基于安芯一号的六轴姿态控制板设计

　　一、项目设计背景及概述

　　在许多工程应用中，都需要测量载体与水平面的倾斜角度。对于导航定位系统来说，姿态信息更是一个重要参数。本系统主要目标是在动态情况下通过姿态融合得到精确的俯仰角和横滚角。首先采用加速度传感器测量倾斜角度，并对测量角进行数据预处理以减少误差，其次加入陀螺仪进行姿态融合，主要方法为卡尔曼滤波，得到系统的横滚角和俯仰角。该方法广泛应用于工程中，技术成熟，姿态融合效果良好。

　　惯性测量单元在飞行器制造、传感器技术领域都能见其身影，应用前景十分广泛。一般的，一个IMU包含了三个单轴的加速度计和三个单轴的陀螺，加速度计检测物体在载体坐标系统独立三轴的加速度信号，而陀螺检测载体相对于导航坐标系的角速度信号，测量物体在三维空间中的角速度和加速度，并以此解算出物体的姿态。在导航中用着很重要的应用价值。

　　为了提高可靠性，还可以为每个轴配备更多的传感器。一般而言IMU要安装在被测物体的重心上。IMU大多用在需要进行运动控制的设备，如汽车和机器人上。也被用在需要用姿态进行精密位移推算的场合，如潜艇、飞机、导d和航天器的惯性导航设备等。利用三轴加速度计，受外力加速度影响很大，在运动/振动等环境中，输出方向角误差较大。加速度测量的是重力方向，在无外力加速度的情况下，能准确输出ROLL/PITCH两轴姿态角度，并且此角度不会有累积误差，在更长的时间尺度内都是准确的。但是加速度传感器测角度的缺点是加速度传感器实际上是用MEMS技术检测惯性力造成的微小形变，而惯性力与重力本质是一样的，所以加速度计就不会区分重力加速度与外力加速度，当系统在三维空间做变速运动时，它的输出就不正确了。

　　二、项目设计原理

　　1、 原理概述

　　陀螺仪输出角速度，是瞬时量，角速度在姿态平衡上是不能直接使用，需要角速度与时间积分计算角度，得到的角度变化量与初始角度相加，就得到目标角度，其中积分时间Dt越小，输出角度越精确，但陀螺仪的原理决定了它的测量基准是自身，并没有系统外的绝对参照物，加上Dt是不可能无限小，所以积分的累积误差会随着时间流逝迅速增加，最终导致输出角度与实际不符，所以陀螺仪只能工作在相对较短的时间尺度内。

　　所以在没有其它参照物的基础上，要得到较为真实的姿态角，就要利用加权算法扬长避短，结合两者的优点，摈弃其各自缺点，设计算法在短时间尺度内增加陀螺仪的权值，在更长时间尺度内增加加速度权值，这样系统输出角度就接近真实值了。