335,11 → 335,17 |
ServoRollValue /= MULTIPLYER; |
//DebugOut.Analog[20] = ServoRollValue; |
break; |
case 3: RemainingPulse += 2 * Parameter_Servo3; |
case 3: // 2 additions are probably faster than a conversion to u16 and multiplication by 2 |
RemainingPulse += Parameter_Servo3; |
RemainingPulse += Parameter_Servo3; |
break; |
case 4: RemainingPulse += 2 * Parameter_Servo4; |
case 4: |
RemainingPulse += Parameter_Servo4; |
RemainingPulse += Parameter_Servo4; |
break; |
case 5: RemainingPulse += 2 * Parameter_Servo5; |
case 5: |
RemainingPulse += Parameter_Servo5; |
RemainingPulse += Parameter_Servo5; |
break; |
default: // other servo channels |
RemainingPulse += 2 * PPM_in[ServoIndex]; // add channel value, factor of 2 because timer 1 increments 3.2µs |