Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-24 16:55:29 +03:00
Code Issues Wiki Activity

Merge pull request #9321 from shirase/dshot-delay-fix

Browse source 
DSHOT delay fix
This commit is contained in:
Paweł Spychalski 2023-09-28 14:27:01 +02:00 • committed by GitHub
commit c8c1e37779
No known key found for this signature in database
GPG key ID: 4AEE18F83AFDEB23
1 changed files with 22 additions and 7 deletions
Download patch file Download diff file Expand all files Collapse all files

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

@ -119,6 +119,7 @@ static bool pwmMotorsEnabled = true;
static timeUs_t digitalMotorUpdateIntervalUs = 0;
static timeUs_t digitalMotorLastUpdateUs;
static timeUs_t lastCommandSent = 0;
static timeUs_t commandPostDelay = 0;
static circularBuffer_t commandsCircularBuffer;
static uint8_t commandsBuff[DHSOT_COMMAND_QUEUE_SIZE];
@ -419,7 +420,7 @@ static int getDShotCommandRepeats(dshotCommands_e cmd) {
return repeats;
}
static void executeDShotCommands(void){
static bool executeDShotCommands(void){
timeUs_t tNow = micros();
@ -430,18 +431,30 @@ static void executeDShotCommands(void){
dshotCommands_e cmd;
circularBufferPopHead(&commandsCircularBuffer, (uint8_t *) &cmd);
currentExecutingCommand.cmd = cmd;
currentExecutingCommand.remainingRepeats = getDShotCommandRepeats(cmd);
currentExecutingCommand.remainingRepeats = getDShotCommandRepeats(cmd);
commandPostDelay = DSHOT_COMMAND_INTERVAL_US;
} else {
return;
if (commandPostDelay) {
if (tNow - lastCommandSent < commandPostDelay) {
return false;
}
commandPostDelay = 0;
}
return true;
}
}
delayMicroseconds(DSHOT_COMMAND_DELAY_US);
for (uint8_t i = 0; i < getMotorCount(); i++) {
motors[i].requestTelemetry = true;
motors[i].value = currentExecutingCommand.cmd;
}
currentExecutingCommand.remainingRepeats--;
lastCommandSent = tNow;
if (tNow - lastCommandSent >= DSHOT_COMMAND_DELAY_US) {
currentExecutingCommand.remainingRepeats--;
lastCommandSent = tNow;
return true;
} else {
return false;
}
}
#endif
@ -464,7 +477,9 @@ void pwmCompleteMotorUpdate(void) {
#ifdef USE_DSHOT
if (isMotorProtocolDshot()) {
executeDShotCommands();
if (!executeDShotCommands()) {
return;
}
#ifdef USE_DSHOT_DMAR
for (int index = 0; index < motorCount; index++) {