diff --git a/utilities/at32f421_freertos_demo/src/TaskLoop.c b/utilities/at32f421_freertos_demo/src/TaskLoop.c index 7a977e5..2cb90a0 100644 --- a/utilities/at32f421_freertos_demo/src/TaskLoop.c +++ b/utilities/at32f421_freertos_demo/src/TaskLoop.c @@ -673,12 +673,16 @@ void vd1_task(void) /*--- 2. 稳定期:只跟踪基线,不检测车辆 ---*/ if (!g_loop_stable) { + /* 稳定期内不做斜率限幅和 IIR — 直接用 Value 快速收敛到真实基线 */ + loop1_CAPVD = loop1_Value; + loop1_CAPVD_fast = loop1_Value; + update_moving_average(&loop1_ORG_SUM, &loop1_ORG_CNT, &loop1_Origin, loop1_CAPVD, 100); _stable_cnt++; if (_stable_cnt >= STABLE_SAMPLES) { g_loop_stable = 1; - PRINT("Loop stable, Origin:%d\n", loop1_Origin); + PRINT("Loop stable, Origin:%d\\n", loop1_Origin); } return; }