void thrusterEast(int pwm, int isForward) { pwm = btd093(pwm); analogWrite(pwmPinEast, pwm); if (isForward) { digitalWrite(directionPinEast1, HIGH); digitalWrite(directionPinEast2, LOW); } else { digitalWrite(directionPinEast1, LOW); digitalWrite(directionPinEast2, HIGH); } }
void thrusterSouthUp(int pwm, int isUpward) { pwm = abs(pwm); pwm = btd093(pwm); analogWrite(pwmPinSouthUp, 255 - pwm); if (isUpward) { digitalWrite(directionPinSouthUp1, HIGH); digitalWrite(directionPinSouthUp2, LOW); } else { digitalWrite(directionPinSouthUp1, LOW); digitalWrite(directionPinSouthUp2, HIGH); } }