 #include "Motor.h"
 #include "colorSensor.h"
+#include "servo.h"
 
 Motor leftMotor1(2, 3);
 Motor leftMotor2(4, 5);


void setup() {
  Serial.begin(9600);
 }

int btn = 0;
void loop() {
  

Motor rightMotor2(8, 9);
Motor strafeMotor(10, 11);
ColorSensor colour_sensor(44, 46, 48, 50, 52);
#define servo_pin 45
#define fire_sensor 47
void hDrive(double move, double rotate, double strafe) {
  double leftSpeed, rightSpeed;
  
