rusefi
/
atbetaflight
mirror of https://github.com/rusefi/atbetaflight.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Fixed review comments

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
Show Stats 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 escTriggerLastTimestamp = -1;
static uint8_t timeoutRetryCount = 0;
static uint8_t totalRetryCount = 0;
static uint8_t escSensorMotor = 0; // motor index
static bool escSensorEnabled = false;
@ -218,7 +219,7 @@ void escSensorProcess(timeUs_t currentTimeUs)
escTriggerLastTimestamp = escTriggerTimestamp;
}
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);
motor->requestTelemetry = true;
@ -237,7 +238,7 @@ void escSensorProcess(timeUs_t currentTimeUs)
selectNextMotor();
}
if (debugMode == DEBUG_ESC_SENSOR) debug[1]++;
DEBUG_SET(DEBUG_ESC_SENSOR, 1, ++totalRetryCount);
}
// Get received frame status
@ -259,8 +260,8 @@ void escSensorProcess(timeUs_t currentTimeUs)
}
}
if (debugMode == DEBUG_ESC_SENSOR) debug[2] = escVbat;
if (debugMode == DEBUG_ESC_SENSOR) debug[3] = escCurrent;
DEBUG_SET(DEBUG_ESC_SENSOR, 2, escVbat);
DEBUG_SET(DEBUG_ESC_SENSOR, 3, escCurrent);
selectNextMotor();
escSensorTriggerState = ESC_SENSOR_TRIGGER_READY;