文章目录
![[外链图片转存失败,源站可能有防盗链机制,建议将图片保存下来直接上传(img-MfFwpvGP-1612751614123)(index_files/0f287f9b-e606-4847-b3ef-186fb231a611.jpg)]](https://i-blog.csdnimg.cn/blog_migrate/7e1067d8950e28080d3bb274d312a22b.png)
采用了基于滑动窗口的优化方法,在VIO紧耦合的框架中加入了全局传感器作为约束,在改善定位精度的同时,没有破坏算法的实时性。
从实验来看室外场景引入GPS信息获得了比较不错的效果提升,但问题在于室内如何获得廉价的全局观测,文中通过动作捕捉装置真值加上高斯噪声模拟的方式不能证明所提方法在室内的可行性。
J V ( X ) = ∑ k = 0 K − 1 ∑ j ∈ J k ∥ e v j , k ∥ W v j , k 2 + ∑ k = 0 K − 1 ∥ e i k ∥ W i k 2 + ∑ k = 0 K − 1 ∑ j ∈ G k ∥ e g j , k ∥ W g k 2 + ∥ e p ∥ 2 J_{V}(\mathcal{X})=\sum_{k=0}^{K-1} \sum_{j \in \mathcal{J}_{k}}\left\|\mathbf{e}_{\mathbf{v}}^{j, k}\right\|_{\mathbf{W}_{\mathbf{v}}^{j, k}}^{2}+\sum_{k=0}^{K-1}\left\|\mathbf{e}_{\mathbf{i}}^{k}\right\|_{\mathbf{W}_{\mathbf{i}}^{k}}^{2}+\sum_{k=0}^{K-1} \sum_{j \in \mathcal{G}_{k}}\left\|\mathbf{e}_{\mathbf{g}}^{j, k}\right\|_{\mathbf{W}_{\mathbf{g}}^{k}}^{2}+\left\|\mathbf{e}_{\mathbf{p}}\right\|^{2} JV(X)=k=0∑K−1j∈Jk∑∥∥evj,k∥∥Wvj,k2+k=0∑K−1∥∥eik∥∥Wik2+k=0∑K−1j∈Gk∑∥∥egj,k∥∥Wgk2+∥ep∥2
整体的优化代价函数由视觉,IMU,全局测量和边缘化残差四个部分构成。
全局测量和相机的约束由全局测量的误差模型和观测时间差之间的IMU预积分组成。