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

MSP changes for the new Power & Battery tab in configurator

Browse source
This commit is contained in:
Bas Delfos 2017-07-15 08:25:39 +02:00
parent 10c8708381
commit 9b189865d1
1 changed files with 61 additions and 32 deletions
Download patch file Download diff file Expand all files Collapse all files

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

@ -706,7 +706,7 @@ static bool mspCommonProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst, mspPostProce
case MSP_VOLTAGE_METERS: case MSP_VOLTAGE_METERS:
// write out id and voltage meter values, once for each meter we support // write out id and voltage meter values, once for each meter we support
for (int i = 0; i < supportedVoltageMeterCount; i++) { for (int i = 0; i < supportedVoltageMeterCount - (12-getMotorCount()); i++) {
voltageMeter_t meter; voltageMeter_t meter;
uint8_t id = (uint8_t)voltageMeterIds[i]; uint8_t id = (uint8_t)voltageMeterIds[i];
@ -719,7 +719,7 @@ static bool mspCommonProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst, mspPostProce
case MSP_CURRENT_METERS: case MSP_CURRENT_METERS:
// write out id and current meter values, once for each meter we support // write out id and current meter values, once for each meter we support
for (int i = 0; i < supportedCurrentMeterCount; i++) { for (int i = 0; i < supportedCurrentMeterCount - (12-getMotorCount()); i++) {
currentMeter_t meter; currentMeter_t meter;
uint8_t id = (uint8_t)currentMeterIds[i]; uint8_t id = (uint8_t)currentMeterIds[i];
@ -2131,12 +2131,22 @@ static mspResult_e mspCommonProcessInCommand(uint8_t cmdMSP, sbuf_t *src)
#endif #endif
case MSP_SET_VOLTAGE_METER_CONFIG: { case MSP_SET_VOLTAGE_METER_CONFIG: {
int id = sbufReadU8(src); int8_t config_count = sbufReadU8(src);
while (config_count > 0) {
int8_t subframe_length = sbufReadU8(src);
if (subframe_length > 4) {
for (int8_t j = 0; j < subframe_length; j++) {
sbufReadU8(src);
}
} else {
int8_t id = sbufReadU8(src);
// //
// find and configure an ADC voltage sensor // find and configure an ADC voltage sensor
// //
int voltageSensorADCIndex; int8_t voltageSensorADCIndex;
for (voltageSensorADCIndex = 0; voltageSensorADCIndex < MAX_VOLTAGE_SENSOR_ADC; voltageSensorADCIndex++) { for (voltageSensorADCIndex = 0; voltageSensorADCIndex < MAX_VOLTAGE_SENSOR_ADC; voltageSensorADCIndex++) {
if (id == voltageMeterADCtoIDMap[voltageSensorADCIndex]) { if (id == voltageMeterADCtoIDMap[voltageSensorADCIndex]) {
break; break;
@ -2149,12 +2159,27 @@ static mspResult_e mspCommonProcessInCommand(uint8_t cmdMSP, sbuf_t *src)
voltageSensorADCConfigMutable(voltageSensorADCIndex)->vbatresdivmultiplier = sbufReadU8(src); voltageSensorADCConfigMutable(voltageSensorADCIndex)->vbatresdivmultiplier = sbufReadU8(src);
} else { } else {
// if we had any other types of voltage sensor to configure, this is where we'd do it. // if we had any other types of voltage sensor to configure, this is where we'd do it.
return -1; sbufReadU8(src);
sbufReadU8(src);
sbufReadU8(src);
}
}
config_count--;
} }
break; break;
} }
case MSP_SET_CURRENT_METER_CONFIG: { case MSP_SET_CURRENT_METER_CONFIG: {
int8_t config_count = sbufReadU8(src);
while (config_count > 0) {
int8_t subframe_length = sbufReadU8(src);
if (subframe_length > 5) {
for (int8_t j = 0; j < subframe_length; j++) {
sbufReadU8(src);
}
} else {
int id = sbufReadU8(src); int id = sbufReadU8(src);
switch (id) { switch (id) {
@ -2168,9 +2193,13 @@ static mspResult_e mspCommonProcessInCommand(uint8_t cmdMSP, sbuf_t *src)
currentSensorVirtualConfigMutable()->offset = sbufReadU16(src); currentSensorVirtualConfigMutable()->offset = sbufReadU16(src);
break; break;
#endif #endif
default: default:
return -1; sbufReadU16(src);
sbufReadU16(src);
break;
}
}
config_count--;
} }
break; break;