Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-19 14:25:20 +03:00
Code Issues Wiki Activity

Fixed review comments

Browse source
This commit is contained in:
Bas Delfos 2016-11-23 23:51:57 +01:00
parent 1561481e52
commit 036c7d0c89
1 changed files with 5 additions and 4 deletions
Download patch file Download diff file Expand all files Collapse all files

9
src/main/sensors/esc_sensor.c
View file

@ -91,6 +91,7 @@ static esc_telemetry_t escSensorData[MAX_SUPPORTED_MOTORS];
static uint32_t escTriggerTimestamp = -1; static uint32_t escTriggerTimestamp = -1;
static uint32_t escTriggerLastTimestamp = -1; static uint32_t escTriggerLastTimestamp = -1;
static uint8_t timeoutRetryCount = 0; static uint8_t timeoutRetryCount = 0;
static uint8_t totalRetryCount = 0;
static uint8_t escSensorMotor = 0; // motor index static uint8_t escSensorMotor = 0; // motor index
static bool escSensorEnabled = false; static bool escSensorEnabled = false;
@ -218,7 +219,7 @@ void escSensorProcess(timeUs_t currentTimeUs)
escTriggerLastTimestamp = escTriggerTimestamp; escTriggerLastTimestamp = escTriggerTimestamp;
} }
else if (escSensorTriggerState == ESC_SENSOR_TRIGGER_READY) { else if (escSensorTriggerState == ESC_SENSOR_TRIGGER_READY) {
if (debugMode == DEBUG_ESC_SENSOR) debug[0] = escSensorMotor+1; DEBUG_SET(DEBUG_ESC_SENSOR, 0, escSensorMotor+1);
motorDmaOutput_t * const motor = getMotorDmaOutput(escSensorMotor); motorDmaOutput_t * const motor = getMotorDmaOutput(escSensorMotor);
motor->requestTelemetry = true; motor->requestTelemetry = true;
@ -237,7 +238,7 @@ void escSensorProcess(timeUs_t currentTimeUs)
selectNextMotor(); selectNextMotor();
} }
if (debugMode == DEBUG_ESC_SENSOR) debug[1]++; DEBUG_SET(DEBUG_ESC_SENSOR, 1, ++totalRetryCount);
} }
// Get received frame status // Get received frame status
@ -259,8 +260,8 @@ void escSensorProcess(timeUs_t currentTimeUs)
} }
} }
if (debugMode == DEBUG_ESC_SENSOR) debug[2] = escVbat; DEBUG_SET(DEBUG_ESC_SENSOR, 2, escVbat);
if (debugMode == DEBUG_ESC_SENSOR) debug[3] = escCurrent; DEBUG_SET(DEBUG_ESC_SENSOR, 3, escCurrent);
selectNextMotor(); selectNextMotor();
escSensorTriggerState = ESC_SENSOR_TRIGGER_READY; escSensorTriggerState = ESC_SENSOR_TRIGGER_READY;