1. 课程导论与问题定义：为什么动态环境是SLAM的噩梦？
大家好，我是你们这门课的主讲。在SLAM这个行当里摸爬滚打了快十年，说实话，最让我头疼的从来不是特征点提取不够快，也不是后端优化收敛太慢——而是那些不听话的、到处乱动的物体。
你想想看，一个静态的走廊，咱们的ORB-SLAM2能跑到飞起。可一旦画面里走进一个人，或者一辆车开过去，整个系统就开始「抽风」。定位飘了、地图花了、甚至直接崩溃。嗯，这就是我们今天要聊的核心问题——动态环境。
1.1 为什么动态环境是SLAM的噩梦？
SLAM的基本假设是什么？说白了就是「世界是静止的」。我们通过匹配连续帧之间的特征点，来估计相机的运动。这个过程的数学基础——对极几何、PnP、BA优化——全都建立在「场景中只有相机在动」这个前提上。
一旦场景里有其他东西在动，问题就来了：
- 特征匹配会出错：上一帧墙角那个点，下一帧可能被行人挡住了。你拿什么去匹配？
- 位姿估计会偏：如果匹配到的点里混入了运动物体上的点，那计算出来的相机运动就是错的。我在一次AGV项目中就吃过这个亏——机器人明明在直行，结果因为旁边有人走过，轨迹估计成了S形。
- 地图会「鬼影」重重：动态物体会在地图中留下残影。你建出来的地图，墙上全是半透明的行人轮廓，这地图谁敢用？
1.2 动态物体的分类
做工程不能只喊「动态环境很难」，得把问题拆开来看。我个人习惯把动态物体分成四类，这样处理起来更有针对性。
| 分类 | 定义 | 典型例子 | 处理难度 |
|---|---|---|---|
| 刚性动态 | 物体形状不变，整体运动 | 行人、车辆、宠物 | 中等 |
| 非刚性动态 | 物体形状随时间变化 | 飘动的旗帜、风吹的树叶、人的手臂摆动 | 高 |
| 低动态 | 运动速度慢，或间歇性运动 | 缓慢旋转的风扇、开关的门 | 较低 |
| 高动态 | 运动速度快，或频繁出现 | 高速行驶的车辆、拥挤的人群 | 极高 |
这里我想多说一句。很多人觉得非刚性动态最难处理，其实不然。我在做园区巡检机器人时发现，高动态场景才是真正的杀手。为什么？因为低动态物体你还能用RANSAC滤掉，非刚性物体你可以用语义分割识别。但高动态场景里，特征点被污染的比例可能超过50%，这时候传统方法基本就废了。
1.3 鲁棒性评估指标
做算法不能光靠「感觉」。你说你的系统鲁棒，怎么证明？得用指标说话。SLAM领域最常用的两个指标是ATE和RPE，另外还有一个「成功率」指标，虽然不那么学术，但工程上非常实用。
1.3.1 ATE（绝对轨迹误差）
ATE衡量的是估计轨迹和真实轨迹之间的整体偏差。说白了就是：你算出来的相机路径，和它实际走的路径，差了多少？
计算方式很简单：
# 伪代码示意
for each timestamp t:
error_t = ||estimated_pose_t - ground_truth_pose_t||
ATE = sqrt(mean(error_t^2))ATE的单位通常是米。数值越小，说明整体定位越准。我一般要求ATE在0.1m以内才算合格，0.05m以内算优秀。
1.3.2 RPE（相对位姿误差）
RPE衡量的是相邻帧之间的相对运动误差。它更关注系统的局部一致性。举个例子：你的机器人走了一米，算法算出来走了0.95米，那RPE就是0.05米。
# 伪代码示意
for each consecutive pair (i, j):
delta_estimated = estimated_pose_i.inv() * estimated_pose_j
delta_gt = ground_truth_i.inv() * ground_truth_j
error = delta_estimated.inv() * delta_gt
RPE = sqrt(mean(||translation(error)||^2))RPE对动态环境特别敏感。为什么？因为动态物体会导致帧间匹配出错，直接反映在RPE上。我记得有一次调试，ATE看着还行，但RPE一直在0.2m以上。后来一查，原来是动态物体导致局部优化一直在震荡。
1.3.3 成功率
这个指标学术论文里很少提，但做工程的人都知道它有多重要。成功率指的是：在给定测试序列中，系统没有崩溃、没有跟丢、没有产生不可恢复的漂移的比例。
举个例子：你跑了100个动态场景序列，有95个序列跑完了全程且定位误差在阈值内，那成功率就是95%。
我个人觉得，对于动态环境SLAM，成功率比ATE更重要。为什么？因为ATE差一点，你还能用后处理修；但系统一旦崩溃，一切归零。我在做仓储机器人时，客户的要求很简单：别撞墙、别跟丢。至于定位精度是10cm还是15cm，人家其实不太在意。
- ATE：看整体轨迹准不准 → 适合评估全局定位能力
- RPE：看局部运动稳不稳 → 适合评估帧间匹配质量
- 成功率：看系统扛不扛得住 → 适合评估工程鲁棒性
1.4 本章知识体系总览
说了这么多，咱们用一张图把这一章的核心逻辑串起来。我画了个简单的结构图，方便你理解整个课程第一讲在讲什么。
这张图把咱们这一章的核心逻辑串起来了。从「动态环境」这个核心问题出发，我们拆解了三个方向：为什么它是个噩梦、怎么分类、怎么评估。后面的课程，就是围绕这三个方向，一步步给出解决方案。