Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-26 09:45:33 +03:00
Code Issues Wiki Activity

Some temperature changes

Browse source
This commit is contained in:
Michel Pastor 2019-02-09 12:12:45 +01:00
parent aef3c60d6b
commit 1aaf153748
5 changed files with 14 additions and 16 deletions
Download patch file Download diff file Expand all files Collapse all files

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

@ -1399,8 +1399,8 @@ static bool mspFcProcessOutCommand(uint16_t cmdMSP, sbuf_t *dst, mspPostProcessF
#endif
break;
case MSP2_INAV_TEMP_SENSOR_CONFIG:
#ifdef USE_TEMPERATURE_SENSOR
case MSP2_INAV_TEMP_SENSOR_CONFIG:
for (uint8_t index = 0; index < MAX_TEMP_SENSORS; ++index) {
const tempSensorConfig_t *sensorConfig = tempSensorConfig(index);
sbufWriteU8(dst, sensorConfig->type);
@ -1411,18 +1411,18 @@ static bool mspFcProcessOutCommand(uint16_t cmdMSP, sbuf_t *dst, mspPostProcessF
sbufWriteU16(dst, sensorConfig->alarm_min);
sbufWriteU16(dst, sensorConfig->alarm_max);
}
#endif
break;
#endif
case MSP2_INAV_TEMPERATURES:
#ifdef USE_TEMPERATURE_SENSOR
case MSP2_INAV_TEMPERATURES:
for (uint8_t index = 0; index < MAX_TEMP_SENSORS; ++index) {
int16_t temperature;
bool valid = getSensorTemperature(index, &temperature);
sbufWriteU16(dst, valid ? temperature : -1000);
}
#endif
break;
#endif
default:
return false;
@ -2670,8 +2670,8 @@ static mspResult_e mspFcProcessInCommand(uint16_t cmdMSP, sbuf_t *src)
}
break;
case MSP2_INAV_SET_TEMP_SENSOR_CONFIG:
#ifdef USE_TEMPERATURE_SENSOR
case MSP2_INAV_SET_TEMP_SENSOR_CONFIG:
if (dataSize == sizeof(tempSensorConfig_t) * MAX_TEMP_SENSORS) {
for (uint8_t index = 0; index < MAX_TEMP_SENSORS; ++index) {
tempSensorConfig_t *sensorConfig = tempSensorConfigMutable(index);
@ -2684,10 +2684,9 @@ static mspResult_e mspFcProcessInCommand(uint16_t cmdMSP, sbuf_t *src)
sensorConfig->alarm_max = sbufReadU16(src);
}
} else
#endif
return MSP_RESULT_ERROR;
break;
#endif
default:
return MSP_RESULT_ERROR;