mirror of
https://github.com/betaflight/betaflight.git
synced 2025-07-23 08:15:30 +03:00
Merge pull request #1903 from martinbudden/bf_pg_cli2
Improvements to CLI diff command. Fixes to CLI print commands.
This commit is contained in:
Anders Höglund
GitHub
commit
8e9dec4fa1
1 changed files with 255 additions and 223 deletions
|
|
@ -1091,19 +1091,19 @@ static bool isEmpty(const char *string)
|
|||
return *string == '\0';
|
||||
}
|
||||
|
||||
static void printRxFail(uint8_t dumpMask, const rxConfig_t *defaultRxConfig)
|
||||
static void printRxFail(uint8_t dumpMask, const rxConfig_t *rxConfig, const rxConfig_t *defaultRxConfig)
|
||||
{
|
||||
// print out rxConfig failsafe settings
|
||||
const rxFailsafeChannelConfiguration_t *channelFailsafeConfiguration;
|
||||
const rxFailsafeChannelConfiguration_t *channelFailsafeConfigurationDefault;
|
||||
bool equalsDefault;
|
||||
bool requireValue;
|
||||
for (uint32_t channel = 0; channel < MAX_SUPPORTED_RC_CHANNEL_COUNT; channel++) {
|
||||
channelFailsafeConfiguration = &rxConfig()->failsafe_channel_configurations[channel];
|
||||
channelFailsafeConfigurationDefault = &defaultRxConfig->failsafe_channel_configurations[channel];
|
||||
equalsDefault = channelFailsafeConfiguration->mode == channelFailsafeConfigurationDefault->mode
|
||||
&& channelFailsafeConfiguration->step == channelFailsafeConfigurationDefault->step;
|
||||
requireValue = channelFailsafeConfiguration->mode == RX_FAILSAFE_MODE_SET;
|
||||
const rxFailsafeChannelConfiguration_t *channelFailsafeConfiguration = &rxConfig->failsafe_channel_configurations[channel];
|
||||
const rxFailsafeChannelConfiguration_t *channelFailsafeConfigurationDefault;
|
||||
bool equalsDefault = true;
|
||||
if (defaultRxConfig) {
|
||||
channelFailsafeConfigurationDefault = &defaultRxConfig->failsafe_channel_configurations[channel];
|
||||
equalsDefault = channelFailsafeConfiguration->mode == channelFailsafeConfigurationDefault->mode
|
||||
&& channelFailsafeConfiguration->step == channelFailsafeConfigurationDefault->step;
|
||||
}
|
||||
const bool requireValue = channelFailsafeConfiguration->mode == RX_FAILSAFE_MODE_SET;
|
||||
if (requireValue) {
|
||||
const char *format = "rxfail %u %c %d\r\n";
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
|
|
@ -1214,24 +1214,27 @@ static void cliRxFail(char *cmdline)
|
|||
}
|
||||
}
|
||||
|
||||
static void printAux(uint8_t dumpMask, const modeActivationProfile_t *defaultModeActivationProfile)
|
||||
static void printAux(uint8_t dumpMask, const modeActivationProfile_t *modeActivationProfile, const modeActivationProfile_t *defaultModeActivationProfile)
|
||||
{
|
||||
const char *format = "aux %u %u %u %u %u\r\n";
|
||||
// print out aux channel settings
|
||||
for (uint32_t i = 0; i < MAX_MODE_ACTIVATION_CONDITION_COUNT; i++) {
|
||||
const modeActivationCondition_t *mac = &modeActivationProfile()->modeActivationConditions[i];
|
||||
const modeActivationCondition_t *macDefault = &defaultModeActivationProfile->modeActivationConditions[i];
|
||||
const bool equalsDefault = mac->modeId == macDefault->modeId
|
||||
&& mac->auxChannelIndex == macDefault->auxChannelIndex
|
||||
&& mac->range.startStep == macDefault->range.startStep
|
||||
&& mac->range.endStep == macDefault->range.endStep;
|
||||
const char *format = "aux %u %u %u %u %u\r\n";
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
macDefault->modeId,
|
||||
macDefault->auxChannelIndex,
|
||||
MODE_STEP_TO_CHANNEL_VALUE(macDefault->range.startStep),
|
||||
MODE_STEP_TO_CHANNEL_VALUE(macDefault->range.endStep)
|
||||
);
|
||||
const modeActivationCondition_t *mac = &modeActivationProfile->modeActivationConditions[i];
|
||||
bool equalsDefault = true;
|
||||
if (defaultModeActivationProfile) {
|
||||
const modeActivationCondition_t *macDefault = &defaultModeActivationProfile->modeActivationConditions[i];
|
||||
equalsDefault = mac->modeId == macDefault->modeId
|
||||
&& mac->auxChannelIndex == macDefault->auxChannelIndex
|
||||
&& mac->range.startStep == macDefault->range.startStep
|
||||
&& mac->range.endStep == macDefault->range.endStep;
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
macDefault->modeId,
|
||||
macDefault->auxChannelIndex,
|
||||
MODE_STEP_TO_CHANNEL_VALUE(macDefault->range.startStep),
|
||||
MODE_STEP_TO_CHANNEL_VALUE(macDefault->range.endStep)
|
||||
);
|
||||
}
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
mac->modeId,
|
||||
|
|
@ -1248,7 +1251,7 @@ static void cliAux(char *cmdline)
|
|||
char *ptr;
|
||||
|
||||
if (isEmpty(cmdline)) {
|
||||
printAux(DUMP_MASTER, NULL);
|
||||
printAux(DUMP_MASTER, modeActivationProfile(), NULL);
|
||||
} else {
|
||||
ptr = cmdline;
|
||||
i = atoi(ptr++);
|
||||
|
|
@ -1282,28 +1285,30 @@ static void cliAux(char *cmdline)
|
|||
}
|
||||
}
|
||||
|
||||
static void printSerial(uint8_t dumpMask, const serialConfig_t *serialConfigDefault)
|
||||
static void printSerial(uint8_t dumpMask, const serialConfig_t *serialConfig, const serialConfig_t *serialConfigDefault)
|
||||
{
|
||||
const serialConfig_t *serialConfig = serialConfig();
|
||||
const char *format = "serial %d %d %ld %ld %ld %ld\r\n";
|
||||
for (uint32_t i = 0; i < SERIAL_PORT_COUNT; i++) {
|
||||
if (!serialIsPortAvailable(serialConfig->portConfigs[i].identifier)) {
|
||||
continue;
|
||||
};
|
||||
const bool equalsDefault = serialConfig->portConfigs[i].identifier == serialConfigDefault->portConfigs[i].identifier
|
||||
&& serialConfig->portConfigs[i].functionMask == serialConfigDefault->portConfigs[i].functionMask
|
||||
&& serialConfig->portConfigs[i].msp_baudrateIndex == serialConfigDefault->portConfigs[i].msp_baudrateIndex
|
||||
&& serialConfig->portConfigs[i].gps_baudrateIndex == serialConfigDefault->portConfigs[i].gps_baudrateIndex
|
||||
&& serialConfig->portConfigs[i].telemetry_baudrateIndex == serialConfigDefault->portConfigs[i].telemetry_baudrateIndex
|
||||
&& serialConfig->portConfigs[i].blackbox_baudrateIndex == serialConfigDefault->portConfigs[i].blackbox_baudrateIndex;
|
||||
const char *format = "serial %d %d %ld %ld %ld %ld\r\n";
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
serialConfigDefault->portConfigs[i].identifier,
|
||||
serialConfigDefault->portConfigs[i].functionMask,
|
||||
baudRates[serialConfigDefault->portConfigs[i].msp_baudrateIndex],
|
||||
baudRates[serialConfigDefault->portConfigs[i].gps_baudrateIndex],
|
||||
baudRates[serialConfigDefault->portConfigs[i].telemetry_baudrateIndex],
|
||||
baudRates[serialConfigDefault->portConfigs[i].blackbox_baudrateIndex]
|
||||
);
|
||||
bool equalsDefault = true;
|
||||
if (serialConfigDefault) {
|
||||
equalsDefault = serialConfig->portConfigs[i].identifier == serialConfigDefault->portConfigs[i].identifier
|
||||
&& serialConfig->portConfigs[i].functionMask == serialConfigDefault->portConfigs[i].functionMask
|
||||
&& serialConfig->portConfigs[i].msp_baudrateIndex == serialConfigDefault->portConfigs[i].msp_baudrateIndex
|
||||
&& serialConfig->portConfigs[i].gps_baudrateIndex == serialConfigDefault->portConfigs[i].gps_baudrateIndex
|
||||
&& serialConfig->portConfigs[i].telemetry_baudrateIndex == serialConfigDefault->portConfigs[i].telemetry_baudrateIndex
|
||||
&& serialConfig->portConfigs[i].blackbox_baudrateIndex == serialConfigDefault->portConfigs[i].blackbox_baudrateIndex;
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
serialConfigDefault->portConfigs[i].identifier,
|
||||
serialConfigDefault->portConfigs[i].functionMask,
|
||||
baudRates[serialConfigDefault->portConfigs[i].msp_baudrateIndex],
|
||||
baudRates[serialConfigDefault->portConfigs[i].gps_baudrateIndex],
|
||||
baudRates[serialConfigDefault->portConfigs[i].telemetry_baudrateIndex],
|
||||
baudRates[serialConfigDefault->portConfigs[i].blackbox_baudrateIndex]
|
||||
);
|
||||
}
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format,
|
||||
serialConfig->portConfigs[i].identifier,
|
||||
serialConfig->portConfigs[i].functionMask,
|
||||
|
|
@ -1321,7 +1326,7 @@ static void cliSerial(char *cmdline)
|
|||
char *ptr;
|
||||
|
||||
if (isEmpty(cmdline)) {
|
||||
printSerial(DUMP_MASTER, NULL);
|
||||
printSerial(DUMP_MASTER, serialConfig(), NULL);
|
||||
|
||||
return;
|
||||
}
|
||||
|
|
@ -1476,28 +1481,31 @@ static void cliSerialPassthrough(char *cmdline)
|
|||
}
|
||||
#endif
|
||||
|
||||
static void printAdjustmentRange(uint8_t dumpMask, const adjustmentProfile_t *defaultAdjustmentProfile)
|
||||
static void printAdjustmentRange(uint8_t dumpMask, const adjustmentProfile_t *adjustmentProfile, const adjustmentProfile_t *defaultAdjustmentProfile)
|
||||
{
|
||||
const char *format = "adjrange %u %u %u %u %u %u %u\r\n";
|
||||
// print out adjustment ranges channel settings
|
||||
for (uint32_t i = 0; i < MAX_ADJUSTMENT_RANGE_COUNT; i++) {
|
||||
const adjustmentRange_t *ar = &adjustmentProfile()->adjustmentRanges[i];
|
||||
const adjustmentRange_t *arDefault = &defaultAdjustmentProfile->adjustmentRanges[i];
|
||||
const bool equalsDefault = ar->auxChannelIndex == arDefault->auxChannelIndex
|
||||
&& ar->range.startStep == arDefault->range.startStep
|
||||
&& ar->range.endStep == arDefault->range.endStep
|
||||
&& ar->adjustmentFunction == arDefault->adjustmentFunction
|
||||
&& ar->auxSwitchChannelIndex == arDefault->auxSwitchChannelIndex
|
||||
&& ar->adjustmentIndex == arDefault->adjustmentIndex;
|
||||
const char *format = "adjrange %u %u %u %u %u %u %u\r\n";
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
arDefault->adjustmentIndex,
|
||||
arDefault->auxChannelIndex,
|
||||
MODE_STEP_TO_CHANNEL_VALUE(arDefault->range.startStep),
|
||||
MODE_STEP_TO_CHANNEL_VALUE(arDefault->range.endStep),
|
||||
arDefault->adjustmentFunction,
|
||||
arDefault->auxSwitchChannelIndex
|
||||
);
|
||||
const adjustmentRange_t *ar = &adjustmentProfile->adjustmentRanges[i];
|
||||
bool equalsDefault = true;
|
||||
if (defaultAdjustmentProfile) {
|
||||
const adjustmentRange_t *arDefault = &defaultAdjustmentProfile->adjustmentRanges[i];
|
||||
equalsDefault = ar->auxChannelIndex == arDefault->auxChannelIndex
|
||||
&& ar->range.startStep == arDefault->range.startStep
|
||||
&& ar->range.endStep == arDefault->range.endStep
|
||||
&& ar->adjustmentFunction == arDefault->adjustmentFunction
|
||||
&& ar->auxSwitchChannelIndex == arDefault->auxSwitchChannelIndex
|
||||
&& ar->adjustmentIndex == arDefault->adjustmentIndex;
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
arDefault->adjustmentIndex,
|
||||
arDefault->auxChannelIndex,
|
||||
MODE_STEP_TO_CHANNEL_VALUE(arDefault->range.startStep),
|
||||
MODE_STEP_TO_CHANNEL_VALUE(arDefault->range.endStep),
|
||||
arDefault->adjustmentFunction,
|
||||
arDefault->auxSwitchChannelIndex
|
||||
);
|
||||
}
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
ar->adjustmentIndex,
|
||||
|
|
@ -1516,7 +1524,7 @@ static void cliAdjustmentRange(char *cmdline)
|
|||
char *ptr;
|
||||
|
||||
if (isEmpty(cmdline)) {
|
||||
printAdjustmentRange(DUMP_MASTER, NULL);
|
||||
printAdjustmentRange(DUMP_MASTER, adjustmentProfile(), NULL);
|
||||
} else {
|
||||
ptr = cmdline;
|
||||
i = atoi(ptr++);
|
||||
|
|
@ -1571,8 +1579,9 @@ static void cliAdjustmentRange(char *cmdline)
|
|||
}
|
||||
|
||||
#ifndef USE_QUAD_MIXER_ONLY
|
||||
static void printMotorMix(uint8_t dumpMask, const motorMixer_t *defaultCustomMotorMixer)
|
||||
static void printMotorMix(uint8_t dumpMask, const motorMixer_t *customMotorMixer, const motorMixer_t *defaultCustomMotorMixer)
|
||||
{
|
||||
const char *format = "mmix %d %s %s %s %s\r\n";
|
||||
char buf0[8];
|
||||
char buf1[8];
|
||||
char buf2[8];
|
||||
|
|
@ -1580,23 +1589,25 @@ static void printMotorMix(uint8_t dumpMask, const motorMixer_t *defaultCustomMot
|
|||
for (uint32_t i = 0; i < MAX_SUPPORTED_MOTORS; i++) {
|
||||
if (customMotorMixer(i)->throttle == 0.0f)
|
||||
break;
|
||||
float thr = customMotorMixer(i)->throttle;
|
||||
float roll = customMotorMixer(i)->roll;
|
||||
float pitch = customMotorMixer(i)->pitch;
|
||||
float yaw = customMotorMixer(i)->yaw;
|
||||
float thrDefault = defaultCustomMotorMixer[i].throttle;
|
||||
float rollDefault = defaultCustomMotorMixer[i].roll;
|
||||
float pitchDefault = defaultCustomMotorMixer[i].pitch;
|
||||
float yawDefault = defaultCustomMotorMixer[i].yaw;
|
||||
const bool equalsDefault = thr == thrDefault && roll == rollDefault && pitch == pitchDefault && yaw == yawDefault;
|
||||
const float thr = customMotorMixer[i].throttle;
|
||||
const float roll = customMotorMixer[i].roll;
|
||||
const float pitch = customMotorMixer[i].pitch;
|
||||
const float yaw = customMotorMixer[i].yaw;
|
||||
bool equalsDefault = true;
|
||||
if (defaultCustomMotorMixer) {
|
||||
const float thrDefault = defaultCustomMotorMixer[i].throttle;
|
||||
const float rollDefault = defaultCustomMotorMixer[i].roll;
|
||||
const float pitchDefault = defaultCustomMotorMixer[i].pitch;
|
||||
const float yawDefault = defaultCustomMotorMixer[i].yaw;
|
||||
const bool equalsDefault = thr == thrDefault && roll == rollDefault && pitch == pitchDefault && yaw == yawDefault;
|
||||
|
||||
const char *format = "mmix %d %s %s %s %s\r\n";
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
ftoa(thrDefault, buf0),
|
||||
ftoa(rollDefault, buf1),
|
||||
ftoa(pitchDefault, buf2),
|
||||
ftoa(yawDefault, buf3));
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
ftoa(thrDefault, buf0),
|
||||
ftoa(rollDefault, buf1),
|
||||
ftoa(pitchDefault, buf2),
|
||||
ftoa(yawDefault, buf3));
|
||||
}
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
ftoa(thr, buf0),
|
||||
|
|
@ -1617,7 +1628,7 @@ static void cliMotorMix(char *cmdline)
|
|||
char *ptr;
|
||||
|
||||
if (isEmpty(cmdline)) {
|
||||
printMotorMix(DUMP_MASTER, NULL);
|
||||
printMotorMix(DUMP_MASTER, customMotorMixer(0), NULL);
|
||||
} else if (strncasecmp(cmdline, "reset", 5) == 0) {
|
||||
// erase custom mixer
|
||||
for (uint32_t i = 0; i < MAX_SUPPORTED_MOTORS; i++)
|
||||
|
|
@ -1666,7 +1677,7 @@ static void cliMotorMix(char *cmdline)
|
|||
if (check != 4) {
|
||||
cliShowParseError();
|
||||
} else {
|
||||
printMotorMix(DUMP_MASTER, NULL);
|
||||
printMotorMix(DUMP_MASTER, customMotorMixer(0), NULL);
|
||||
}
|
||||
} else {
|
||||
cliShowArgumentRangeError("index", 0, MAX_SUPPORTED_MOTORS - 1);
|
||||
|
|
@ -1675,22 +1686,22 @@ static void cliMotorMix(char *cmdline)
|
|||
#endif
|
||||
}
|
||||
|
||||
static void printRxRange(uint8_t dumpMask, const rxConfig_t *defaultRxConfig)
|
||||
static void printRxRange(uint8_t dumpMask, const rxConfig_t *rxConfig, const rxConfig_t *defaultRxConfig)
|
||||
{
|
||||
const rxChannelRangeConfiguration_t *channelRangeConfiguration;
|
||||
const rxChannelRangeConfiguration_t *channelRangeConfigurationDefault;
|
||||
bool equalsDefault;
|
||||
const char *format = "rxrange %u %u %u\r\n";
|
||||
for (uint32_t i = 0; i < NON_AUX_CHANNEL_COUNT; i++) {
|
||||
channelRangeConfiguration = &rxConfig()->channelRanges[i];
|
||||
channelRangeConfigurationDefault = &defaultRxConfig->channelRanges[i];
|
||||
equalsDefault = channelRangeConfiguration->min == channelRangeConfigurationDefault->min
|
||||
&& channelRangeConfiguration->max == channelRangeConfigurationDefault->max;
|
||||
const char *format = "rxrange %u %u %u\r\n";
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
channelRangeConfigurationDefault->min,
|
||||
channelRangeConfigurationDefault->max
|
||||
);
|
||||
const rxChannelRangeConfiguration_t *channelRangeConfiguration = &rxConfig->channelRanges[i];
|
||||
bool equalsDefault = true;
|
||||
if (defaultRxConfig) {
|
||||
const rxChannelRangeConfiguration_t *channelRangeConfigurationDefault = &defaultRxConfig->channelRanges[i];
|
||||
equalsDefault = channelRangeConfiguration->min == channelRangeConfigurationDefault->min
|
||||
&& channelRangeConfiguration->max == channelRangeConfigurationDefault->max;
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
channelRangeConfigurationDefault->min,
|
||||
channelRangeConfigurationDefault->max
|
||||
);
|
||||
}
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
channelRangeConfiguration->min,
|
||||
|
|
@ -1705,7 +1716,7 @@ static void cliRxRange(char *cmdline)
|
|||
char *ptr;
|
||||
|
||||
if (isEmpty(cmdline)) {
|
||||
printRxRange(DUMP_MASTER, NULL);
|
||||
printRxRange(DUMP_MASTER, rxConfig(), NULL);
|
||||
} else if (strcasecmp(cmdline, "reset") == 0) {
|
||||
resetAllRxChannelRangeConfigurations(rxConfig()->channelRanges);
|
||||
} else {
|
||||
|
|
@ -1742,20 +1753,21 @@ static void cliRxRange(char *cmdline)
|
|||
}
|
||||
|
||||
#ifdef LED_STRIP
|
||||
static void printLed(uint8_t dumpMask, const ledStripConfig_t *defaultLedStripConfig)
|
||||
static void printLed(uint8_t dumpMask, const ledConfig_t *ledConfigs, const ledConfig_t *defaultLedConfigs)
|
||||
{
|
||||
ledConfig_t ledConfig;
|
||||
ledConfig_t ledConfigDefault;
|
||||
const char *format = "led %u %s\r\n";
|
||||
char ledConfigBuffer[20];
|
||||
char ledConfigDefaultBuffer[20];
|
||||
for (uint32_t i = 0; i < LED_MAX_STRIP_LENGTH; i++) {
|
||||
ledConfig = ledStripConfig()->ledConfigs[i];
|
||||
ledConfigDefault = defaultLedStripConfig->ledConfigs[i];
|
||||
const bool equalsDefault = ledConfig == ledConfigDefault;
|
||||
ledConfig_t ledConfig = ledConfigs[i];
|
||||
generateLedConfig(&ledConfig, ledConfigBuffer, sizeof(ledConfigBuffer));
|
||||
generateLedConfig(&ledConfigDefault, ledConfigDefaultBuffer, sizeof(ledConfigDefaultBuffer));
|
||||
const char *format = "led %u %s\r\n";
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format, i, ledConfigDefaultBuffer);
|
||||
bool equalsDefault = true;
|
||||
if (defaultLedConfigs) {
|
||||
ledConfig_t ledConfigDefault = defaultLedConfigs[i];
|
||||
equalsDefault = ledConfig == ledConfigDefault;
|
||||
generateLedConfig(&ledConfigDefault, ledConfigDefaultBuffer, sizeof(ledConfigDefaultBuffer));
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format, i, ledConfigDefaultBuffer);
|
||||
}
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format, i, ledConfigBuffer);
|
||||
}
|
||||
}
|
||||
|
|
@ -1766,7 +1778,7 @@ static void cliLed(char *cmdline)
|
|||
char *ptr;
|
||||
|
||||
if (isEmpty(cmdline)) {
|
||||
printLed(DUMP_MASTER, NULL);
|
||||
printLed(DUMP_MASTER, ledStripConfig()->ledConfigs, NULL);
|
||||
} else {
|
||||
ptr = cmdline;
|
||||
i = atoi(ptr);
|
||||
|
|
@ -1781,27 +1793,20 @@ static void cliLed(char *cmdline)
|
|||
}
|
||||
}
|
||||
|
||||
static void printColor(uint8_t dumpMask, const ledStripConfig_t *defaultLedStripConfig)
|
||||
static void printColor(uint8_t dumpMask, const hsvColor_t *colors, const hsvColor_t *defaultColors)
|
||||
{
|
||||
const char *format = "color %u %d,%u,%u\r\n";
|
||||
for (uint32_t i = 0; i < LED_CONFIGURABLE_COLOR_COUNT; i++) {
|
||||
const hsvColor_t *color = &ledStripConfig()->colors[i];
|
||||
const hsvColor_t *colorDefault = &defaultLedStripConfig->colors[i];
|
||||
const bool equalsDefault = color->h == colorDefault->h
|
||||
&& color->s == colorDefault->s
|
||||
&& color->v == colorDefault->v;
|
||||
const char *format = "color %u %d,%u,%u\r\n";
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
colorDefault->h,
|
||||
colorDefault->s,
|
||||
colorDefault->v
|
||||
);
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
color->h,
|
||||
color->s,
|
||||
color->v
|
||||
);
|
||||
const hsvColor_t *color = &colors[i];
|
||||
bool equalsDefault = true;
|
||||
if (defaultColors) {
|
||||
const hsvColor_t *colorDefault = &defaultColors[i];
|
||||
equalsDefault = color->h == colorDefault->h
|
||||
&& color->s == colorDefault->s
|
||||
&& color->v == colorDefault->v;
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format, i,colorDefault->h, colorDefault->s, colorDefault->v);
|
||||
}
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format, i, color->h, color->s, color->v);
|
||||
}
|
||||
}
|
||||
|
||||
|
|
@ -1811,7 +1816,7 @@ static void cliColor(char *cmdline)
|
|||
char *ptr;
|
||||
|
||||
if (isEmpty(cmdline)) {
|
||||
printColor(DUMP_MASTER, NULL);
|
||||
printColor(DUMP_MASTER, ledStripConfig()->colors, NULL);
|
||||
} else {
|
||||
ptr = cmdline;
|
||||
i = atoi(ptr);
|
||||
|
|
@ -1826,36 +1831,47 @@ static void cliColor(char *cmdline)
|
|||
}
|
||||
}
|
||||
|
||||
static void printModeColor(uint8_t dumpMask, const ledStripConfig_t *defaultLedStripConfig)
|
||||
static void printModeColor(uint8_t dumpMask, const ledStripConfig_t *ledStripConfig, const ledStripConfig_t *defaultLedStripConfig)
|
||||
{
|
||||
const char *format = "mode_color %u %u %u\r\n";
|
||||
for (uint32_t i = 0; i < LED_MODE_COUNT; i++) {
|
||||
for (uint32_t j = 0; j < LED_DIRECTION_COUNT; j++) {
|
||||
int colorIndex = ledStripConfig()->modeColors[i].color[j];
|
||||
int colorIndexDefault = defaultLedStripConfig->modeColors[i].color[j];
|
||||
const char *format = "mode_color %u %u %u\r\n";
|
||||
cliDefaultPrintf(dumpMask, colorIndex == colorIndexDefault, format, i, j, colorIndexDefault);
|
||||
cliDumpPrintf(dumpMask, colorIndex == colorIndexDefault, format, i, j, colorIndex);
|
||||
int colorIndex = ledStripConfig->modeColors[i].color[j];
|
||||
bool equalsDefault = true;
|
||||
if (defaultLedStripConfig) {
|
||||
int colorIndexDefault = defaultLedStripConfig->modeColors[i].color[j];
|
||||
equalsDefault = colorIndex == colorIndexDefault;
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format, i, j, colorIndexDefault);
|
||||
}
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format, i, j, colorIndex);
|
||||
}
|
||||
}
|
||||
|
||||
const char *format = "mode_color %u %u %u\r\n";
|
||||
for (uint32_t j = 0; j < LED_SPECIAL_COLOR_COUNT; j++) {
|
||||
int colorIndex = ledStripConfig()->specialColors.color[j];
|
||||
int colorIndexDefault = defaultLedStripConfig->specialColors.color[j];
|
||||
cliDefaultPrintf(dumpMask, colorIndex == colorIndexDefault, format, LED_SPECIAL, j, colorIndexDefault);
|
||||
cliDumpPrintf(dumpMask, colorIndex == colorIndexDefault, format, LED_SPECIAL, j, colorIndex);
|
||||
const int colorIndex = ledStripConfig->specialColors.color[j];
|
||||
bool equalsDefault = true;
|
||||
if (defaultLedStripConfig) {
|
||||
const int colorIndexDefault = defaultLedStripConfig->specialColors.color[j];
|
||||
equalsDefault = colorIndex == colorIndexDefault;
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format, LED_SPECIAL, j, colorIndexDefault);
|
||||
}
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format, LED_SPECIAL, j, colorIndex);
|
||||
}
|
||||
|
||||
int ledStripAuxChannel = ledStripConfig()->ledstrip_aux_channel;
|
||||
int ledStripAuxChannelDefault = defaultLedStripConfig->ledstrip_aux_channel;
|
||||
cliDefaultPrintf(dumpMask, ledStripAuxChannel == ledStripAuxChannelDefault, format, LED_AUX_CHANNEL, 0, ledStripAuxChannelDefault);
|
||||
cliDumpPrintf(dumpMask, ledStripAuxChannel == ledStripAuxChannelDefault, format, LED_AUX_CHANNEL, 0, ledStripAuxChannel);
|
||||
const int ledStripAuxChannel = ledStripConfig->ledstrip_aux_channel;
|
||||
bool equalsDefault = true;
|
||||
if (defaultLedStripConfig) {
|
||||
const int ledStripAuxChannelDefault = defaultLedStripConfig->ledstrip_aux_channel;
|
||||
equalsDefault = ledStripAuxChannel == ledStripAuxChannelDefault;
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format, LED_AUX_CHANNEL, 0, ledStripAuxChannelDefault);
|
||||
}
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format, LED_AUX_CHANNEL, 0, ledStripAuxChannel);
|
||||
}
|
||||
|
||||
static void cliModeColor(char *cmdline)
|
||||
{
|
||||
if (isEmpty(cmdline)) {
|
||||
printModeColor(DUMP_MASTER, NULL);
|
||||
printModeColor(DUMP_MASTER, ledStripConfig(), NULL);
|
||||
} else {
|
||||
enum {MODE = 0, FUNCTION, COLOR, ARGS_COUNT};
|
||||
int args[ARGS_COUNT];
|
||||
|
|
@ -1888,26 +1904,29 @@ static void cliModeColor(char *cmdline)
|
|||
static void printServo(uint8_t dumpMask, servoProfile_t *defaultServoProfile)
|
||||
{
|
||||
// print out servo settings
|
||||
const char *format = "servo %u %d %d %d %d %d %d %d\r\n";
|
||||
for (uint32_t i = 0; i < MAX_SUPPORTED_SERVOS; i++) {
|
||||
const servoParam_t *servoConf = &servoProfile()->servoConf[i];
|
||||
const servoParam_t *servoConfDefault = &defaultServoProfile->servoConf[i];
|
||||
const bool equalsDefault = servoConf->min == servoConfDefault->min
|
||||
&& servoConf->max == servoConfDefault->max
|
||||
&& servoConf->middle == servoConfDefault->middle
|
||||
&& servoConf->angleAtMin == servoConfDefault->angleAtMax
|
||||
&& servoConf->rate == servoConfDefault->rate
|
||||
&& servoConf->forwardFromChannel == servoConfDefault->forwardFromChannel;
|
||||
const char *format = "servo %u %d %d %d %d %d %d %d\r\n";
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
servoConfDefault->min,
|
||||
servoConfDefault->max,
|
||||
servoConfDefault->middle,
|
||||
servoConfDefault->angleAtMin,
|
||||
servoConfDefault->angleAtMax,
|
||||
servoConfDefault->rate,
|
||||
servoConfDefault->forwardFromChannel
|
||||
);
|
||||
bool equalsDefault = true;
|
||||
if (defaultServoProfile) {
|
||||
const servoParam_t *servoConfDefault = &defaultServoProfile->servoConf[i];
|
||||
equalsDefault = servoConf->min == servoConfDefault->min
|
||||
&& servoConf->max == servoConfDefault->max
|
||||
&& servoConf->middle == servoConfDefault->middle
|
||||
&& servoConf->angleAtMin == servoConfDefault->angleAtMax
|
||||
&& servoConf->rate == servoConfDefault->rate
|
||||
&& servoConf->forwardFromChannel == servoConfDefault->forwardFromChannel;
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
servoConfDefault->min,
|
||||
servoConfDefault->max,
|
||||
servoConfDefault->middle,
|
||||
servoConfDefault->angleAtMin,
|
||||
servoConfDefault->angleAtMax,
|
||||
servoConfDefault->rate,
|
||||
servoConfDefault->forwardFromChannel
|
||||
);
|
||||
}
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
servoConf->min,
|
||||
|
|
@ -2001,32 +2020,35 @@ static void cliServo(char *cmdline)
|
|||
#ifdef USE_SERVOS
|
||||
static void printServoMix(uint8_t dumpMask, const master_t *defaultConfig)
|
||||
{
|
||||
const char *format = "smix %d %d %d %d %d %d %d %d\r\n";
|
||||
for (uint32_t i = 0; i < MAX_SERVO_RULES; i++) {
|
||||
servoMixer_t customServoMixer = *customServoMixer(i);
|
||||
servoMixer_t customServoMixerDefault = defaultConfig->customServoMixer[i];
|
||||
if (customServoMixer.rate == 0) {
|
||||
break;
|
||||
}
|
||||
|
||||
const bool equalsDefault = customServoMixer.targetChannel == customServoMixerDefault.targetChannel
|
||||
&& customServoMixer.inputSource == customServoMixerDefault.inputSource
|
||||
&& customServoMixer.rate == customServoMixerDefault.rate
|
||||
&& customServoMixer.speed == customServoMixerDefault.speed
|
||||
&& customServoMixer.min == customServoMixerDefault.min
|
||||
&& customServoMixer.max == customServoMixerDefault.max
|
||||
&& customServoMixer.box == customServoMixerDefault.box;
|
||||
bool equalsDefault = true;
|
||||
if (defaultConfig) {
|
||||
servoMixer_t customServoMixerDefault = defaultConfig->customServoMixer[i];
|
||||
equalsDefault = customServoMixer.targetChannel == customServoMixerDefault.targetChannel
|
||||
&& customServoMixer.inputSource == customServoMixerDefault.inputSource
|
||||
&& customServoMixer.rate == customServoMixerDefault.rate
|
||||
&& customServoMixer.speed == customServoMixerDefault.speed
|
||||
&& customServoMixer.min == customServoMixerDefault.min
|
||||
&& customServoMixer.max == customServoMixerDefault.max
|
||||
&& customServoMixer.box == customServoMixerDefault.box;
|
||||
|
||||
const char *format = "smix %d %d %d %d %d %d %d %d\r\n";
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
customServoMixerDefault.targetChannel,
|
||||
customServoMixerDefault.inputSource,
|
||||
customServoMixerDefault.rate,
|
||||
customServoMixerDefault.speed,
|
||||
customServoMixerDefault.min,
|
||||
customServoMixerDefault.max,
|
||||
customServoMixerDefault.box
|
||||
);
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
customServoMixerDefault.targetChannel,
|
||||
customServoMixerDefault.inputSource,
|
||||
customServoMixerDefault.rate,
|
||||
customServoMixerDefault.speed,
|
||||
customServoMixerDefault.min,
|
||||
customServoMixerDefault.max,
|
||||
customServoMixerDefault.box
|
||||
);
|
||||
}
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
customServoMixer.targetChannel,
|
||||
|
|
@ -2043,17 +2065,25 @@ static void printServoMix(uint8_t dumpMask, const master_t *defaultConfig)
|
|||
|
||||
// print servo directions
|
||||
for (uint32_t i = 0; i < MAX_SUPPORTED_SERVOS; i++) {
|
||||
const char *format = "smix reverse %d %d r\r\n";
|
||||
const servoParam_t *servoConf = &servoProfile()->servoConf[i];
|
||||
const servoParam_t *servoConfDefault = &defaultConfig->servoProfile.servoConf[i];
|
||||
bool equalsDefault = servoConf->reversedSources == servoConfDefault->reversedSources;
|
||||
for (uint32_t channel = 0; channel < INPUT_SOURCE_COUNT; channel++) {
|
||||
equalsDefault = ~(servoConf->reversedSources ^ servoConfDefault->reversedSources) & (1 << channel);
|
||||
const char *format = "smix reverse %d %d r\r\n";
|
||||
if (servoConfDefault->reversedSources & (1 << channel)) {
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format, i , channel);
|
||||
if (defaultConfig) {
|
||||
const servoParam_t *servoConfDefault = &defaultConfig->servoProfile.servoConf[i];
|
||||
bool equalsDefault = servoConf->reversedSources == servoConfDefault->reversedSources;
|
||||
for (uint32_t channel = 0; channel < INPUT_SOURCE_COUNT; channel++) {
|
||||
equalsDefault = ~(servoConf->reversedSources ^ servoConfDefault->reversedSources) & (1 << channel);
|
||||
if (servoConfDefault->reversedSources & (1 << channel)) {
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format, i , channel);
|
||||
}
|
||||
if (servoConf->reversedSources & (1 << channel)) {
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format, i , channel);
|
||||
}
|
||||
}
|
||||
if (servoConf->reversedSources & (1 << channel)) {
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format, i , channel);
|
||||
} else {
|
||||
for (uint32_t channel = 0; channel < INPUT_SOURCE_COUNT; channel++) {
|
||||
if (servoConf->reversedSources & (1 << channel)) {
|
||||
cliDumpPrintf(dumpMask, true, format, i , channel);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
|
@ -2344,26 +2374,26 @@ static void cliFlashRead(char *cmdline)
|
|||
static void printVtx(uint8_t dumpMask, const master_t *defaultConfig)
|
||||
{
|
||||
// print out vtx channel settings
|
||||
vtxChannelActivationCondition_t *cac;
|
||||
vtxChannelActivationCondition_t *cacDefault;
|
||||
bool equalsDefault;
|
||||
const char *format = "vtx %u %u %u %u %u %u\r\n";
|
||||
bool equalsDefault = true;
|
||||
for (uint32_t i = 0; i < MAX_CHANNEL_ACTIVATION_CONDITION_COUNT; i++) {
|
||||
cac = &masterConfig.vtxChannelActivationConditions[i];
|
||||
cacDefault = &defaultConfig->vtxChannelActivationConditions[i];
|
||||
equalsDefault = cac->auxChannelIndex == cacDefault->auxChannelIndex
|
||||
&& cac->band == cacDefault->band
|
||||
&& cac->channel == cacDefault->channel
|
||||
&& cac->range.startStep == cacDefault->range.startStep
|
||||
&& cac->range.endStep == cacDefault->range.endStep;
|
||||
const char *format = "vtx %u %u %u %u %u %u\r\n";
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
cacDefault->auxChannelIndex,
|
||||
cacDefault->band,
|
||||
cacDefault->channel,
|
||||
MODE_STEP_TO_CHANNEL_VALUE(cacDefault->range.startStep),
|
||||
MODE_STEP_TO_CHANNEL_VALUE(cacDefault->range.endStep)
|
||||
);
|
||||
const vtxChannelActivationCondition_t *cac = &masterConfig.vtxChannelActivationConditions[i];
|
||||
if (defaultConfig) {
|
||||
const vtxChannelActivationCondition_t *cacDefault = &defaultConfig->vtxChannelActivationConditions[i];
|
||||
equalsDefault = cac->auxChannelIndex == cacDefault->auxChannelIndex
|
||||
&& cac->band == cacDefault->band
|
||||
&& cac->channel == cacDefault->channel
|
||||
&& cac->range.startStep == cacDefault->range.startStep
|
||||
&& cac->range.endStep == cacDefault->range.endStep;
|
||||
cliDefaultPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
cacDefault->auxChannelIndex,
|
||||
cacDefault->band,
|
||||
cacDefault->channel,
|
||||
MODE_STEP_TO_CHANNEL_VALUE(cacDefault->range.startStep),
|
||||
MODE_STEP_TO_CHANNEL_VALUE(cacDefault->range.endStep)
|
||||
);
|
||||
}
|
||||
cliDumpPrintf(dumpMask, equalsDefault, format,
|
||||
i,
|
||||
cac->auxChannelIndex,
|
||||
|
|
@ -2617,16 +2647,18 @@ static void cliBeeper(char *cmdline)
|
|||
}
|
||||
#endif
|
||||
|
||||
static void printMap(uint8_t dumpMask, const rxConfig_t *defaultRxConfig)
|
||||
static void printMap(uint8_t dumpMask, const rxConfig_t *rxConfig, const rxConfig_t *defaultRxConfig)
|
||||
{
|
||||
bool equalsDefault = true;
|
||||
char buf[16];
|
||||
char bufDefault[16];
|
||||
uint32_t i;
|
||||
for (i = 0; i < MAX_MAPPABLE_RX_INPUTS; i++) {
|
||||
buf[rxConfig()->rcmap[i]] = rcChannelLetters[i];
|
||||
bufDefault[defaultRxConfig->rcmap[i]] = rcChannelLetters[i];
|
||||
equalsDefault = equalsDefault && (rxConfig()->rcmap[i] == defaultRxConfig->rcmap[i]);
|
||||
buf[rxConfig->rcmap[i]] = rcChannelLetters[i];
|
||||
if (defaultRxConfig) {
|
||||
bufDefault[defaultRxConfig->rcmap[i]] = rcChannelLetters[i];
|
||||
equalsDefault = equalsDefault && (rxConfig->rcmap[i] == defaultRxConfig->rcmap[i]);
|
||||
}
|
||||
}
|
||||
buf[i] = '\0';
|
||||
|
||||
|
|
@ -2811,7 +2843,7 @@ static void printConfig(char *cmdline, bool doDiff)
|
|||
|
||||
cliDumpPrintf(dumpMask, masterConfig.customMotorMixer[0].throttle == 0.0f, "\r\nmmix reset\r\n\r\n");
|
||||
|
||||
printMotorMix(dumpMask, defaultConfig.customMotorMixer);
|
||||
printMotorMix(dumpMask, customMotorMixer(0), defaultConfig.customMotorMixer);
|
||||
|
||||
#ifdef USE_SERVOS
|
||||
cliPrintHashLine("servo");
|
||||
|
|
@ -2833,30 +2865,30 @@ static void printConfig(char *cmdline, bool doDiff)
|
|||
#endif
|
||||
|
||||
cliPrintHashLine("map");
|
||||
printMap(dumpMask, &defaultConfig.rxConfig);
|
||||
printMap(dumpMask, rxConfig(), &defaultConfig.rxConfig);
|
||||
|
||||
cliPrintHashLine("serial");
|
||||
printSerial(dumpMask, &defaultConfig.serialConfig);
|
||||
printSerial(dumpMask, serialConfig(), &defaultConfig.serialConfig);
|
||||
|
||||
#ifdef LED_STRIP
|
||||
cliPrintHashLine("led");
|
||||
printLed(dumpMask, &defaultConfig.ledStripConfig);
|
||||
printLed(dumpMask, ledStripConfig()->ledConfigs, defaultConfig.ledStripConfig.ledConfigs);
|
||||
|
||||
cliPrintHashLine("color");
|
||||
printColor(dumpMask, &defaultConfig.ledStripConfig);
|
||||
printColor(dumpMask, ledStripConfig()->colors, defaultConfig.ledStripConfig.colors);
|
||||
|
||||
cliPrintHashLine("mode_color");
|
||||
printModeColor(dumpMask, &defaultConfig.ledStripConfig);
|
||||
printModeColor(dumpMask, ledStripConfig(), &defaultConfig.ledStripConfig);
|
||||
#endif
|
||||
|
||||
cliPrintHashLine("aux");
|
||||
printAux(dumpMask, &defaultConfig.modeActivationProfile);
|
||||
printAux(dumpMask, modeActivationProfile(), &defaultConfig.modeActivationProfile);
|
||||
|
||||
cliPrintHashLine("adjrange");
|
||||
printAdjustmentRange(dumpMask, &defaultConfig.adjustmentProfile);
|
||||
printAdjustmentRange(dumpMask, adjustmentProfile(), &defaultConfig.adjustmentProfile);
|
||||
|
||||
cliPrintHashLine("rxrange");
|
||||
printRxRange(dumpMask, &defaultConfig.rxConfig);
|
||||
printRxRange(dumpMask, rxConfig(), &defaultConfig.rxConfig);
|
||||
|
||||
#ifdef VTX
|
||||
cliPrintHashLine("vtx");
|
||||
|
|
@ -2864,7 +2896,7 @@ static void printConfig(char *cmdline, bool doDiff)
|
|||
#endif
|
||||
|
||||
cliPrintHashLine("rxfail");
|
||||
printRxFail(dumpMask, &defaultConfig.rxConfig);
|
||||
printRxFail(dumpMask, rxConfig(), &defaultConfig.rxConfig);
|
||||
|
||||
cliPrintHashLine("master");
|
||||
dumpValues(MASTER_VALUE, dumpMask, &defaultConfig);
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue