燕山大学学报
燕山大學學報
연산대학학보
JOURNAL OF YANSHAN UNIVERSITY
2014年
2期
175-180
,共6页
姿态%四元数%互补滤波%稳定性分析
姿態%四元數%互補濾波%穩定性分析
자태%사원수%호보려파%은정성분석
attitude%quaternion%complementary filtering%stability analysis
针对无人机低成本姿态解算这一基本问题,考虑到传统姿态算法运算量大、不易调试,采用微惯性单元(MEMS)测量无人机原始姿态数据,采用基于四元数的互补滤波算法,有效降低姿态解算的运算量,实现MEMS各传感器的信息融合。从理论上证明了基于四元数的互补滤波器的稳定性,分析了滤波器的性能。采用无人机真实数据验证了算法的有效性,解算得到的俯仰角、滚转角精度小于1°,航向角精度小于2°。与传统姿态算法比较,本算法简单有效、运算量小、易于调试。
針對無人機低成本姿態解算這一基本問題,攷慮到傳統姿態算法運算量大、不易調試,採用微慣性單元(MEMS)測量無人機原始姿態數據,採用基于四元數的互補濾波算法,有效降低姿態解算的運算量,實現MEMS各傳感器的信息融閤。從理論上證明瞭基于四元數的互補濾波器的穩定性,分析瞭濾波器的性能。採用無人機真實數據驗證瞭算法的有效性,解算得到的俯仰角、滾轉角精度小于1°,航嚮角精度小于2°。與傳統姿態算法比較,本算法簡單有效、運算量小、易于調試。
침대무인궤저성본자태해산저일기본문제,고필도전통자태산법운산량대、불역조시,채용미관성단원(MEMS)측량무인궤원시자태수거,채용기우사원수적호보려파산법,유효강저자태해산적운산량,실현MEMS각전감기적신식융합。종이론상증명료기우사원수적호보려파기적은정성,분석료려파기적성능。채용무인궤진실수거험증료산법적유효성,해산득도적부앙각、곤전각정도소우1°,항향각정도소우2°。여전통자태산법비교,본산법간단유효、운산량소、역우조시。
Aiming at the basic problem of attitude estimation of unmanned aerial vehicles, in consideration of the quality of the traditional algorithm which is complex and hard to debug, MEMS is used to measure the data of UAV primitive attitude. Quaternion complementary filtering algorithm is applied to reduce the operation quantity of attitude estimation and make the fuse of information collected by every sensor. The complementary filter stability based on quaternion is theoretically proved. And the quality of filter was analysed here. The effectiveness of the algorithm used here is testified by real data from UAV. The precision of pitch and yaw are less than 1° and 2° respectively. Compared with traditional attitude algorithm, this algorithm is simple and effective, small computational complexity, and easy to debug.