NOTE / 2020/5/5
解超定方程 Ax=0
SLAM技术笔记SLAMVIO传感器融合
工程中很多问题会归结为求超定方程 , 是 的矩阵,且 。如 SLAM中三角化地图点 , PnP 等一些问题都是求解这个方程。 很显然,这个方程有一个0解,但这不是我们想要的, 我们实际想求非零解 。
为了求非零解,我们对 x 加上一个约束 ∥x∥2=1 。也就是限制 x 的长度为1。并构建成一个最带约束的最小二乘问题:
x^=argmin∥Ax∥2, subject to ∥x∥2=1 (1)
这是一个带约束的最小二乘问题,我们把拉格朗日搬出来:
L(x,λ)=∥Ax∥2+λ(1−∥x∥2)=xTATAx+λ(1−xTx)(2)
为了求极值,我们分别对 x 和 λ 求偏导数,令为0:
∂x∂L(x,λ)∂λ∂L(x,λ)=2ATAx−2λx=0=1−xTx=0(3)(4)
把(3)式整理一下:
(ATA−λI)x=0ATAx=λx(5)(6)
可以看出 λ 和 x 分别是 ATA 的特征值和特征向量。也就是说(1)式的解,就是这些特征向量中的一个。
问题来了,那么多的特征向量,应该选择哪个作为解呢?我们展开 ∥Ax∥2 看一下:
∥Ax∥2=xTATAx=xTλx=λxTx=λ(7)
(7)式的推导,用到了式(6)和 。
也就是说,我们想要 ∥Ax∥2 最小,就需要 λ 最小。
那方程(1)的非零解就是ATA最小特征值λ对应的特征向量。
参考资料
- Karel Zimmermann. Lecture notes: overdetermined homogeneous linear system.
- Richard Hartley and Andrew Zisserman. Multiple View Geometry in Computer Vision.