当前位置:网站首页>IMU预积分的简单理解
IMU预积分的简单理解
2022-08-02 02:20:00 【诺有缸的高飞鸟】
写在前面
1、本文内容
IMU预积分的简单理解
2、转载请注明出处:
https://blog.csdn.net/qq_41102371/article/details/125972298
IMU预积分
主要参考imu预积分原理的个人理解 https://zhuanlan.zhihu.com/p/438525032
重点:
关键帧 t 1 t_1 t1与 t 2 t_2 t2之间的加速度,采集好之后就是不变的,但是只要bias不变,矩形上面的 α \alpha α区域就不变
每次状态更新之后, v t 1 v_{t1} vt1和 v t 2 v_{t2} vt2会改变,因此文中的矩形是变化的,但是变化的矩形面积直接由 ( t 2 − t 1 ) ∗ v t 1 (t_2-t_1)*v_t1 (t2−t1)∗vt1得到,计算就变得很简单
文中这部分应该是笔误了
应该改成
β = ∑ k ( a k − b a ) Δ t α = ∑ k = 0 t 2 − t 1 [ ∑ l = 0 k − 1 ( a l − b a ) Δ t ∗ Δ t + 1 2 ( a k − b a ) Δ t 2 ] = ∑ k = 0 t 2 − t 1 [ β k Δ t + 1 2 ( a k − b a ) Δ t 2 ] \begin{aligned} \beta & =\sum_{k}{(a_k-b_a)\Delta t} \\ \alpha & =\sum_{k=0}^{t_2-t_1}{[\sum_{l=0}^{k-1}{(a_l-b_a)\Delta t * \Delta t}+\frac{1}{2}(a_k-b_a)\Delta t^2]}=\sum_{k=0}^{t_2-t_1}{[\beta_k\Delta t+\frac{1}{2}(a_k-b_a)\Delta t^2]} \end{aligned} βα=k∑(ak−ba)Δt=k=0∑t2−t1[l=0∑k−1(al−ba)Δt∗Δt+21(ak−ba)Δt2]=k=0∑t2−t1[βkΔt+21(ak−ba)Δt2]
x t 2 = x t 1 + ∑ k = 0 t 2 − t 1 [ v k Δ t + 1 2 ( a k − b a ) Δ t 2 ] = x t 1 + ∑ k = 0 t 2 − t 1 [ v t 1 Δ t + ∑ l = 0 k − 1 a l − b a Δ t Δ ˙ t + 1 2 ( a k − b a ) Δ t 2 ] \begin{aligned} x_{t_2} & =x_{t_1}+\sum_{k=0}^{t_2-t_1}{[v_k\Delta t+\frac{1}{2}(a_k-b_a)\Delta t^2]} \\ & = x_{t_1}+\sum_{k=0}^{t_2-t_1}{[v_{t_1}\Delta t+\sum_{l=0}^{k-1}{a_l-b_a}\Delta t\dot\Delta t+\frac{1}{2}(a_k-b_a)\Delta t^2]} \end{aligned} xt2=xt1+k=0∑t2−t1[vkΔt+21(ak−ba)Δt2]=xt1+k=0∑t2−t1[vt1Δt+l=0∑k−1al−baΔtΔ˙t+21(ak−ba)Δt2]
参考
imu预积分原理的个人理解 https://zhuanlan.zhihu.com/p/438525032
完
如有错漏,敬请指正
边栏推荐
- Hash collisions and consistent hashing
- Safety (2)
- 永磁同步电机36问(三)——SVPWM代码实现
- AI target segmentation capability for fast video cutout without green screen
- Redis 底层的数据结构
- 【LeetCode每日一题】——654.最大二叉树
- NAS和私有云盘的区别?1篇文章说清楚
- "NetEase Internship" Weekly Diary (3)
- nacos startup error, the database has been configured, stand-alone startup
- 记一个gorm初始化的坑
猜你喜欢
随机推荐
[ORB_SLAM2] SetPose, UpdatePoseMatrices
Talking about the "horizontal, vertical and vertical" development trend of domestic ERP
¶ Backtop back to the top is not effective
TKU remembers a single-point QPS optimization (I wish ITEYE is finally back)
The principle and code implementation of intelligent follower robot in the actual combat of innovative projects
用位运算为你的程序加速
Reflex WMS Intermediate Series 7: What should I do if I want to cancel the picking of an HD that has finished picking but has not yet been loaded?
【ORB_SLAM2】void Frame::AssignFeaturesToGrid()
机器人领域期刊会议汇总
Multi-Party Threshold Private Set Intersection with Sublinear Communication-2021: Interpretation
CodeTon Round 2 D. Magical Array
2022-08-01 mysql/stoonedb slow SQL-Q18 analysis
Personal blog system project test
GTK RGB图像绘制
Fundamentals of Cryptography: X.690 and Corresponding BER CER DER Encodings
Ringtone 1161. Maximum In-Layer Elements and
AWR分析报告问题求助:SQL如何可以从哪几个方面优化?
AOF rewrite
EFCore 反向工程
Rasa 3 x learning series - Rasa - 4873 dispatcher Issues. Utter_message study notes









