惯性单元(inertial unit)

惯性单元位于机器人胸部,带有自己的处理器。输出数据为胸部的速度和高度(Yaw、Pitch、Roll)的估计值。中心单元由以下部分组成:

Nao frame

躯干角度计算法

Aldebaran计算法根据加速计和陀螺仪的数据计算躯干角度,在惯性电路板内部编程。

该计算法恰当地使用每个传感器的特点。静态时,加速计是唯一的绝对参照,提供正确的躯干角度。当探测到动作时,输出角度便由适合在动态模式下使用的陀螺仪来计算。然而,使用陀螺仪会引起计算角度偏差。因此,在动态模式下,计算法会结合加速计和陀螺仪的计算角度来缩小角度偏差。

相对于躯干框架的位置

器件 X(m) Y(m) Z(m)
加速计 -0.008 0.00606 0.027
陀螺仪 -0.008 0.006 0.029

访问值时,使用ALMemory 关键码名

原始数据加速计(m/s²):

Device/SubDeviceList/InertialSensor/AccX/Sensor/Value Device/SubDeviceList/InertialSensor/AccY/Sensor/Value Device/SubDeviceList/InertialSensor/AccZ/Sensor/Value

原始数据陀螺仪(弧度/s):

Device/SubDeviceList/InertialSensor/GyrX/Sensor/Value Device/SubDeviceList/InertialSensor/GyrY/Sensor/Value

过滤数据(弧度):

Device/SubDeviceList/InertialSensor/AngleX/Sensor/Value Device/SubDeviceList/InertialSensor/AngleY/Sensor/Value





Copyright © 2010 Aldebaran-Robotics - 版权所有