高斯牛顿继承法matlab代码用于多摄像机和IMU校准的最小解算器
给定一个由三个带有相应IMU的摄像机组成的可移动装备,请使用IMU数据查找摄像机的位置和方向。
我们假设存在从摄像机到IMU的已知刚性转换。
这将基于Isaac
Skog等人的先前工作。
[1]和HåkanCarlsson等。
[2]。
在[2]中,校准是使用坐标下降法结合经典的非线性最小二乘法进行的。
这些方法可能并不总是收敛或收敛缓慢。
在这个项目中,我们将研究是否可以通过使用动作矩阵方法(例如,参见Viktor
Larsson的论文简介中的第7节)使解决方案更健壮和/或更快速。
通过这种方法,该问题可以转化为特征分解问题,对于该问题,存在快速的数值稳定求解器。
此外,此方法是不需要初始化的全局优化方法。
入门
所有代码都是用MATLAB编写的,可以在matlab文件夹中找到。
在该文件夹中,
solveImuArray.m是作用矩阵求解器,将与solveImuArrayMl.m高斯-牛顿求解器solveImuArrayMl.m
。
可在tests文件夹中找到用于测试两个求解器的数值以解决各种噪声的脚本
初步结果
2024-05-03 17:53:12
235KB
系统开源
1