当前位置:网站首页>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
完
如有错漏,敬请指正
边栏推荐
- LeetCode Brushing Diary: 74. Searching 2D Matrix
- Hash collisions and consistent hashing
- The failure to create a role in Dahua Westward Journey has been solved
- 2023年起,这些地区软考成绩低于45分也能拿证
- "NetEase Internship" Weekly Diary (1)
- 用位运算为你的程序加速
- 接口测试神器Apifox究竟有多香?
- 使用docker安装mysql
- 十字光标太小怎么调节、CAD梦想画图算量技巧
- 面对职场“毕业”,PM&PMO应该如何从容的应对?如何跳槽能够大幅度升职加薪?
猜你喜欢

2022-08-01 mysql/stoonedb慢SQL-Q18分析

Pinduoduo leverages the consumer expo to promote the upgrading of domestic agricultural products brands and keep pace with international high-quality agricultural products

【LeetCode每日一题】——103.二叉树的锯齿形层序遍历

用位运算为你的程序加速

GTK RGB图像绘制

个人博客系统项目测试

Service discovery of kubernetes

Multi-Party Threshold Private Set Intersection with Sublinear Communication-2021: Interpretation

LeetCode brush diary: LCP 03. Machine's adventure

Hiring a WordPress Developer: 4 Practical Ways
随机推荐
【LeetCode Daily Question】——704. Binary Search
2022-08-01 反思
oracle query scan full table and walk index
Ask God to answer, how should this kind of sql be written?
Personal blog system project test
Scheduled tasks for distributed applications in Golang
The failure to create a role in Dahua Westward Journey has been solved
Redis 底层的数据结构
Fundamentals of Cryptography: X.690 and Corresponding BER CER DER Encodings
LeetCode brush diary: LCP 03. Machine's adventure
面对职场“毕业”,PM&PMO应该如何从容的应对?如何跳槽能够大幅度升职加薪?
Use DBeaver for mysql data backup and recovery
Redis Persistence - RDB and AOF
使用docker安装mysql
How to adjust the cross cursor too small, CAD dream drawing calculation skills
2022-08-01 Reflection
Rasa 3.x 学习系列- Rasa - Issues 4873 dispatcher.utter_message 学习笔记
[ORB_SLAM2] void Frame::ComputeImageBounds(const cv::Mat & imLeft)
messy website
2022河南青训联赛第(三)场