CAJ | 학술논문

针对微型四旋翼飞行器捷联惯性导航姿态解算中低成本 MEMS 器件易发散导致姿态漂移问题，基于四元数姿态更新算法，提出了一种自适应互补滤波姿态估计算法，该算法利用 MEMS 器件中的加速度计补偿陀螺仪偏差引起的姿态漂移误差，并根据陀螺仪频率响应的截止角速度分段调整补偿系数。最后，基于 ARM Cortex-M3内核设计了微型四旋翼飞行器，实验结果表明，该自适应互补滤波算法能有效、实时地跟踪四旋翼飞行器的三维姿态，提高姿态解算的测量精度，实现了飞行器的自主悬停。
침대미형사선익비행기첩련관성도항자태해산중저성본 MEMS 기건역발산도치자태표이문제，기우사원수자태경신산법，제출료일충자괄응호보려파자태고계산법，해산법이용 MEMS 기건중적가속도계보상타라의편차인기적자태표이오차，병근거타라의빈솔향응적절지각속도분단조정보상계수。최후，기우 ARM Cortex-M3내핵설계료미형사선익비행기，실험결과표명，해자괄응호보려파산법능유효、실시지근종사선익비행기적삼유자태，제고자태해산적측량정도，실현료비행기적자주현정。
In order to overcome the drift problem of low-cost MEMS inertial sensor in SINS attitude estimation, this paper presents a quaternion-based adaptive complementary filter for attitude estimation. The proposed algorithm uses the MEMS accelerometer to eliminate attitude estimation error caused by gyroscope bias and drift, and the compensation coefficient is adjusted by the piecewise function defined by gyroscope frequency response of cut-off angular velocity. Finally, a micro quadrotor is designed based on ARM Cortex-M3. The experimental results show that the adaptive complementary filter is able to effectively trace the quadrotor’s attitude in real time, improve the attitude estimation accuracy and then implement the autonomous hover of a micro quadrotor.