 	direction = !direction;
 	
 	delay(50);
+
 }
 
 void tankDrive(double leftSpeed, double rightSpeed, double strafeSpeed) {

void resetGyro(char axis) {
  switch (axis) {
    case 'x':
      gyroResetValX += getAngle('x');
      break;
    case 'y':
      gyroResetValY += getAngle('y');
      break;
    case 'z':
      gyroResetValZ += getAngle('z');
      break;
  }
}


// PID
#define setpoint 0
#define kP 0.002

Servo extingusher_servo;

