 #include "Motor.h"
+#include "Ultrasonic.h"
 #include "colorSensor.h"
 #include "servo.h"
+
+#define WALL_DISTANCE 5
 
 Motor leftMotor1(2, 3);
 Motor leftMotor2(4, 5);
 Motor rightMotor1(6, 7);
 Motor rightMotor2(8, 9);
 Motor strafeMotor(10, 11);
+
 ColorSensor colour_sensor(44, 46, 48, 50, 52);
 #define servo_pin 45
 #define fire_sensor 47
+
+Ultrasonic frontUltrasonic(22, 23, true);
+Ultrasonic leftUltrasonic(24, 25, true);
+Ultrasonic rightUltrasonic(26, 27, true);
+Ultrasonic backUltrasonic(28, 29, true);
+
+void driveToWhite();
+void driveThroughRoom();
+
 void hDrive(double move, double rotate, double strafe) {
   double leftSpeed, rightSpeed;
   

    }
  
  }
}

    break;
  }
}

int btn = 0;
void loop() {
  
