企业官网建设流程全解析

函数TrackWithMotionModel()是跟踪线程最常用的跟踪模式：恒速运动模型跟踪。它假设相机在相邻帧之间运动近似匀速，用上一帧的速度预测当前帧位姿，然后在上一帧地图点投影附近搜索匹配，仅优化当前帧位姿。

它的核心流程是：

1. 更新上一帧的位姿和地图点关联；

2. 若 IMU 已初始化且无需重置，用 IMU 预测当前帧状态并直接返回；

3. 否则用恒速模型预测当前帧位姿；

4. 在上一帧地图点投影附近搜索匹配；

5. 若匹配不足，扩大搜索窗口；

6. 若仍不足，根据传感器类型决定失败或继续；

7. 位姿优化并剔除优化后的外点；

8. 根据模式（纯跟踪/IMU/纯视觉）判断返回值。

bool Tracking::TrackWithMotionModel() // Tracking 类的成员函数。 // 返回 bool：true 表示恒速模型跟踪成功，false 表示失败。 // 函数名 TrackWithMotionModel，表示“用运动模型进行跟踪”。 { ORBmatcher matcher(0.9,true); // 创建 ORB 匹配器。 // 第一个参数 0.9 是描述子距离比例测试阈值。 // 与参考关键帧跟踪的 0.