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

. .下载可编辑. 基于惯性传感器的机器人姿态监测系统设计 一、设计背景 空间飞行器的惯性测量系统、机器人的平衡姿态检测、机械臂伸展确定等许 多方面都需要测量物体的倾斜和方向等姿态参数。 机器人的运动过程中要不断的 检测机器人的运动状态，以实现对机器人的精确控制。 ?本文研究的基于 MEMS 惯性传感器姿态检测系统用于检测自平衡机器人运动时姿态， 以控制机器人的平 衡。 随着微机电系统（MEM）技术的发展，采用传感器应用到姿态检测系统上的 条件变得成熟。基于MEMS技术的加速度传感器和陀螺仪具有抗冲击能力强、 可 靠性高、寿命长、成本低等优点，是适用于构建姿态检测系统的惯性传感器。利 用MEMS它螺仪和加速度传感器等惯性传感器组成的姿态检测系统， 能够通过对 重力矢量夹角和系统转动角速度进行测量，从而实时、准确地检测系统的偏转角 度。 由于惯性传感器随着时间、温度的外界变化，会产生不同程度的漂移。通过 对陀螺仪和加速度计的采集数据进行数据融合， 测量的角度与实际的角度相吻合， 取得了良好的控制效果。同时该系统具有独立，易用的特点，其应用前景广泛。 基本原理 在地球上任何位置的物体都受到重力的作用而产生一个加速度， 加速度传感 器可以用来测定变化或恒定的加速度。把三轴加速度传感器固定在物体上，在相 对静止状态下，当物体姿态改变时，加速度传感器的敏感轴相对于重力场发生变 化，加速度传感器的三个敏感轴分别输出重力在其相应方向产生的分量信号。 当系统处于变速运动状态时，由于加速度传感器同时受到重力加速度和系统 自身加速度的影响，其返回值是重力加速度同系统自身加速度的矢量和。 对加速 度传感器温度漂移及系统振动和机械噪声等方面的考虑，加速度传感器不能独立 运用测量系统的姿态。陀螺仪能够提供瞬间的动态角度变化，由于其本身的固有 特性、温度及积分过程的影响，它会随着工作时间的延长产生漂移误差。 因此对 于姿态检测系统而言，单独使用陀螺仪或加速度计，都不能提供系统姿态的可靠 估计。为了克服这些问题，数据融合算法需使用加速度传感器的测量值并使用陀 螺仪测得的角速度数据对加速度传感器数据进行融合和矫正。 （a）初始状态5）加連用传憊 器坐标累5）世标系他忆甲面投影 （a）初始状态 5）加連用传憊 器坐标累 5）世标系他忆甲面投影 图1加速度传感器 系统依据上一时刻的重力矢量方向的估计值， 结合陀螺仪测得的角度值计算 出当前时刻的重力矢量方向，再与当前时刻加速度传感器返回的矢量方向进行加 权平均，得到当前矢量方向的最优估计值。 三、系统框架 姿态平衡检测系统中，控制单元采用单片机来完成控制，数据采集与处理， 数据通讯等功能。根据对资料的分析，同时对性能价格比的衡量，惯性测量单元 采用Analog Device 公司的ADXRS150陀螺仪）和ADXL202加速度计）。其基本 性能指标如下。 ADXRS15其输出电压与偏航角速度成正比，电压的极性则代表转动方向（顺 时针转动或逆时针转动）。其测量偏航角速度（以下简称为角速度）的范围是土 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°，但是单纯的使用，由于积分计算及噪声影响会使得角度测 量误差超出允许的测量范围，所以从硬件和滤波算法上进行校正和数据融合， 以 完成机器人偏转角度的精确测量。 系统框架图如图2所示. 图2姿态检测系统框架图 四、电路设计 对于这个姿态检测系统，其检测电路分为两个部分：陀螺仪信号采集和加速 度计信号采集。陀螺仪输出模拟信号，加速度计输出的是脉冲信号。 1陀螺仪的电路设计 1.1滤波电路 ADXRS15C型微机械陀螺属于芯片级微机械陀螺，陀螺仪本身容易受到高频 信号及其他外在因素的影响，导致其信号输出的不稳定。为了有效滤除陀螺仪的 高频信号，在陀螺仪的输出上增加 But-terworth 低通滤波电路。经过滤波电路 再连接到单片机的A/D端，从而减少了数据处理的干扰，提高了检测精度，滤波 电路如图3所示。 I 5kQ 7 瞪祕一＞MCU± 0J u F~34 5kCLTCI0636 7 瞪祕一＞MCU ± 0J u F~3 4 5kC LTCI063 6 13kQ T 0.1卩卜 200 pF 图3陀螺仪的滤波电路 1.2陀螺仪的基本电路 陀螺仪的基本电路主要由