机器人 / 系统课时

单目相机为什么无法直接确定尺度

单目相机为什么无法直接确定尺度

即使相机已标定,单目 SLAM 也能从连续图像估计相对运动和三维结构,却无法仅凭图像判断一段轨迹究竟长 1 米还是 2 米。下面用投影算例找出这个不可观测的尺度自由度,再说明它如何影响地图,以及怎样引入米制参考。

学习目标

  • 用透视投影公式验证整体放大场景后像素坐标不变。
  • 区分全局尺度未知与沿途不断变化的尺度漂移。
  • 用已知长度或辅助传感器确定尺度,并独立检查误差。

透视投影只保留长度比

针孔模型把相机坐标系中的三维点 (Xc,Yc,Zc)(X_c,Y_c,Z_c) 投影为像素 (u,v)(u,v)。已标定的相机满足 u=fxXcZc+cxu=f_x\frac{X_c}{Z_c}+c_x、v=fyYcZc+cyv=f_y\frac{Y_c}{Z_c}+c_y,其中焦距 fx,fyf_x,f_y 以像素计,(cx,cy)(c_x,c_y) 是主点。

设 fx=fy=800f_x=f_y=800 像素,主点为 (320,240)(320,240)。点 A 的相机坐标是 (1,0,5)(1,0,5) 米,得到像素 (480,240)(480,240);若点 B 位于 (2,0,10)(2,0,10) 米,投影仍是 (480,240)(480,240)。相机看见的是横向距离与深度的比值,无法从这个像素反推唯一的米制距离。

多帧重建为何仍缺少米尺

相机移动产生视差,可以三角化特征点并恢复轨迹形状。但如果把所有三维地标坐标与相机位置同时乘以任意正数 ss,保持每帧旋转不变,各帧像素投影仍然相同。

例如,第一帧相机在 (0,0)(0,0),第二帧沿 X 轴移动 0.50.5 米,地标在 (1,5)(1,5) 米处。两帧的归一化水平像坐标分别是 1/5=0.21/5=0.2 与 (1−0.5)/5=0.1(1-0.5)/5=0.1。将场景整体放大两倍,第二帧移动 11 米、地标改为 (2,10)(2,10) 米,两帧观测仍分别是 0.20.2 和 0.10.1。图像无法判定哪套尺寸是真实的。

整体尺度不同但两帧图像投影相同

实际单目重建通常会固定一个任意尺度,例如把初始化时的平移长度设为 1 个地图单位。这个单位不自动等于 1 米。纯旋转没有可用于三角化的平移视差;前向运动视差过小、纹理重复等情况还会削弱深度估计。

尺度漂移如何破坏轨迹与地图

全局尺度未知是整张地图与真实世界相差同一个倍率:若地图中两点相距 4 单位,真实距离可能是 2 米,也可能是 8 米,单目观测无法选定其中一个。只要倍率恒定,地图形状与相对距离比例仍可能正确。

尺度漂移则是不同路段的估计比例不一致。假设机器人真实连续行驶两段各 5 米的直路,重建结果却分别是 5.0 和 6.0 地图单位;按第一段标定为 1 米/单位,第二段就会误报为 6 米。此时给整条轨迹乘一个常数,无法同时修正两段距离。

尺度误差会让房间长度、路标间距和导航路径距离失真。单目回环检测配合 Sim(3) 相似变换优化,可以调整位姿之间的旋转、平移与相对尺度以减轻漂移,但没有外部长度参考,优化后仍不保证地图单位是米。

怎样恢复并验证米制尺度

最直接的方法是引入一个已知长度。假设场景中有边长 0.20 米的方形标记,多视角重建得到相邻两个角点的距离为 0.10 地图单位,那么尺度系数是 s=0.20/0.10=2s=0.20/0.10=2 米/单位。地图上相距 3.5 单位的两点,换算后相距 7 米。这种单次定标只能消除共同倍率,不能单独修复随路段变化的漂移。

工程上也可以利用已标定的双目相机基线、轮式里程计,或时间同步且具有足够运动激励的相机与 IMU 融合来约束米制尺度。轮胎打滑、IMU 静止或近似匀速且激励不足,都可能让尺度估计不可靠。

验收时不要重复使用定标所用的那段长度。另量一段真实 2.00 米的距离,若地图换算结果为 2.06 米,则相对误差为 ∣2.06−2.00∣/2.00=3%|2.06-2.00|/2.00=3\%;可将 5% 作为本次练习的通过阈值,实际项目应按定位精度要求另定标准。同时在起点、中段和终点分别核对长度,才能发现局部尺度漂移。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

单目相机为什么无法直接确定尺度

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通