一种基于多传感器数据融合的云台自稳控制方法

关键词：四元数 陀螺仪 加速度计 地磁计 姿态解算 

摘要：云台的稳定性对搭载的设备有重要影响,为实现云台自稳,设计了一种基于多传感器数据融合的云台自稳控制方法。采用三轴陀螺仪、三轴加速度计、三轴地磁的(Attitude and Heading Reference System,AHRS)系统获取角速度、加速度及地磁强度等信号,采用卡尔曼滤波算法对加速度进行处理,采用四元数对三种数据进行融合,并求解云台俯仰姿态角和偏航姿态角,使用串级双闭环PID作为控制策略。实验结果表明,该方法能够使云台在复杂环境下具有较高的精度和抗干扰能力,同时具有超调量小、鲁棒性强的特点。

控制工程杂志要求:

{1}全文注释采用当页脚注模式，用规范的中文或外文标点符号。编码用①、②、③……之类排序，每页重新编码。

{2}本刊可以对准备发表的文章酌情修改、删节，不愿本刊修改、删节者请随稿注明。

{3}作者姓名在题名下按序排列，排序应由全体作者共同讨论确定，稿件受理后不应再作改动。确需改动时，必须出示单位证明以及所有作者亲笔签名表明对署名改动无异议的书面证明。

{4}国家及省部级自然科学基金资助项目研究论文、国家及省部级获奖项目论文优先录用。

{5}正文按“前言、资料(对象)与方法、结果、讨论”的顺序书写，为一级标题；以下各级小标题按照：一、(一)、１．安排序号。

注：因版权方要求，不能公开全文，如需全文，请咨询杂志社