从imu到姿态

文章讨论了如何将IMU数据转化为世界坐标系中的姿态,涉及欧拉角表示的旋转矩阵,以及如何通过角速度积分计算姿态变化,同时提到了偏航角的计算挑战和位置、速度的累加过程。

摘要生成于 C知道 ,由 DeepSeek-R1 满血版支持, 前往体验 >

首先,imu数据本身的校准滤波,还涉及到用什么传感器协同问题,这个不在本文表述范围.我们探讨的是imu数据到姿态的转化.使用问题.
1 从每一帧的坐标系转化到世界坐标系,R代表了在世界坐标中的姿态
把每一帧转化到世界坐标
2 转化矩阵用欧拉角表述(roll 翻滚ϕ, pitch 俯仰θ, and yaw偏航 ψ):

在这里插入图片描述

3 初始位置的世界坐标
在这里插入图片描述
4 当imu旋转一定的姿态时,重力加速度会在3个轴上产生相应的分量,其本质是大地坐标系下的(0,0,g)在此刻imu坐标系下的坐标,也就是此刻imu的姿态,这个也是我们最终要的,但是为了得到这个旋转矩阵,需要欧拉角
此外需要注意这个旋转矩阵的物理意义,它代表,世界坐标[0,0,g]在新的坐标系下的位置,如果把新的坐标转回到世界坐标,应该求逆
在这里插入图片描述
5 其中两个欧拉角,俯仰角和翻滚角,直接可以用惯导的旋转加速度得出,但是偏航角不可以,偏航角可以用下面的方法,但是有累计误差
在这里插入图片描述
6 三个欧拉角也可以通过积分获取. IMU在第n个时刻的姿态角度为r、p、y,此时需要计算下一个时刻(n+1)的姿态。设n+1时刻的姿态角为r+Δr、p+Δp、y+Δy,该姿态也是经历了3次旋转。要想计算n+1时刻的姿态,只要在n时刻姿态的基础上,加上对应的姿态角度变化量即可。姿态角度的变化量可以通过角速度与采用时间周期积分即可。

在这里插入图片描述

7 位置平移和速度需要时间序列不停累加
在这里插入图片描述

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值