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

Simplified PID rate counter code (#5350)

This commit is contained in:
Andrey Mironov 2018-03-04 01:48:22 +03:00 committed by Michael Keller
parent 33ee5efa17
commit 36c3fdb576
1 changed files with 3 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
src/main/fc/fc_core.c
View File

@ -929,7 +929,7 @@ static void subTaskMotorUpdate(timeUs_t currentTimeUs)
// Function for loop trigger
void taskMainPidLoop(timeUs_t currentTimeUs)
{
static uint8_t pidUpdateCountdown = 0;
static uint32_t pidUpdateCounter = 0;
#if defined(SIMULATOR_BUILD) && defined(SIMULATOR_GYROPID_SYNC)
if (lockMainPID() != 0) return;
@ -937,16 +937,13 @@ void taskMainPidLoop(timeUs_t currentTimeUs)
// DEBUG_PIDLOOP, timings for:
// 0 - gyroUpdate()
// 1 - pidController()
// 1 - subTaskPidController()
// 2 - subTaskMotorUpdate()
// 3 - subTaskMainSubprocesses()
gyroUpdate(currentTimeUs);
DEBUG_SET(DEBUG_PIDLOOP, 0, micros() - currentTimeUs);
if (pidUpdateCountdown) {
pidUpdateCountdown--;
} else {
pidUpdateCountdown = pidConfig()->pid_process_denom - 1;
if (pidUpdateCounter++ % pidConfig()->pid_process_denom == 0) {
subTaskPidController(currentTimeUs);
subTaskMotorUpdate(currentTimeUs);
subTaskMainSubprocesses(currentTimeUs);