 #define LEFT_MOTOR_1B 3
 
 #define INTERRUPT_PIN 2
+
+#define setpoint 0
+#define kP 0.05
 
 Servo extingusher_servo;
 

void hDrive(double move, double rotate, double strafe);
void tankDrive(double leftSpeed, double rightSpeed, double strafeSpeed);
void definedStartSearch();
double getAngle(double targetAngle);
double getAngle(char axis);
double getPercentError(double actual, double target);
void turnToAngle(double targetAngle, double speed);

  }
  
  hDrive(0.0, 0.0, 0.0);
}

double getPidOutput() {
  return (setpoint - getAngle('x')) * kP;
}

void extinguish() {
