Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-25 17:25:18 +03:00
Code Issues Wiki Activity

fixed compilation error

Browse source
This commit is contained in:
Roman Lut 2022-07-30 08:02:16 +03:00
parent f472fbeaf7
commit ec4c2b69d3
1 changed files with 8 additions and 4 deletions
Download patch file Download diff file Expand all files Collapse all files

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

@ -3407,11 +3407,13 @@ bool mspFCProcessInOutCommand(uint16_t cmdMSP, sbuf_t *dst, sbuf_t *src, mspResu
if (ARMING_FLAG(SIMULATOR_MODE)) { // just once if (ARMING_FLAG(SIMULATOR_MODE)) { // just once
DISABLE_ARMING_FLAG(SIMULATOR_MODE); DISABLE_ARMING_FLAG(SIMULATOR_MODE);
#ifdef USE_BARO
baroStartCalibration(); baroStartCalibration();
#endif
#ifdef USE_MAG
DISABLE_STATE(COMPASS_CALIBRATED); DISABLE_STATE(COMPASS_CALIBRATED);
compassInit(); compassInit();
#endif
simulatorData.flags = 0; simulatorData.flags = 0;
//review: many states were affected. reboot? //review: many states were affected. reboot?
@ -3420,8 +3422,10 @@ bool mspFCProcessInOutCommand(uint16_t cmdMSP, sbuf_t *dst, sbuf_t *src, mspResu
} }
else if (!areSensorsCalibrating()) { else if (!areSensorsCalibrating()) {
if (!ARMING_FLAG(SIMULATOR_MODE)) { // just once if (!ARMING_FLAG(SIMULATOR_MODE)) { // just once
#ifdef USE_BARO
baroStartCalibration(); baroStartCalibration();
#endif
#ifdef USE_MAG
if (compassConfig()->mag_hardware != 0){ if (compassConfig()->mag_hardware != 0){
sensorsSet(SENSOR_MAG); sensorsSet(SENSOR_MAG);
ENABLE_STATE(COMPASS_CALIBRATED); ENABLE_STATE(COMPASS_CALIBRATED);
@ -3430,7 +3434,7 @@ bool mspFCProcessInOutCommand(uint16_t cmdMSP, sbuf_t *dst, sbuf_t *src, mspResu
mag.magADC[Y] = 0; mag.magADC[Y] = 0;
mag.magADC[Z] = 0; mag.magADC[Z] = 0;
} }
#endif
ENABLE_ARMING_FLAG(SIMULATOR_MODE); ENABLE_ARMING_FLAG(SIMULATOR_MODE);
LOG_D(SYSTEM, "Simulator enabled"); LOG_D(SYSTEM, "Simulator enabled");
} }