当前位置:网站首页>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
完
如有错漏,敬请指正
边栏推荐
- 永磁同步电机36问(二)——机械量与电物理量如何转化?
- TKU remembers a single-point QPS optimization (I wish ITEYE is finally back)
- What to study after the PMP exam?The soft exam ahead is waiting for you~
- CASE2023
- 十字光标太小怎么调节、CAD梦想画图算量技巧
- Nanoprobes Polyhistidine (His-) Tag: Recombinant Protein Detection Protocol
- ALCCIKERS Shane 20191114
- Service discovery of kubernetes
- oracle query scan full table and walk index
- The principle and code implementation of intelligent follower robot in the actual combat of innovative projects
猜你喜欢

Oracle19c安装图文教程

Talking about the "horizontal, vertical and vertical" development trend of domestic ERP

BI-SQL丨WHILE

GTK RGB图像绘制

"NetEase Internship" Weekly Diary (2)

LeetCode刷题日记:LCP 03.机器人大冒险

Remember a pit for gorm initialization

Redis 底层的数据结构

Win Go development kit installation configuration, GoLand configuration

项目后台技术Express
随机推荐
Rasa 3.x 学习系列- Rasa - Issues 4873 dispatcher.utter_message 学习笔记
EFCore 反向工程
Check if IP or port is blocked
AntPathMatcher uses
局部敏感哈希:如何在常数时间内搜索Embedding最近邻
GTK RGB图像绘制
Personal blog system project test
Data transfer at the data link layer
Nanoprobes Polyhistidine (His-) Tag: Recombinant Protein Detection Protocol
The principle and code implementation of intelligent follower robot in the actual combat of innovative projects
oracle query scan full table and walk index
Scheduled tasks for distributed applications in Golang
列表常用方法
Ask God to answer, how should this kind of sql be written?
LeetCode brushing diary: 53, the largest sub-array and
字典常用方法
CASE2023
2022-08-01 Reflection
[LeetCode Daily Question] - 103. Zigzag Level Order Traversal of Binary Tree
Fundamentals of Cryptography: X.690 and Corresponding BER CER DER Encodings