1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-17 21:35:44 +03:00

Add more info for sensor in (get) MSP_SENSOR_CONFIG (#12626)

* more info for sensor

* moved comment
This commit is contained in:
HThuren 2023-04-06 23:49:33 +02:00 committed by GitHub
parent 2878ad4e72
commit 29ef811fa2
No known key found for this signature in database
GPG key ID: 4AEE18F83AFDEB23

View file

@ -2048,20 +2048,31 @@ case MSP_NAME:
sbufWriteU16(dst, currentPidProfile->tpa_breakpoint); // was currentControlRateProfile->tpa_breakpoint sbufWriteU16(dst, currentPidProfile->tpa_breakpoint); // was currentControlRateProfile->tpa_breakpoint
break; break;
case MSP_SENSOR_CONFIG: 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) #if defined(USE_ACC)
sbufWriteU8(dst, accelerometerConfig()->acc_hardware); // Changed with API 1.46
sbufWriteU8(dst, accelerometerConfig()->acc_hardware == ACC_DEFAULT ? detectedSensors[1] : accelerometerConfig()->acc_hardware);
#else #else
sbufWriteU8(dst, 0); sbufWriteU8(dst, 0);
#endif #endif
#ifdef USE_BARO #ifdef USE_BARO
sbufWriteU8(dst, barometerConfig()->baro_hardware); // Changed with API 1.46
sbufWriteU8(dst, barometerConfig()->baro_hardware == BARO_DEFAULT ? detectedSensors[2] : barometerConfig()->baro_hardware);
#else #else
sbufWriteU8(dst, BARO_NONE); sbufWriteU8(dst, BARO_NONE);
#endif #endif
#ifdef USE_MAG #ifdef USE_MAG
sbufWriteU8(dst, compassConfig()->mag_hardware); // Changed with API 1.46
sbufWriteU8(dst, compassConfig()->mag_hardware == MAG_DEFAULT ? detectedSensors[3] : compassConfig()->mag_hardware);
#else #else
sbufWriteU8(dst, MAG_NONE); sbufWriteU8(dst, MAG_NONE);
#endif
// Added in MSP API 1.46
#ifdef USE_RANGEFINDER
sbufWriteU8(dst, rangefinderConfig()->rangefinder_hardware); // no RANGEFINDER_DEFAULT value
#else
sbufWriteU8(dst, RANGEFINDER_NONE);
#endif #endif
break; break;