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

cosmetic changes & minor improvements on speed negotiation logic

Browse source
This commit is contained in:
tbs-fpv 2021-05-20 11:09:35 +08:00
parent 55288dc2e1
commit 761a0d2b1f
3 changed files with 30 additions and 36 deletions
Download patch file Download diff file Expand all files Collapse all files

12
src/main/fc/tasks.c
View file

@ -267,13 +267,6 @@ static void taskCameraControl(uint32_t currentTime)
}
#endif
#ifdef USE_CRSF_V3
static void taskSpeedNegotiation(uint32_t currentTime)
{
speedNegotiationProcess(currentTime);
}
#endif
void tasksInit(void)
{
schedulerInit();
@ -419,7 +412,8 @@ void tasksInit(void)
#endif
#ifdef USE_CRSF_V3
setTaskEnabled(TASK_SPEED_NEGOTIATION, true);
const bool useCRSF = rxRuntimeState.serialrxProvider == SERIALRX_CRSF;
setTaskEnabled(TASK_SPEED_NEGOTIATION, useCRSF);
#endif
}
@ -541,7 +535,7 @@ task_t tasks[TASK_COUNT] = {
#endif
#ifdef USE_CRSF_V3
[TASK_SPEED_NEGOTIATION] = DEFINE_TASK("SPEED_NEGOTIATION", NULL, NULL, taskSpeedNegotiation, TASK_PERIOD_HZ(100), TASK_PRIORITY_IDLE),
[TASK_SPEED_NEGOTIATION] = DEFINE_TASK("SPEED_NEGOTIATION", NULL, NULL, speedNegotiationProcess, TASK_PERIOD_HZ(100), TASK_PRIORITY_IDLE),
#endif
};

24
src/main/telemetry/crsf.c
View file

@ -104,7 +104,7 @@ bool checkCrsfCustomizedSpeed(void)
return crsfSpeed.index < BAUD_COUNT ? true : false;
}
uint32_t getCrsfDesireSpeed(void)
uint32_t getCrsfDesiredSpeed(void)
{
return checkCrsfCustomizedSpeed() ? baudRates[crsfSpeed.index] : CRSF_BAUDRATE;
}
@ -116,7 +116,7 @@ void setCrsfDefaultSpeed(void)
crsfSpeed.confirmationTime = 0;
crsfSpeed.index = BAUD_COUNT;
isCrsfV3Running = false;
crsfRxUpdateBaudrate(getCrsfDesireSpeed());
crsfRxUpdateBaudrate(getCrsfDesiredSpeed());
}
#endif
@ -399,6 +399,15 @@ void crsfScheduleSpeedNegotiationResponse(void)
void speedNegotiationProcess(uint32_t currentTime)
{
if (!featureIsEnabled(FEATURE_TELEMETRY) && getCrsfDesiredSpeed() == CRSF_BAUDRATE) {
// to notify the RX to fall back to default baud rate by sending device info frame if telemetry is disabled
sbuf_t crsfPayloadBuf;
sbuf_t *dst = &crsfPayloadBuf;
crsfInitializeFrame(dst);
crsfFrameDeviceInfo(dst);
crsfFinalize(dst);
crsfRxSendTelemetryData();
} else {
if (crsfSpeed.hasPendingReply) {
bool found = crsfSpeed.index < BAUD_COUNT ? true : false;
sbuf_t crsfSpeedNegotiationBuf;
@ -414,21 +423,12 @@ void speedNegotiationProcess(uint32_t currentTime)
} else if (crsfSpeed.isNewSpeedValid) {
if (currentTime - crsfSpeed.confirmationTime >= 4000) {
// delay 4ms before applying the new baudrate
crsfRxUpdateBaudrate(getCrsfDesireSpeed());
crsfRxUpdateBaudrate(getCrsfDesiredSpeed());
crsfSpeed.isNewSpeedValid = false;
isCrsfV3Running = true;
return;
}
}
// to notify the RX to fall back by sedning device info frame if telemetry is disabled
if (!featureIsEnabled(FEATURE_TELEMETRY) && getCrsfDesireSpeed() == CRSF_BAUDRATE) {
sbuf_t crsfPayloadBuf;
sbuf_t *dst = &crsfPayloadBuf;
crsfInitializeFrame(dst);
crsfFrameDeviceInfo(dst);
crsfFinalize(dst);
crsfRxSendTelemetryData();
}
}
#endif

2
src/main/telemetry/crsf.h
View file

@ -31,7 +31,7 @@
#define CRSF_MSP_TX_BUF_SIZE 128
void initCrsfTelemetry(void);
uint32_t getCrsfDesireSpeed(void);
uint32_t getCrsfDesiredSpeed(void);
void setCrsfDefaultSpeed(void);
bool checkCrsfTelemetryState(void);
void handleCrsfTelemetry(timeUs_t currentTimeUs);