当前位置:网站首页>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
完
如有错漏,敬请指正
边栏推荐
- "NetEase Internship" Weekly Diary (2)
- 2022-08-01 mysql/stoonedb慢SQL-Q18分析
- LeetCode Review Diary: 153. Find the Minimum Value in a Rotated Sort Array
- 记一个gorm初始化的坑
- 【web】Understanding Cookie and Session Mechanism
- 使用DBeaver进行mysql数据备份与恢复
- 【LeetCode每日一题】——704.二分查找
- 2022-08-01 Install mysql monitoring tool phhMyAdmin
- Power button 1374. Generate each character string is an odd number
- NIO's Sword
猜你喜欢

【 wheeled odometer 】

Install mysql using docker

Power button 1374. Generate each character string is an odd number

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

The underlying data structure of Redis

Redis Subscription and Redis Stream

Handwritten Blog Platform ~ Day Two

Safety (2)

Speed up your programs with bitwise operations

2023年起,这些地区软考成绩低于45分也能拿证
随机推荐
Simple example of libcurl accessing url saved as file
Speed up your programs with bitwise operations
Nanoprobes丨1-巯基-(三甘醇)甲醚功能化金纳米颗粒
通用客户端架构
LeetCode刷题日记:74. 搜索二维矩阵
A good book for newcomers to the workplace
nacos startup error, the database has been configured, stand-alone startup
面对职场“毕业”,PM&PMO应该如何从容的应对?如何跳槽能够大幅度升职加薪?
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?
Moonbeam and Project integration of the Galaxy, bring brand-new user experience for the community
Talking about the "horizontal, vertical and vertical" development trend of domestic ERP
AI target segmentation capability for fast video cutout without green screen
"NetEase Internship" Weekly Diary (3)
软件测试 接口自动化测试 pytest框架封装 requests库 封装统一请求和多个基础路径处理 接口关联封装 测试用例写在yaml文件中 数据热加载(动态参数) 断言
AWR analysis report questions for help: How can SQL be optimized from what aspects?
【ORB_SLAM2】void Frame::AssignFeaturesToGrid()
The underlying data structure of Redis
Redis Subscription and Redis Stream
2022-08-01 反思
MySQL - CRUD operations