1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-15 12:25:20 +03:00

Cleanup servo configuration storage (align some values more

efficiently).  Update MSP_SERVO_CONFIGURATIONS,
MSP_SET_SERVO_CONFIGURATION value order.  Add some error checking to
size of MSP_SET_SERVO_CONFIGURATION.
This commit is contained in:
Dominic Clifton 2015-07-12 23:32:07 +01:00
parent 52fe86e66d
commit 6dca303130
2 changed files with 9 additions and 5 deletions

View file

@ -843,8 +843,8 @@ static bool processOutCommand(uint8_t cmdMSP)
serialize8(currentProfile->servoConf[i].rate);
serialize8(currentProfile->servoConf[i].angleAtMin);
serialize8(currentProfile->servoConf[i].angleAtMax);
serialize32(currentProfile->servoConf[i].reversedSources);
serialize8(currentProfile->servoConf[i].forwardFromChannel);
serialize32(currentProfile->servoConf[i].reversedSources);
}
break;
case MSP_SERVO_MIX_RULES:
@ -1429,6 +1429,10 @@ static bool processInCommand(void)
break;
case MSP_SET_SERVO_CONFIGURATION:
#ifdef USE_SERVOS
if (currentPort->dataSize != 1 + sizeof(servoParam_t)) {
headSerialError(0);
break;
}
i = read8();
if (i >= MAX_SUPPORTED_SERVOS) {
headSerialError(0);
@ -1439,8 +1443,8 @@ static bool processInCommand(void)
currentProfile->servoConf[i].rate = read8();
currentProfile->servoConf[i].angleAtMin = read8();
currentProfile->servoConf[i].angleAtMax = read8();
currentProfile->servoConf[i].reversedSources = read32();
currentProfile->servoConf[i].forwardFromChannel = read8();
currentProfile->servoConf[i].reversedSources = read32();
}
#endif
break;