在使用BA平差之前,对每一个观测方程,得到一个代价函数.对多个路标,会产生一个多个代价函数的和的形式,对这个和进行最小二乘法进行求解,使用优化方法.相当于同时对相机位姿和路标进行调整,这就是所谓的BA. 在优化过程中,对每一个代价函数求取雅克比矩阵E和F,形成一个H矩阵,正因为H矩阵的稀疏性,才可是使用稀疏方法对BA进行求解.把一个大的稀疏矩阵,通过特定的消元法,消解为一个小的稠密矩阵,降低计算量. 摘抄部分有趣的链接,如有不适,请移步原文. 参考原文链接:Jacobian矩阵和Hessian矩…