Skip to content

Commit

Permalink
Fix sensor config
Browse files Browse the repository at this point in the history
  • Loading branch information
haslinghuis committed Nov 22, 2023
1 parent 89607c6 commit c5ec1c6
Showing 1 changed file with 4 additions and 8 deletions.
12 changes: 4 additions & 8 deletions src/main/msp/msp.c
Expand Up @@ -2050,23 +2050,19 @@ case MSP_NAME:
sbufWriteU16(dst, currentPidProfile->tpa_breakpoint); // was currentControlRateProfile->tpa_breakpoint
break;
case MSP_SENSOR_CONFIG:
// if sensor name is default setting, use name in runtime config
// use sensorIndex_e index: 0:GyroHardware, 1:AccHardware, 2:BaroHardware, 3:MagHardware, 4:RangefinderHardware
#if defined(USE_ACC)
// Changed with API 1.46
sbufWriteU8(dst, accelerometerConfig()->acc_hardware == ACC_DEFAULT ? detectedSensors[1] : accelerometerConfig()->acc_hardware);
sbufWriteU8(dst, accelerometerConfig()->acc_hardware);
#else
sbufWriteU8(dst, 0);
sbufWriteU8(dst, ACC_NONE);
#endif
#ifdef USE_BARO
// Changed with API 1.46
sbufWriteU8(dst, barometerConfig()->baro_hardware == BARO_DEFAULT ? detectedSensors[2] : barometerConfig()->baro_hardware);
sbufWriteU8(dst, barometerConfig()->baro_hardware);
#else
sbufWriteU8(dst, BARO_NONE);
#endif
#ifdef USE_MAG
// Changed with API 1.46
sbufWriteU8(dst, compassConfig()->mag_hardware == MAG_DEFAULT ? detectedSensors[3] : compassConfig()->mag_hardware);
sbufWriteU8(dst, compassConfig()->mag_hardware);
#else
sbufWriteU8(dst, MAG_NONE);
#endif
Expand Down

0 comments on commit c5ec1c6

Please sign in to comment.