   }
 }
 
-void scanForFire(){
-//  servo_pin.write(0);
-//  for(int i = 0; i <= 180;i += 10){
-//    if(digitalRead(fire_sensor)){
-//      delay(10);//make sure that the reading isn't a false positive
-//      while(digitalRead(fire_sensor))
-//      {
-//        //Turn on extinguisher
-//        delay(50);
-//      }
-//    }
-//    break;
-//  }
-}
-
 void countPulseRight() {
   int Lstate = digitalRead(encoderARight);
   if((encoderALastRight == LOW) && Lstate==HIGH)

  delay(100);
}

void drivetrainCheck() {
  hDrive(0.3, 0.0, 0.0); delay(300); hDrive(-0.3, 0.0, 0.0); delay(300);
  hDrive(0.0, 0.3, 0.0); delay(300); hDrive(0.0, -0.3, 0.0); delay(300);

#include "Ultrasonic.h"
#include "ColorSensor.h"
#include <Servo.h>

#define WALL_DISTANCE 5
#define servo_pin 45
#define fire_sensor 47

Motor leftMotor1(3, 4);
Motor leftMotor2(5, 6);
