基于惯性传感器的机器人姿态监测系统设计说明

1、.下载可编辑.基于惯性传感器的机器人姿态监测系统设计一、设计背景空间飞行器的惯性测量系统、机器人的平衡姿态检测、机械臂伸展确定等许 多方面都需要测量物体的倾斜和方向等姿态参数。 机器人的运动过程中要不断的 检测机器人的运动状态，以实现对机器人的精确控制。本文研究的基于 MEMS惯性传感器姿态检测系统用于检测自平衡机器人运动时姿态，以控制机器人的平衡。随着微机电系统（MEM）技术的发展，采用传感器应用到姿态检测系统上的 条件变得成熟。基于 MEMS 技术的加速度传感器和陀螺仪具有抗冲击能力强、 可 靠性高、寿命长、成本低等优点，是适用于构建姿态检测系统的惯性传感器。利 用 MEMS 它螺仪和加速

2、度传感器等惯性传感器组成的姿态检测系统，能够通过对重力矢量夹角和系统转动角速度进行测量，从而实时、准确地检测系统的偏转角 度。由于惯性传感器随着时间、温度的外界变化，会产生不同程度的漂移。通过 对陀螺仪和加速度计的采集数据进行数据融合， 测量的角度与实际的角度相吻合， 取得了良好的控制效果。同时该系统具有独立，易用的特点，其应用前景广泛。基本原理在地球上任何位置的物体都受到重力的作用而产生一个加速度，加速度传感器可以用来测定变化或恒定的加速度。把三轴加速度传感器固定在物体上，在相 对静止状态下，当物体姿态改变时，加速度传感器的敏感轴相对于重力场发生变 化，加速度传感器的三个敏感轴分别输出重力在

3、其相应方向产生的分量信号。当系统处于变速运动状态时，由于加速度传感器同时受到重力加速度和系统 自身加速度的影响，其返回值是重力加速度同系统自身加速度的矢量和。 对加速 度传感器温度漂移及系统振动和机械噪声等方面的考虑，加速度传感器不能独立 运用测量系统的姿态。陀螺仪能够提供瞬间的动态角度变化，由于其本身的固有 特性、温度及积分过程的影响，它会随着工作时间的延长产生漂移误差。因此对.下载可编辑.于姿态检测系统而言，单独使用陀螺仪或加速度计，都不能提供系统姿态的可靠 估计。为了克服这些问题，数据融合算法需使用加速度传感器的测量值并使用陀 螺仪测得的角速度数据对加速度传感器数据进行融合和矫正。图 1

4、 加速度传感器系统依据上一时刻的重力矢量方向的估计值， 结合陀螺仪测得的角度值计算 出当前时刻的重力矢量方向，再与当前时刻加速度传感器返回的矢量方向进行加 权平均，得到当前矢量方向的最优估计值。三、系统框架姿态平衡检测系统中，控制单元采用单片机来完成控制，数据采集与处理， 数据通讯等功能。根据对资料的分析，同时对性能价格比的衡量，惯性测量单元 采用 AnalogDevice 公司的 ADXRS150 陀螺仪）和 ADXL202 加速度计）。其基本 性能指标如下。ADXRS15 其输出电压与偏航角速度成正比，电压的极性则代表转动方向（顺 时针转动或逆时针转动）。其测量偏航角速度（以下简称为角速度

5、）的范围是土 150 rad/s，灵敏度为 12.5 mV/rad/s，零位输出电压为 2.50 V，非线性误差为 0.1%F.S.,稳定度为土 0.03 rad /s，-3 dB 带宽为 40 Hz,固有频率为 14 kHz,-1角速度噪声密度为0.05 ?s 7HZ2。ADXL202 是 一款双轴的加速度传感器，可测量正负加速度，其最大测量范围 为土 2gn。灵敏度 12.5 %/gn，-3 dB 带宽为 6 kHz。从技术指标可以知道能满足 在测量角度0.25，但是单纯的使用，由于积分计算及噪声影响会使得角度测5）加連用传憊器坐标累5）世标系他忆甲面投影（a）初始状态.下载可编辑.量误差

