From fd6ee7984e27ac9485441b34385a446ae2db568a Mon Sep 17 00:00:00 2001 From: wangfq Date: Wed, 2 Sep 2026 14:52:17 +0800 Subject: [PATCH] =?UTF-8?q?fix(DLD110SV4):=20=E5=9F=BA=E7=BA=BF=E8=B7=9F?= =?UTF-8?q?=E8=B8=AA=E5=8F=8C=E5=90=91=E5=AF=B9=E7=A7=B0=E4=BF=9D=E6=8A=A4?= =?UTF-8?q?=E5=90=8C=E6=AD=A5V4B=20V4.20=20=E2=80=94=20=E8=B4=9Fvariation?= =?UTF-8?q?=E9=93=81=E5=9D=97=E9=98=B2Origin=E6=B1=A1=E6=9F=93=E9=94=81?= =?UTF-8?q?=E6=AD=BB?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit 负偏差(dev>0,CAPVD>Origin)只冻结永不超时更新Origin, 对称窗口[-4×dlt,+4×dlt] 与DLD154V4B V4.20修复同构 --- .../APP/peripheral_main.c | 21 ++++++++++++++++--- 1 file changed, 18 insertions(+), 3 deletions(-) diff --git a/BLE/DLD110S_Peripheral_28K/APP/peripheral_main.c b/BLE/DLD110S_Peripheral_28K/APP/peripheral_main.c index 42a64b0..1c2cbc5 100644 --- a/BLE/DLD110S_Peripheral_28K/APP/peripheral_main.c +++ b/BLE/DLD110S_Peripheral_28K/APP/peripheral_main.c @@ -609,12 +609,18 @@ void vd1_task(void){ *================================================================*/ loop1_dlt_ORG = ((uint32_t)loop1_Origin * g_loop_sens_list.sens[g_freq_sens].sens_in) >> 16; { + /* V4B V4.20 同步: 双向对称保护 — 负variation(铁块磁导率)也冻结基线 + * 原单边只挡 dev>+4×dlt, 负variation会把Origin污染抬高 → 离开时假进入 → 锁死不释放 + * 修复: ① 对称窗口 [-4×dlt, +4×dlt] ② 负偏差只冻结永不超时更新 */ int32_t dev = (int32_t)loop1_CAPVD - (int32_t)loop1_Origin; - if (dev < (int32_t)(loop1_dlt_ORG * 4)) { + int32_t freeze_band = (int32_t)(loop1_dlt_ORG * 4); + if (dev < freeze_band && dev > -freeze_band) { + /* 对称窗口内 → 正常基线跟踪 */ loop1_freeze_cnt = 0; + loop1_freeze_ref = 0; update_moving_average(&loop1_ORG_SUM, &loop1_ORG_CNT, &loop1_Origin, loop1_CAPVD, WINDOW_ORIGIN); - } else { - /*--- CAPVD 异常偏高: 暂停跟踪, 冻结超时 + 稳定性双条件 ---*/ + } else if (dev < 0) { + /* 正variation (疑似车) → 冻结, 保留超时兜底更新 */ if (loop1_freeze_cnt == 0) { loop1_freeze_ref = loop1_CAPVD; } else { @@ -633,6 +639,15 @@ void vd1_task(void){ } loop1_ORG_CNT = 0; loop1_ORG_SUM = 0; + } else { + /* 负variation (CAPVD高于Origin, 特殊铁块磁导率主导) → 只冻结, 永不更新 Origin */ + if (loop1_freeze_cnt == 0) { + loop1_freeze_ref = loop1_CAPVD; + } + loop1_freeze_cnt++; + if (loop1_freeze_cnt > FREEZE_TIMEOUT) loop1_freeze_cnt = FREEZE_TIMEOUT; + loop1_ORG_CNT = 0; + loop1_ORG_SUM = 0; } }