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

Added src as argument to the macro

Browse source
This commit is contained in:
Bas Delfos 2017-07-14 17:11:51 +02:00
parent 79c13673be
commit 3c8880d781
1 changed files with 13 additions and 13 deletions
Download patch file Download diff file Expand all files Collapse all files

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

@ -115,7 +115,7 @@
#define STATIC_ASSERT(condition, name) \
typedef char assert_failed_ ## name [(condition) ? 1 : -1 ] __attribute__((unused))
#define BYTES_REMAINING_GTE(num) \
#define BYTES_REMAINING_GTE(src, num) \
sbufBytesRemaining(src) >= num
static const char * const flightControllerIdentifier = BETAFLIGHT_IDENTIFIER; // 4 UPPER CASE alpha numeric characters that identify the flight controller.
@ -1600,7 +1600,7 @@ static mspResult_e mspFcProcessInCommand(uint8_t cmdMSP, sbuf_t *src)
break;
case MSP_SET_RC_TUNING:
if (BYTES_REMAINING_GTE(10)) {
if (BYTES_REMAINING_GTE(src, 10)) {
currentControlRateProfile->rcRate8 = sbufReadU8(src);
currentControlRateProfile->rcExpo8 = sbufReadU8(src);
for (int i = 0; i < 3; i++) {
@ -1612,10 +1612,10 @@ static mspResult_e mspFcProcessInCommand(uint8_t cmdMSP, sbuf_t *src)
currentControlRateProfile->thrMid8 = sbufReadU8(src);
currentControlRateProfile->thrExpo8 = sbufReadU8(src);
currentControlRateProfile->tpa_breakpoint = sbufReadU16(src);
if (BYTES_REMAINING_GTE(1)) {
if (BYTES_REMAINING_GTE(src, 1)) {
currentControlRateProfile->rcYawExpo8 = sbufReadU8(src);
}
if (BYTES_REMAINING_GTE(1)) {
if (BYTES_REMAINING_GTE(src, 1)) {
currentControlRateProfile->rcYawRate8 = sbufReadU8(src);
}
generateThrottleCurve();
@ -1741,17 +1741,17 @@ static mspResult_e mspFcProcessInCommand(uint8_t cmdMSP, sbuf_t *src)
gyroConfigMutable()->gyro_soft_lpf_hz = sbufReadU8(src);
currentPidProfile->dterm_lpf_hz = sbufReadU16(src);
currentPidProfile->yaw_lpf_hz = sbufReadU16(src);
if (BYTES_REMAINING_GTE(8)) {
if (BYTES_REMAINING_GTE(src, 8)) {
gyroConfigMutable()->gyro_soft_notch_hz_1 = sbufReadU16(src);
gyroConfigMutable()->gyro_soft_notch_cutoff_1 = sbufReadU16(src);
currentPidProfile->dterm_notch_hz = sbufReadU16(src);
currentPidProfile->dterm_notch_cutoff = sbufReadU16(src);
}
if (BYTES_REMAINING_GTE(4)) {
if (BYTES_REMAINING_GTE(src, 4)) {
gyroConfigMutable()->gyro_soft_notch_hz_2 = sbufReadU16(src);
gyroConfigMutable()->gyro_soft_notch_cutoff_2 = sbufReadU16(src);
}
if (BYTES_REMAINING_GTE(1)) {
if (BYTES_REMAINING_GTE(src, 1)) {
currentPidProfile->dterm_filter_type = sbufReadU8(src);
}
// reinitialize the gyro filters with the new values
@ -1774,11 +1774,11 @@ static mspResult_e mspFcProcessInCommand(uint8_t cmdMSP, sbuf_t *src)
sbufReadU8(src); // reserved
currentPidProfile->rateAccelLimit = sbufReadU16(src);
currentPidProfile->yawRateAccelLimit = sbufReadU16(src);
if (BYTES_REMAINING_GTE(2)) {
if (BYTES_REMAINING_GTE(src, 2)) {
currentPidProfile->levelAngleLimit = sbufReadU8(src);
currentPidProfile->levelSensitivity = sbufReadU8(src);
}
if (BYTES_REMAINING_GTE(4)) {
if (BYTES_REMAINING_GTE(src, 4)) {
currentPidProfile->itermThrottleThreshold = sbufReadU16(src);
currentPidProfile->itermAcceleratorGain = sbufReadU16(src);
}
@ -1931,21 +1931,21 @@ static mspResult_e mspFcProcessInCommand(uint8_t cmdMSP, sbuf_t *src)
rxConfigMutable()->midrc = sbufReadU16(src);
rxConfigMutable()->mincheck = sbufReadU16(src);
rxConfigMutable()->spektrum_sat_bind = sbufReadU8(src);
if (BYTES_REMAINING_GTE(4)) {
if (BYTES_REMAINING_GTE(src, 4)) {
rxConfigMutable()->rx_min_usec = sbufReadU16(src);
rxConfigMutable()->rx_max_usec = sbufReadU16(src);
}
if (BYTES_REMAINING_GTE(4)) {
if (BYTES_REMAINING_GTE(src, 4)) {
rxConfigMutable()->rcInterpolation = sbufReadU8(src);
rxConfigMutable()->rcInterpolationInterval = sbufReadU8(src);
rxConfigMutable()->airModeActivateThreshold = sbufReadU16(src);
}
if (BYTES_REMAINING_GTE(6)) {
if (BYTES_REMAINING_GTE(src, 6)) {
rxConfigMutable()->rx_spi_protocol = sbufReadU8(src);
rxConfigMutable()->rx_spi_id = sbufReadU32(src);
rxConfigMutable()->rx_spi_rf_channel_count = sbufReadU8(src);
}
if (BYTES_REMAINING_GTE(1)) {
if (BYTES_REMAINING_GTE(src, 1)) {
rxConfigMutable()->fpvCamAngleDegrees = sbufReadU8(src);
}
break;