尺度可观性

单目相机只能测量方向(指向点的方位),因此重建世界的绝对大小是不可观测的:将整个场景和所有平移量按任意因子缩放,会产生完全相同的图像。双目相机从结构上消除了这种模糊性。两个相机之间已知且经过标定的基线 BB 是一个被置入每个双目观测中的物理长度:通过 Z=fB/dZ = fB/d,每个匹配的关键点都能得到以米为单位的深度。度量尺度可以从单个双目帧中被观测到,无需运动、无需 IMU、也无需任何场景假设。

为什么单目尺度不可观测

取任意单目重建结果 {Xj,(Ri,ti)}\{\mathbf{X}_j, (\mathbf{R}_i, \mathbf{t}_i)\},将其按 s>0s > 0 缩放:点变为 sXjs\mathbf{X}_j,平移量变为 stis\mathbf{t}_i(旋转不变)。每个投影都保持不变,因为针孔投影对齐次坐标的缩放是不变的:

π ⁣(K(RisXj+sti))=π ⁣(sK(RiXj+ti))=π ⁣(K(RiXj+ti)).\pi\!\left(\mathbf{K}(\mathbf{R}_i\, s\mathbf{X}_j + s\mathbf{t}_i)\right) = \pi\!\left(s\,\mathbf{K}(\mathbf{R}_i \mathbf{X}_j + \mathbf{t}_i)\right) = \pi\!\left(\mathbf{K}(\mathbf{R}_i \mathbf{X}_j + \mathbf{t}_i)\right).

对于每一个 ss,测量似然都是完全相同的——无论多少单目数据,都无法区分一个被缓慢穿越的小世界与一个被快速穿越的大世界。尺度是一种规范自由度(gauge freedom),正如全局位置和方向的选择一样。

什么让尺度变得可观测

一旦任何测量携带了度量单位,尺度就变得可观测:

对SLAM估计器的影响

常见陷阱

一个有用的思考方式:单目 SLAM 以”第一次平移的单位”来估计世界;双目 SLAM 以米为单位来估计世界,因为标尺(基线)是被固定在机器人上的。

对SLAM的意义

机器人以米为单位进行规划、控制和避障,因此度量尺度对于导航而言是不可或缺的。理解哪些传感器配置能使尺度可观测——双目基线、IMU 加速度、深度相机、轮式里程计——可以解释许多系统设计选择,从自动驾驶汽车为何使用宽基线双目相机,到 AR 头显为何将相机与 IMU 配对使用。

相关条目