当前位置:网站首页>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
完
如有错漏,敬请指正
边栏推荐
- [Server data recovery] Data recovery case of server Raid5 array mdisk disk offline
- LeetCode Review Diary: 34. Find the first and last position of an element in a sorted array
- 通用客户端架构
- Golang分布式应用之Redis
- Remember a gorm transaction and debug to solve mysql deadlock
- NIO's Sword
- nacos startup error, the database has been configured, stand-alone startup
- 2022-08-01 Reflection
- Can Youxuan database import wrongly be restored?
- LeetCode 213. Robbery II (2022.08.01)
猜你喜欢

Handwriting a blogging platform ~ Day 3

Nanoprobes丨1-mercapto-(triethylene glycol) methyl ether functionalized gold nanoparticles

局部敏感哈希:如何在常数时间内搜索Embedding最近邻

BI-SQL丨WHILE

Nanoprobes Polyhistidine (His-) Tag: Recombinant Protein Detection Protocol

FOFAHUB使用测试

拼多多借力消博会推动国内农产品品牌升级 看齐国际精品农货

一次SQL优化,数据库查询速度提升 60 倍

2022河南青训联赛第(三)场

The failure to create a role in Dahua Westward Journey has been solved
随机推荐
How to adjust the cross cursor too small, CAD dream drawing calculation skills
线程的不同状态
Analysis of volatile principle
字典常用方法
LeetCode Review Diary: 34. Find the first and last position of an element in a sorted array
十字光标太小怎么调节、CAD梦想画图算量技巧
messy website
¶ Backtop back to the top is not effective
Check if IP or port is blocked
A good book for newcomers to the workplace
Speed up your programs with bitwise operations
MySQL optimization strategy
Ask God to answer, how should this kind of sql be written?
【LeetCode每日一题】——103.二叉树的锯齿形层序遍历
LeetCode brushing diary: 53, the largest sub-array and
LeetCode Review Diary: 153. Find the Minimum Value in a Rotated Sort Array
[Server data recovery] Data recovery case of server Raid5 array mdisk disk offline
From 2023 onwards, these regions will be able to obtain a certificate with a score lower than 45 in the soft examination.
Remember a gorm transaction and debug to solve mysql deadlock
ofstream,ifstream,fstream read and write files