Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-16 12:55:19 +03:00
Code Issues Wiki Activity

Fixed Dshot command check on non-F7.

Browse source
This commit is contained in:
mikeller 2018-06-14 01:46:04 +12:00
parent 11d8171c36
commit 906a4bcb78
2 changed files with 9 additions and 7 deletions
Download patch file Download diff file Expand all files Collapse all files

10
src/main/drivers/pwm_output.c
View file

@ -386,6 +386,11 @@ uint32_t getDshotHz(motorPwmProtocolTypes_e pwmProtocolType)
}
}
FAST_RAM bool pwmIsProcessingDshotCommand(void)
{
return dshotCommandControl.nextCommandAt;
}
void pwmWriteDshotCommand(uint8_t index, uint8_t motorCount, uint8_t command, bool blocking)
{
timeUs_t timeNowUs = micros();
@ -448,11 +453,6 @@ void pwmWriteDshotCommand(uint8_t index, uint8_t motorCount, uint8_t command, bo
}
}
FAST_RAM bool pwmIsProcessingDshotCommand(void)
{
return dshotCommandControl.nextCommandAt;
}
uint8_t pwmGetDshotCommand(uint8_t index)
{
return dshotCommandControl.command[index];

6
src/main/drivers/pwm_output_dshot.c
View file

@ -97,8 +97,10 @@ void pwmCompleteDshotMotorUpdate(uint8_t motorCount)
UNUSED(motorCount);
/* If there is a dshot command loaded up, time it correctly with motor update*/
if (!pwmProcessDshotCommand(motorCount)) {
return; //Skip motor update
if (pwmIsProcessingDshotCommand()) {
if (!pwmProcessDshotCommand(motorCount)) {
return;
}
}
for (int i = 0; i < dmaMotorTimerCount; i++) {