算法细节
ArmorDetector
Detector 从同步帧取图像,经过模型前处理、推理、候选解码、NMS、语义过滤、四边形检查和 PnP,发布装甲板结果。
主要文件:
| 文件 | 内容 |
|---|---|
ArmorDetectorNetwork.hpp | 模型选择与初始化 |
ArmorDetectorRuntime.hpp | 处理阶段、输入槽和结果发布 |
infer/ArmorDetectorModelRegistry.hpp | 模型枚举与工件、后端的对应 |
ArmorDetectorPnPSolver.hpp | PnP 求解 |
OpenVINO 推理 worker 按输入槽管理请求和输出,丢帧、推理失败、后处理失败分别计数,便于定位吞吐瓶颈。
模型格式和门限说明见模型与数据。
ArmorTracker
Tracker 用检测角点、原生标定和安装外参获得观测,再更新车辆状态与 EKF。
ArmorTrackerPipeline.hpp 负责订阅、发布和预览,ArmorTrackerCore.hpp 连接输入与核心处理,ArmorTrackerModel.hpp 实现观测、状态模型和滤波。
不同装甲板编号分别维护目标状态。目标选择考虑观测数量、距离、图像面积、自旋速度和视轴角差;switch_margin 控制换目标所需的分差。
常用参数在 cfg.tracker:
| 参数 | 用途 |
|---|---|
require_target_tag、target_tag_id | 是否只跟踪指定编号 |
min_detect_count | 进入跟踪所需的 观测次数 |
max_temp_lost_count | 暂时丢失后的保留次数 |
target_select | 各评分项的权重、归一化参数和切换裕量 |
循环回放时,时间戳回到起点会触发 Tracker 清理旧状态并重新建立时间基线。
Aimer
AimerTargetModel.hpp 负责目标预测和装甲面展开,AimerMath.hpp 处理角度与弹道,AimerPlanner.hpp 生成云台计划,AimerImpl.hpp 连接回调与输出。
弹道模型包含二次空气阻力,使用 RK4 积分和一维求根寻找低弹道仰角。无法求解时输出空命令。
启用 MPC 后,yaw 和机械俯仰分别使用双积分模型。预测窗口为 100 个样本、步长 0.01 s,参考轨迹会随预测过程重新选择装甲面。
开火需要同时满足装甲面可打、计划与命中候选一致、命令稳定和云台对齐。姿态反馈来自 host/gimbal_quat。
延迟、阻力、加速度限制和 MPC 权重在 Aimer 的 cfg 中配置。预览由 AimerPreview.hpp 投影同帧目标,不参与弹道和 MPC 计算。
算法改动可以先用测试与回归中的固定场景做功能检查;识别精度、位姿误差和命中率再用对应数据集评测。