Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-21 15:25:36 +03:00
Code Issues Wiki Activity

Nicer DSHOT MSP handling

Browse source
This commit is contained in:
borisbstyle 2016-10-23 00:53:32 +02:00
parent 32ec29ccce
commit f19b508cd4
1 changed files with 4 additions and 1 deletions
Download patch file Download diff file Expand all files Collapse all files

5
src/main/fc/fc_msp.c
View file

@ -649,7 +649,10 @@ static bool mspFcProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst, mspPostProcessFn
#endif #endif
case MSP_MOTOR: case MSP_MOTOR:
for (unsigned i = 0; i < 8; i++) { for (unsigned i = 0; i < 8; i++) {
sbufWriteU16(dst, i < MAX_SUPPORTED_MOTORS ? constrain(motor[i], 1, 2047) : 0); // TODO - Fix 0 handling in the configurator. This is just a workaround if (masterConfig.motorConfig.motorPwmProtocol == PWM_TYPE_DSHOT150 || masterConfig.motorConfig.motorPwmProtocol == PWM_TYPE_DSHOT600)
sbufWriteU16(dst, i < MAX_SUPPORTED_MOTORS ? constrain((motor[i] / 2) + 1000, 1000, 2000) : 0); // This is to get it working in the configurator
else
sbufWriteU16(dst, i < MAX_SUPPORTED_MOTORS ? motor[i] : 0);
} }
break; break;
case MSP_RC: case MSP_RC: