IMU

IMU 全称 Inertial Measurement Unit,惯性测量单元,主要用来检测和测量加速度与旋转运动的传感器。其原理是采用惯性定律实现的。

# 九轴 IMU

三轴加速度、三轴角速度、三轴磁力

# IMU 性能参数

量程:加速度计量程、陀螺仪量程

非线性度

零偏:机器人静止状态下,采集出来的角速度不是 0,而是在某个值上下乱跳,去除零飘也很简单,就是在机器人刚上电后,采集 1000 帧陀螺仪原始数据,然后看这 1000 帧数据的方差和标准差,方差小于阈值,代表在采零飘这段时间内,机器人基本保持静止。

轴间灵敏度

噪声密度

温偏

# 固件驱动开发读取数据

IMU 的工作原理是通过其中包含的加速度计来测量 X、Y、Z 三个移动方向上的加速度,通过一重积分得到速度,通过二重积分得到位置,通过包含的陀螺仪测量 Roll、Pitch、Yaw 三个旋转方向上的角速度,通过一重积分得到姿态,包含磁力计的 IMU 还可以通过测量与地球磁场的夹角来确定当前的朝向,弥补加速度计在水平面上的测量缺失问题。

在实际应用中,我们获得的只能是离散的信号,想要通过离散信号来还原真实连续时域信号的曲线是不现实的,我们只能在固定的时间间隔下采样得到当前的角速度,并假设在这一小段△t 中是匀速运动。

累加当前角度 += 当前角速度 * 采样时间间隔

θ=ω+δt\theta=\omega+\delta t

# 参数标定

误差:

加速度计测量的是三轴线加速度,普通的消费级 IMU,往往加速度计的高频噪声特别大,单独使用加速度计一般效果都比较糟糕。常见误差来源:

  • 轴间误差:加速度计三轴间理论是严格互相垂直的,但实际的传感器是很难保证严格垂直安装,比如期望是 90°,实际是 88°,这种误差统称为轴间误差。

  • 尺度误差:这个是传感器内部测量不准,比如机器人朝 Y 轴以 1m/s2 的加速度超前走,实际传感器测量的可能是 0.8m/s2,这两个误差都可以通过椭球拟合或 6 面法标定,扫地机项目中未使用标定算法。

image-20250817112245972

陀螺仪获得姿态角,短时间准确,长时间会漂移。加速度计获得姿态角,短时间震荡严重,长时间相对准确。因此,一般使用加速度计的数据来修正陀螺仪,以加速度计获取的实时姿态角来修正陀螺仪的累积误差,就能在短时间和长时间内都能获取比较满意的姿态信息。

# 数据滤波

经过标定后的 IMU 数据,依然存在抖动、毛刺之类的噪声,因此需要滤波降噪。

image-20250817113705548

# 姿态融合

Z 轴向上,约定绕 X 轴旋转的角度为滚转角(横滚角);绕 Y 轴旋转的角度为俯仰角,绕 Z 轴旋转的角度为偏航角。

image-20250817163120506

滚转角(绕 X 轴转)和俯仰角(绕 Y 轴转)发生变化时,IMU 测出来的重力加速度 g 的方向相对于载体也会发生变化。而加速度计测出来的重力加速度 g 的方向是实时的,不会受长时间计算累加的影响。所以,可以用加速度计测到的 g 的方向,来修正陀螺仪积分得到的滚转角和俯仰角。

# 坐标系

姿态控制的反馈数据是姿态角,而姿态角的概念就是机体坐标系相对于参考坐标系(地理坐标系)

image-20250817202022830

image-20250817202209779

image-20250817202246093

image-20250817202636752

image-20250817202920589

image-20250817183031377

image-20250817183049099

image-20250817183943635

image-20250817184023377

image-20250817184048135

image-20250817184102241

image-20250817184118903

image-20250817184136859

image-20250817184151952

#

更新于 阅读次数