@@ -20,7 +20,7 @@
|
||||
|
||||
1. **时间主线**：所有时间戳为 64 位毫秒（CPI/GNSS），参与运算时除 1000 转秒；ΔT = 点迹时间 − 航迹时间，ΔT 的正负决定"有效更新 / 只消费不更新 / 跳过"。
|
||||
2. **状态主线**：每条可靠航迹维护一套 IMM（3 个 Singer 模型）状态 [x, vx, ax, y, vy, ay]，x/y 两轴解耦，量测为「距离-方位-径向速度」三维 EKF。
|
||||
3. **生命周期主线**：可靠航迹靠"外推轮数"消亡（判据为 `>`：TWS 普通航迹 6 圈、重点目标 10 圈，TAS 相扫 10 / 机扫 96 圈）；临时航迹靠"缓存圈数 buff_round"消亡。
|
||||
3. **生命周期主线**：可靠航迹的消亡分两种判据——**TWS 普通航迹自 V1.5.8 起按航迹质量**（`Quality < TRACK_DIE_QUALITY` = 0.3），**重点目标按外推轮数**（判据 `> 10`）、**TAS 按外推轮数**（判据 `> 阈值`：相扫 10 / 机扫 96 圈）；临时航迹靠"缓存圈数 buff_round"消亡。
|
||||
|
||||
---
|
||||
|
||||
@@ -74,7 +74,7 @@ flowchart TD
|
||||
flowchart TD
|
||||
A["收到一帧点迹"] --> B{"point_type ?"}
|
||||
B -->|"0 = TWS"| C["写入 TWS 缓存"]
|
||||
C --> D{"方位波位号 Beam_index_aiz == 0 ?"}
|
||||
C --> D{"判圈条件成立 ?<br/>相扫: Beam_index_aiz <= last_beam_num<br/>机扫: Beam_index_aiz == 0"}
|
||||
D -->|"是"| E["return 1：满一圈，执行 TWS 航迹处理"]
|
||||
D -->|"否"| F["return 2：未满圈，仅做滑窗凝聚"]
|
||||
B -->|"1 = TAS"| G["写入 TAS 缓存<br/>记录 TAS 批号与本帧时间戳"]
|
||||
@@ -84,9 +84,10 @@ flowchart TD
|
||||
|
||||
**要点**
|
||||
|
||||
- 判圈条件由"波位号由大变小"改为 **波位号为 0**（7d5a56f），避免机扫转台反转时误判一圈完成（代码中保留了旧判断的注释）。
|
||||
- 波位号 0 是每圈的起始波位，因此**每圈恰好触发一次 model=1**。
|
||||
- 清空（`track_clear_all`）后圈状态复位，下一次调用必然判为"满一圈"。
|
||||
- 判圈条件按扫描体制区分（3e6763c，源码用 `#ifdef PHASE_SCANNING` 编译期隔离）：
|
||||
- **相扫**：比较前后两帧方位波位号，当前帧 `Beam_index_aiz <= last_beam_num` 判为满一圈；`last_beam_num` 参与判断，`track_clear_all()` 复位为 INT_MAX，故**清空后/首帧即判满一圈**；
|
||||
- **机扫**：判 **波位号为 0**（7d5a56f 起），避免转台反转时波位号变小导致误判一圈完成（代码中保留了旧判断的注释）；该分支下 `last_beam_num` 仍被赋值但不参与判断。
|
||||
- 机扫下波位号 0 是每圈的起始波位，因此**每圈恰好触发一次 model=1**。
|
||||
- TAS 数据不参与判圈，**每来一帧就处理一次**（TAS 是调度的跟踪波位，本身就是单目标 CPI）。
|
||||
|
||||
### 2.3 调度：model 与动作的对应
|
||||
@@ -277,9 +278,11 @@ VT > 300 且 R > 1200 → 拒绝（高速目标给固定 1200 m 上限）
|
||||
|
||||
**输出门控（50e0b5c）**：TWS 输出航迹的循环改为「`Track_Update_Flag == 1` 才输出，输出后清零」，即每圈只输出**本圈关联到实点或成功外推**的航迹；此前是每圈把航迹表中全部可靠航迹各输出一行。门控只判更新标志、不判 `manual_tracking_flag`，因此手动转 TAS 的航迹若本圈在 TWS 侧关联到实点，仍会经 TWS 通道输出。
|
||||
|
||||
> 由于外推上限（3）小于 TWS 消亡轮数（6），普通航迹在停止预测后还会**连续 3 圈不向宿主输出**任何航迹行（`Extrapolate_round` 依次走到 5、6、7，第 7 圈在 `track_die` 中消亡），只在最后输出一次消亡批号。
|
||||
> **普通 TWS 航迹的消亡改由质量决定（V1.5.8）**：`track_die.cpp` 对 `Track_Mode==0 && primary_target_flag==0` 的航迹改用 `Quality < TRACK_DIE_QUALITY`（0.3）判消亡，因此外推超限后航迹仍会驻留，直到质量衰减到门限以下；`Extrapolate_round` 继续每圈 +1 但不再决定普通 TWS 航迹的存活。重点航迹（10 圈）与 TAS（相扫 10 / 机扫 96）不变。
|
||||
>
|
||||
> **TAS 通道的判据方向相反**（`track_asso_tas.cpp` L484）：`Extrapolate_round >= MAX_EXTRAPOLATE_NUM_TAS` 时才做预测、推进航迹时间并置 `Track_Update_Flag = 1`；未达该轮数时只累加圈数（不预测、不输出）。即 TWS 是"先外推、到上限后停"，TAS 是"先不预测、到轮数后才开始外推"，详见 7.2 与第 10 节。
|
||||
> 质量在外推环节按未更新时长二次衰减（`Unupdated_time` 累计，ΔT 由 `work_mode` 数据率决定），且该计算位于外推上限判断之外，故上限内、外都会衰减。
|
||||
>
|
||||
> **TAS 通道的判据方向相反**（`track_asso_tas.cpp`）：`Extrapolate_round >= MAX_EXTRAPOLATE_NUM_TAS` 时才做预测、推进航迹时间并置 `Track_Update_Flag = 1`；未达该轮数时只累加圈数（不预测、不输出）。即 TWS 是"先外推、到上限后停"，TAS 是"先不预测、到轮数后才开始外推"，详见 7.2 与第 10 节；TAS 不维护航迹质量。
|
||||
|
||||
---
|
||||
|
||||
@@ -390,14 +393,16 @@ dis ≥ |v_r,head| · ΔT 同上，用航迹头的多普勒约
|
||||
|
||||
| 通道 | 条件（满足其一即消亡） |
|
||||
|---|---|
|
||||
| TWS 普通航迹 | `Track_Mode==0` 且 `primary_target_flag==0` 且 `Extrapolate_round > TRACK_DIE_ROUND`（相扫/机扫均为 6） |
|
||||
| TWS 普通航迹 | `Track_Mode==0` 且 `primary_target_flag==0` 且 **`Quality < TRACK_DIE_QUALITY`（0.3）** —— V1.5.8（782bff5）起改按航迹质量，不再看外推圈数 |
|
||||
| TWS 重点航迹 | `Track_Mode==0` 且 `primary_target_flag==1` 且 `Extrapolate_round > TRACK_DIE_ROUND_PRIMARY`（10） |
|
||||
| TAS 航迹 | `Track_Mode==1` 且 `Extrapolate_round > TRACK_DIE_ROUND_TAS`（相扫 10 / 机扫 96） |
|
||||
| 手动删除 | `manual_delete_flag == 1`（各通道单独判定，置位即消亡，由外部删除接口 `track_delete` 置位） |
|
||||
|
||||
三个判据都改为 `die_flag` 组合（"或"关系），且比较符由 `>=` 改为 `>`（50e0b5c）：即允许的外推圈数比旧版各多 1 圈，且**重点航迹与普通航迹走不同门限**。由于每圈未关联只自增 1，判据为 `>` 时实际是"连续 N+1 圈没有实点关联"才消亡：普通 TWS 航迹 7 圈、重点航迹 11 圈、TAS 相扫 11 圈 / 机扫 97 圈。
|
||||
轮数类判据都改为 `die_flag` 组合（"或"关系），且比较符由 `>=` 改为 `>`（50e0b5c）：即允许的外推圈数比旧版各多 1 圈，且**重点航迹与普通航迹走不同门限**。由于每圈未关联只自增 1，判据为 `>` 时实际是"连续 N+1 圈没有实点关联"才消亡：重点航迹 11 圈、TAS 相扫 11 圈 / 机扫 97 圈。
|
||||
|
||||
> `primary_target_flag`（重点目标标记）由外部接口 `Data_Process::primary_target_add / primary_target_cancel` 按批号置 1 / 清 0（`data_process.cpp` L268-297）；新起批航迹在 `track_init.cpp` 中以 `Trust_Track trust_track_tmp = {}` 零初始化，故恒为 0。该标记目前只影响上表的 TWS 消亡轮数。
|
||||
> **普通 TWS 航迹的消亡时长（V1.5.8）**：改按质量后不再有固定圈数，存活时长由质量衰减速度决定——未关联期间按 `Unupdated_time` 的二次函数加速衰减（见 9.9 / README 9.11），`Quality` 跌破 0.3 即消亡；`TRACK_DIE_ROUND`（6）已不再被引用。
|
||||
|
||||
> `primary_target_flag`（重点目标标记）由外部接口 `Data_Process::primary_target_add / primary_target_cancel` 按批号置 1 / 清 0（`data_process.cpp`）；新起批航迹在 `track_init.cpp` 中以 `Trust_Track trust_track_tmp = {}` 零初始化，故恒为 0。该标记在 TWS 上决定走「质量消亡（普通）」还是「10 圈消亡（重点）」。
|
||||
|
||||
消亡时把批号写入消亡输出数组并从航迹表删除；**临时航迹消亡不对外输出**（起批失败的中间态对宿主不可见）。
|
||||
|
||||
@@ -538,9 +543,12 @@ flowchart TD
|
||||
| `ASSO_THORD` | 4 | 同左 | 关联波门（判据 d*d < ASSO_THORD²，d 已是马氏距离平方，等效 d < 4） |
|
||||
| `MAX_EXTRAPOLATE_NUM` | 3 | 同左 | TWS 未关联航迹最大外推轮数（`Extrapolate_round <= 该值` 才预测并输出） |
|
||||
| `MAX_EXTRAPOLATE_NUM_TAS` | 5 | 48 | TAS 未关联航迹开始外推的轮数（判据 `>=`，方向与 TWS 相反） |
|
||||
| `TRACK_DIE_ROUND` | 6 | 6 | TWS 普通航迹消亡轮数（判据 `Extrapolate_round > 该值`） |
|
||||
| `TRACK_DIE_ROUND` | 6 | 6 | **已不被引用**：V1.5.8 起 TWS 普通航迹改按质量消亡（宏保留备用） |
|
||||
| `TRACK_DIE_ROUND_PRIMARY` | 10 | 10 | TWS 重点航迹（`primary_target_flag==1`）消亡轮数 |
|
||||
| `TRACK_DIE_ROUND_TAS` | 10 | 96 | TAS 航迹消亡轮数（判据 `Extrapolate_round > 该值`） |
|
||||
| `TRACK_DIE_QUALITY` | 0.3 | 0.3 | TWS 普通航迹质量消亡门限（`Quality < 该值`；V1.5.8 新增） |
|
||||
| `TRACK_START_QUALITY_L3~L7` | 0.7 / 0.6 / 0.5 / 0.4 / 0.3 | 同左 | 起批最低质量（按临时航迹长度 3/4/5/6/≥7；V1.5.8 新增） |
|
||||
| `TRACK_QUALITY_*` | 见 README 10.1 | 同左 | 质量权重（D/SNR/LEN：0.5/0.3/0.2）、平滑系数 0.8、衰减系数 O2/O1 = −0.0008/−0.0025、折算上限 100（V1.5.8 新增） |
|
||||
| `MAX_TRACK_NUM / MAX_TRACK_INDEX` | 500 / 500 | 同左 | 航迹数上限 / 航迹号上限 |
|
||||
| `TAS_QUEUE_LENGTH / MAX_TAS_NUM` | 4 / 4 | 1 / 1 | TAS 队列长度 / 最大 TAS 目标数 |
|
||||
| `H_F_WIN_LEN` | 3 | 同左 | 高度平滑窗长基数（实际 +2/+3/+4/+6） |
|
||||
@@ -593,14 +601,15 @@ flowchart TD
|
||||
- 屏蔽区/禁止区的组数按 30 组数组定义，配置数量未做上限校验；
|
||||
- 高度平滑缓存只增不减，长时运行下每条航迹的内存占用会持续增长。
|
||||
|
||||
**外推、消亡与输出门控（50e0b5c / fc49707 / 42b598e / e8c56f9）**
|
||||
**外推、消亡与输出门控（50e0b5c / fc49707 / 42b598e / e8c56f9 / V1.5.8）**
|
||||
|
||||
- **外推圈数上限**：TWS 只在 `Extrapolate_round <= MAX_EXTRAPOLATE_NUM`（3）时预测并输出；TAS 相反，`Extrapolate_round >= MAX_EXTRAPOLATE_NUM_TAS`（相扫 5 / 机扫 48）时才预测并输出。两处比较方向不一致，此处仅如实记录，**不判定为缺陷**；
|
||||
- **消亡判据**由 `>=` 改为 `>`，并区分重点目标：普通 TWS 航迹 `> TRACK_DIE_ROUND`（6）、重点航迹（`primary_target_flag==1`）`> TRACK_DIE_ROUND_PRIMARY`（10）、TAS 航迹 `> TRACK_DIE_ROUND_TAS`（相扫 10 / 机扫 96）；`manual_delete_flag == 1` 单独判为消亡；因外推上限（3）小于消亡轮数（6），普通 TWS 航迹停止预测后还会连续 3 圈不向宿主输出；
|
||||
- **普通 TWS 航迹消亡改按质量（V1.5.8）**：`Quality < TRACK_DIE_QUALITY`（0.3）即消亡，`TRACK_DIE_ROUND`（6）不再被引用；重点航迹仍按 `> TRACK_DIE_ROUND_PRIMARY`（10）、TAS 仍按 `> TRACK_DIE_ROUND_TAS`（相扫 10 / 机扫 96）；`manual_delete_flag == 1` 单独判为消亡；
|
||||
- **航迹质量（V1.5.8）**：内部 0~1，临时航迹每延长一点按「距离+SNR」更新、关联实点按「距离+SNR+有效点占比」平滑更新、未关联期间按 `Unupdated_time` 二次衰减；起批需达按长度分级的最低质量；输出 `Track.Quality` 为 0~100（×100）。TAS 通道不维护质量；
|
||||
- **输出门控**：TWS 与 TAS 的输出航迹循环都新增 `Track_Update_Flag == 1` 判定并在输出后清零，只输出**本圈关联到实点或成功外推**的航迹（此前 TWS 每圈把航迹表中全部可靠航迹各输出一行）；
|
||||
- **接近/远离判据**（fc49707 + 42b598e）：`Flag_Direction` 不再用实测径向速度 `vr_point > 0`（受多普勒速度模糊影响符号可能取反），改为用 IMM 融合速度方向角判定——`Direction_Angle = atan2(X[4], X[1])`（弧度转度后输出到 `Track.Direction_Angle`），`x`、`y` 为经 `Work_Parameter.Sys_delay` 补偿后的位置、`r` 为其模，`acos((-x·cosθ - y·sinθ)/r) < π/2` 判为靠近(1)、否则远离(0)，等价于"速度方向与雷达→目标位置方向夹角 > 90°"。中间版本 fc49707 曾写为 `acos((-x·vx - y·vy)/r/Range_V) < π/4`（按合速度归一化、门限 45°），42b598e 改为上式；
|
||||
- **归一化幅度 / 速度维 FFT 点数（e8c56f9 新增，输入侧已打通）**：`DataRev` 新增 `amp_asv`（归一化幅度 dB）、`prn_fftn`（速度维 FFT 点数），`Track`/内部 `PointRecv`/`Trust_Track` 也新增同名成对字段；`data_preprocess()` 现已在 TWS 与 TAS 两条分支都把这两个字段搬入 `PointRecv`（并随 `RdpRecPoint` 落库），因此 `track_asso.cpp` 写入航迹并在 TWS 输出行写回的 `amp_asv_point` / `prn_fftn_point` 有有效数据来源；**TAS 的关联与输出路径（`track_asso_tas.cpp`）仍未涉及这两个字段**，TAS 输出行中它们保持宿主原值。
|
||||
- **版本号与记录标识（b227ae1 / c3c7e66）**：`parameters.h` 新增版本宏并拼装为 `VERSION_STRING`（当前 `V1.5.6.PS` / `V1.5.6.MS`），实例创建后可由基类公开成员 `version_info` 读取；`Data_Process` 新增 `point_id` / `frame_id` / `circle_id` 自增计数（`circle_id` 在 TWS 满一圈、TAS 每帧末自增），`PointRecv`/`Temp_track`/`Trust_Track` 新增对应的标识字段，记录功能据此把「输入点迹 → 凝聚点迹 → 临时航迹 → 可靠航迹 → 关联信息」串成同一条链路。
|
||||
- **版本号与记录标识（b227ae1 / c3c7e66 / 5cb67cc）**：`parameters.h` 新增版本宏并拼装为 `VERSION_STRING`（当前 `V1.5.8.PS` / `V1.5.8.MS`），实例创建后可由基类公开成员 `version_info` 读取；`Data_Process` 新增 `point_id` / `frame_id` / `circle_id` 自增计数（`circle_id` 在 TWS 每判满一圈、TAS 每帧末自增），`PointRecv`/`Temp_track`/`Trust_Track` 新增对应的标识字段，记录功能据此把「输入点迹 → 凝聚点迹 → 临时航迹 → 可靠航迹 → 关联信息」串成同一条链路；可靠航迹与关联信息的记录点为 TWS/TAS 双通道（关联信息以 `Asso_Info::tas_flag` 区分来源）。
|
||||
|
||||
**未启用**
|
||||
|
||||
@@ -616,13 +625,13 @@ flowchart TD
|
||||
|
||||
| 项 | README 描述（更新前） | 当前源码 |
|
||||
|---|---|---|
|
||||
| 满圈判据 | 当前方位波位号 < 上一帧波位号 | **方位波位号 == 0**（7d5a56f，适应机扫转台反转） |
|
||||
| 满圈判据 | 当前方位波位号 < 上一帧波位号 | 按体制区分（3e6763c）：**相扫**当前波位号 ≤ 上一帧波位号（等价于原判据）、**机扫**方位波位号 == 0（7d5a56f，适应机扫转台反转） |
|
||||
| 点-航迹头判据 | 按距离分段收紧速度门限（半速、1/2~1/3 速） | 该分支注释停用；改为统一速度区间 **+ 两条多普勒-几何一致性约束**（7d5a56f） |
|
||||
| 起始输出历史点 | "临时航迹的全部 L 个点" | 实际输出**前 `track_start_point_num` 个点** |
|
||||
| 起始输入过滤 | "track_init 跳过 Use_Flag==1 的点" | 上游 `track_asso_process()` 结束前已把 `Use_Flag==1` 的点迹从 `point_recv` 删除；`track_init` 入口（L59-70）也会再剔除一次 `Use_Flag==1` 的点，两道处理叠加，效果一致 |
|
||||
| 日志开关 | "RDP_LOG_ENABLE 默认开启" | `parameters.h` 中该宏当前为**注释状态**（不落盘，日志进控制台） |
|
||||
| 起始步骤顺序 | "航迹头（1 点）→ 点-航迹头关联（2 点）→ 点-临时航迹关联（≥3 点）→ 起批" | 每圈实际顺序为**点 × ≥2 点临时航迹关联 → 点 × 1 点航迹头关联 → 剩余点转新航迹头 → 长度达标的临时航迹起批**，消亡最后执行（`track_init.cpp` L49-126，见第 6 节） |
|
||||
|
||||
> 后续：README 与 `track_init_readme.md`（航迹起始专项说明）已按上表结论同步（见 CHANGELOG 的 Unreleased 记录）；流程落地实现仍以本文为准。
|
||||
> 后续：README 与 `track_init_readme.md`（航迹起始专项说明）已按上表结论同步（见 CHANGELOG 对应版本的记录）；流程落地实现仍以本文为准。
|
||||
>
|
||||
> 补充修订（本次）：起始流程的**步骤顺序**原先在本文档（第 0、6 节）与 README（第 2、5.2、8.3、9.3 节）中都写作「航迹头 → 2 点 → ≥3 点 → 起批」，与源码每圈「点 × 临时航迹关联 → 点 × 航迹头关联 → 剩余点转航迹头 → 达标者起批」的顺序相反，现已按源码修正，并补充说明两个关联阶段互不排斥、均不做一对一分配。
|
||||
|
||||
Reference in New Issue
Block a user