6、超出允许的测量范围，所以从硬件和滤波算法上进行校正和数据融合，以完成机器人偏转角度的精确测量。系统框架图如图 2 所示.图 2 姿态检测系统框架图四、电路设计对于这个姿态检测系统，其检测电路分为两个部分：陀螺仪信号采集和加速 度计信号采集。陀螺仪输出模拟信号，加速度计输出的是脉冲信号。1 陀螺仪的电路设计1.1 滤波电路ADXRS15C 型微机械陀螺属于芯片级微机械陀螺，陀螺仪本身容易受到高频 信号及其他外在因素的影响，导致其信号输出的不稳定。为了有效滤除陀螺仪的 高频信号，在陀螺仪的输出上增加 But-terworth 低通滤波电路。经过滤波电路 再连接到单片机的A/D 端，从而减少了数据处

7、理的干扰，提高了检测精度，滤波 电路如图 3 所示。.下载可编辑.I5kQ图 3 陀螺仪的滤波电路1.2 陀螺仪的基本电路陀螺仪的基本电路主要由 ADXRS15 组成，为提高可移植性，将它与必要的外围电阻，电容集成在同一模块，可以直接应用于其他的系统中，如图4 所示,实际完成后的陀螺仪模块。2 加速度计的电路设计2.1 加速度的基本电路ADXL202 是 一个双轴的加速度计，可以测量运动和静态的加速度。静态加速 度的一个特殊例子是重力加速度。当加速度传感器静止时（也就是侧面和垂直方 向没有7瞪祕一MCU 0J u F34 5kCLTCI063T0.1 卩卜200 pF613kQ.下载可编辑.加

8、速度作用），那么作用在它上面的只有重力加速度。重力（垂直）和加速.下载可编辑.度传感器灵敏轴之间的夹角就是倾斜角。 就是说可将加速度计用作倾角计。因为 角度由灵敏轴和重力矢量组成的垂直平面决定，倾斜可以从各种初始的加速度传 感器位置测得。在大多数设计中，加速度传感器的位置由水平或者垂直的 PCB 印 刷电路板）决定。这里选择了垂直的放置方法，如图 5 所示。图 5 加速度计的垂直放置及加速度的计算方法基于垂直位置的倾斜角，可以测量大于 90 的倾斜角时。通过加速度传感器 的 x和 y 轴的结合起来得到在 360范围内都有比较好分辨率。同时执行了这个 转换过程后就不用对加速度传感器进行温度补偿了

9、， 因为两个轴的输出都是相同 的变化幅度，所以灵敏度随温度的变化对比值的计算没有影响。加速度计电路主要由 ADXL202 勾成，并辅助以一些滤波及调节电路；通过系 统控制电路处理 ADXL20 計生的占空比调制信号；采样电路中滤波电容选择 Cx, Cy 为0.1 尸，滤波带宽为 50 Hz,选择的周期 T2 的电阻为 130kQ,T2=1.04 ms 利用加速度计可以实现倾角传感器。 ADXL202 勺原理图如图 6 所示：Ag）=（斥/心 45）/25%Og=5O%l3uty CycleT =RscxJ 25M.下载可编辑.YSil I图 6 ADXL202 的测量原理图输出信号 Xout,

10、 Yout 连接到单片机，对与加速度成正比的占空比的方波进行处 理，通过下面的公式得到偏转的角度。0= tan-lA?Ay)2.2 参数标定由于器件参数的差异，芯片的基本参数(0gn,1gn)也不完全相同。因此，当要求测量精度较高时仍使用参数典型值就会引起误差。要提高测量的精度，就需要在测量前对相关参数认真标定。采用“ 1gn 标定方法”来对加速度计的参数进 行标定，标定后的参数如下：Ax= (T1/T2-0.46327)/12.5%Ay= (T1/T2-0.52941)/12.5%以上就是机器人的姿态平衡控制系统，其相应的控制板如图 7 所示.控制系 统由Mi-crochip 公司的 PIC18F458 进行数据处理，完成数据处理后通过串口通 信发送到电机控制系统板，以驱动电机来完成机器人的姿态平衡动作。5VIVIM oSTY(IU1 2YCOMOUTYtnilPoeA”吊脚IB