Exergie/NeoECU-Firmware
2
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

delat macros and crank miss filter

Browse Source
This commit is contained in:
Pierre Barbier
2026-06-03 12:02:17 +02:00
parent bacb144369
commit 31bdeeaf50
2 changed files with 10 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
STM32/CM7/Core/Inc/macros.h
View File

@@ -2,7 +2,7 @@
// Copyright (C) 2026 Pierre Barbier <pierrebarbier741@gmail.com> // Copyright (C) 2026 Pierre Barbier <pierrebarbier741@gmail.com>
// Copyright (C) 2026 Association Exergie <association.exergie@gmail.com> // Copyright (C) 2026 Association Exergie <association.exergie@gmail.com>
// SPDX-License-Identifier: GPL-3.0-or-later // SPDX-License-Identifier: GPL-3.0-or-later
#include "global_state.h"
#ifdef DEBUG #ifdef DEBUG
#include "SEGGER_RTT.h" #include "SEGGER_RTT.h"
#define DEBUG_LOG(fmt, ...) SEGGER_RTT_printf(0, fmt "\n", ##__VA_ARGS__) #define DEBUG_LOG(fmt, ...) SEGGER_RTT_printf(0, fmt "\n", ##__VA_ARGS__)
@@ -13,3 +13,5 @@
#endif #endif
#define CRANK(num) ringBufferRead(&state_g.crank_RB, num) #define CRANK(num) ringBufferRead(&state_g.crank_RB, num)
#define CAM(num) ringBufferRead(&state_g.cam_RB, num) #define CAM(num) ringBufferRead(&state_g.cam_RB, num)
#define D1A CRANK(0)-CRANK(1)
#define D1B CRANK(1)-CRANK(2)

7
STM32/CM7/Core/Src/tasks/crank.c
View File

@@ -4,6 +4,7 @@
// SPDX-License-Identifier: GPL-3.0-or-later // SPDX-License-Identifier: GPL-3.0-or-later
#include "cmsis_os2.h" #include "cmsis_os2.h"
#include "global_state.h"
#include "macros.h" #include "macros.h"
#include "main.h" #include "main.h"
#include "ring_buffer.h" #include "ring_buffer.h"
@@ -16,6 +17,12 @@ void crankHandler(void *argument) {
DEBUG_LOG("Crank pulse detected at: %lu\n\r", DEBUG_LOG("Crank pulse detected at: %lu\n\r",
ringBufferRead(&state_g.crank_RB, 0)); ringBufferRead(&state_g.crank_RB, 0));
// FILTER // FILTER
float delta_percentage = ((float)(D1A - D1B)) / D1B;
if ( delta_percentage> 0.4||delta_percentage < -0.4) {
state_g.sync_state = SYNC_NOT_OK;
state_g.crank_state = CYCLE_UNKNOWN;
continue;
}
// INCREMENT SWITCH // INCREMENT SWITCH
switch (state_g.crank_state) { switch (state_g.crank_state) {
case CYCLE_COMPRESSION: { case CYCLE_COMPRESSION: {