center_wing.c

bool centerWingIsMoving = false;
bool centerWingDown = false;
int centerWingPulseTimeMs = 200;

void joyWing(DesiredMotorVals *desiredMotorVals, TJoystick *joyState) {
  if (centerWingIsMoving) {
    if (time1[T1] > centerWingPulseTimeMs) {
      desiredMotorVals->power[Wing_Middle] = 0;
      centerWingIsMoving = false;
      centerWingDown = !centerWingDown;
    }
  } else {
    if (joyButtonPressed(joyState, JOY1, BUTTON_X)) {
      ClearTimer(T1);
      centerWingIsMoving = true;
      if (centerWingDown) {
        desiredMotorVals->power[Wing_Middle] = 75;
      } else {
        desiredMotorVals->power[Wing_Middle] = -75;
      }
    }
  }
}