六轴陀螺仪姿态解算研究

《六轴陀螺仪姿态解算研究》由会员上传分享，免费在线阅读，更多相关内容在应用文档-天天文库。

1、为了确保“教学点数字教育资源全覆盖”项目设备正常使用，我校做到安装、教师培训同步进行。设备安装到位后，中心校组织各学点管理人员统一到县教师进修学校进行培训，熟悉系统的使用和维护。六轴陀螺仪姿态解算研究　　摘要：六轴陀螺仪是三轴陀螺仪与三轴加速计的合称，它是在三轴陀螺仪这个传感器的基础上增加上三轴加速器这个元器件。由于六轴陀螺仪收集的加速度、角速度等数据会受到噪声信号的影响，所以要对这些收集到的数据进行滤波处理。在众多的滤波方式中，选用较为普遍的一阶互补滤波、卡尔曼滤波和DMP，在滤波后获得更加精

2、确的数据同时对这三种滤波方式进行对比。　　关键词：六轴陀螺仪；一阶互补滤波；卡尔曼滤波；DMP　　中图分类号：TP302文献标识码：A文章编号：1009--0243-02　　陀螺仪是自动控制系统中的一个信号传感器，因为它成本低、体积小、重量轻等优点被广泛运用于飞行器行业，为飞行器提供准确的方位、水平、位置、速度和加速度等信号。本文通过对六轴陀螺仪姿态解算的方法分析，来阐述六轴陀螺仪如何向飞行器的单片机反馈信号，同时在匿名上位机该仿真软件的帮助下，我们会分别使用三种算法对六轴陀螺仪的波形进行仿真测

3、试并记录，从而来分析各个滤波方式的优劣[1]。　　1一阶互补滤波为了充分发挥“教学点数字教育资源全覆盖”项目设备的作用，我们不仅把资源运用于课堂教学，还利用系统的特色栏目开展课外活动，对学生进行安全教育、健康教育、反邪教教育等丰富学生的课余文化生活。为了确保“教学点数字教育资源全覆盖”项目设备正常使用，我校做到安装、教师培训同步进行。设备安装到位后，中心校组织各学点管理人员统一到县教师进修学校进行培训，熟悉系统的使用和维护。　　因为MPU6050收集获得的加速度和角速度数据会被传感器噪声信号的影

4、响，从而使得我��不能直观的通过加速度和角速度这两个数据来获得该轴上的角度。所以我们需要对加速度和角速度这两个数据进行互补滤波来近似得到一个比较准确的角度。　　互补滤波算法可以同时滤除低频和高频的干扰，能更好地实现传感器的数据融合，以下为一阶互补滤波的实函数　　voidfilter　　{angle=K1*angle_m+*；　　//本次滤波的输出值=本次采样值+上次滤波的输出值　　}　　公式中angle_m和gyro_m分别是经过陀螺仪采集数据计算后得到的角度与角加速度；K1是对加速度计取值的权

5、重；dt是滤波器的采样时间。在获得上一次滤波的输出值以及本次陀螺仪采集得到数据的情况下，我们就可以通过该公式获得本次滤波后的输出值[2]。　　2卡尔曼滤波　　在测量方差已知的情况时，卡尔曼滤波能够从测量噪声的数据中估计动态系统的状态，所以卡尔曼滤波对于六轴陀螺仪收集的动态数据的处理有很大的帮助[3]。　　首先，卡尔曼滤波需要一个离散控制过程的系统，这一过程可以使用一个线性随机微分方程来描述：为了充分发挥“教学点数字教育资源全覆盖”项目设备的作用，我们不仅把资源运用于课堂教学，还利用系统的特色栏目

6、开展课外活动，对学生进行安全教育、健康教育、反邪教教育等丰富学生的课余文化生活。为了确保“教学点数字教育资源全覆盖”项目设备正常使用，我校做到安装、教师培训同步进行。设备安装到位后，中心校组织各学点管理人员统一到县教师进修学校进行培训，熟悉系统的使用和维护。　　上述方程中k表示一个实际的值，也就是第k时刻的真实量，比如X为第k时刻系统状态、Z为第k时刻测量值，而U则为第k时刻对系统的控制量。A和B为系统参数，是相对于多模型系统的矩阵；H为测量系统的参数，是相对于多测量系统的矩阵。W和V分别为过程

7、中的噪音及测量中的噪声。它们被假设为高斯白噪声，他们的协方差分别是Q和R。若以上条件满足，那么卡尔曼滤波将比较理想。　　在该系统中，需利用该过程模型去预测下一状态的系统，也即下一状态结果=上一状态结果+现在上状态控制量，公式为：　　接着在系统结果已经更新之后，我们需要对协方差进行更新，至于如何更新协方差呢，这就要使用到X、X的协方差，也就是下一状态和上一状态的协方差，其公式为：　　其中C表示协方差，A’表示A的转置矩阵，Q是系统过程的协方差。　　随着得到对系统的预测结果之后，我们便需要开始收集现

8、在状态的测量值。结合预测的结果及收集好的测量值，便可得到现今的最优估算值，相应公式为：　　上式中Kg为卡尔曼增益，由协方差和H矩阵计算得到，相应的公式为：　　有了第k时刻状态下最优的估算值X，我们还需更新这第k时刻状态下的协方差以便卡尔曼滤波能运行下去直至系统过程结束，该过程公式为：为了充分发挥“教学点数字教育资源全覆盖”项目设备的作用，我们不仅把资源运用于课堂教学，还利用系统的特色栏目开展课外活动，对学生进行安全教育、健康教育、反邪教教育等丰富学生的课余文化生活。为了确保“教学点数字教育资源全