feat: add support for ExpressLRS optional arming method (#5641)
Co-authored-by: elecpower <elecpower@users.noreply.github.com>
This commit is contained in:
@@ -270,6 +270,17 @@ void processCrossfireTelemetryFrame(uint8_t module, uint8_t* rxBuffer,
|
||||
crossfireModuleStatus[module].major = rxBuffer[14 + nameSize];
|
||||
crossfireModuleStatus[module].minor = rxBuffer[15 + nameSize];
|
||||
crossfireModuleStatus[module].revision = rxBuffer[16 + nameSize];
|
||||
|
||||
ModuleData *md = &g_model.moduleData[module];
|
||||
|
||||
if(!CRSF_ELRS_MIN_VER(module, 4, 0) &&
|
||||
(md->crsf.crsfArmingMode != ARMING_MODE_CH5 || md->crsf.crsfArmingMode != SWSRC_NONE)) {
|
||||
md->crsf.crsfArmingMode = ARMING_MODE_CH5;
|
||||
md->crsf.crsfArmingTrigger = SWSRC_NONE;
|
||||
|
||||
storageDirty(EE_MODEL);
|
||||
}
|
||||
|
||||
crossfireModuleStatus[module].queryCompleted = true;
|
||||
}
|
||||
|
||||
|
||||
@@ -119,8 +119,6 @@ void processCrossfireTelemetryFrame(uint8_t module, uint8_t* rxBuffer,
|
||||
uint8_t rxBufferCount);
|
||||
void crossfireSetDefault(int index, uint8_t id, uint8_t subId);
|
||||
|
||||
uint8_t createCrossfireModelIDFrame(uint8_t* frame);
|
||||
|
||||
const uint32_t CROSSFIRE_BAUDRATES[] = {
|
||||
115200,
|
||||
400000,
|
||||
@@ -158,6 +156,11 @@ const uint8_t CROSSFIRE_FRAME_PERIODS[] = {
|
||||
% DIM(CROSSFIRE_BAUDRATES)
|
||||
#endif
|
||||
|
||||
#define CRSF_ELRS_MIN_VER(moduleIdx, maj, min) \
|
||||
(crossfireModuleStatus[moduleIdx].isELRS \
|
||||
&& crossfireModuleStatus[moduleIdx].major >= maj \
|
||||
&& crossfireModuleStatus[moduleIdx].minor >= min)
|
||||
|
||||
#if defined(HARDWARE_INTERNAL_MODULE)
|
||||
#define INT_CROSSFIRE_BR_IDX CROSSFIRE_STORE_TO_INDEX(g_eeGeneral.internalModuleBaudrate)
|
||||
#define INT_CROSSFIRE_BAUDRATE CROSSFIRE_BAUDRATES[INT_CROSSFIRE_BR_IDX]
|
||||
|
||||
Reference in New Issue
Block a user