柱塞气举工艺下基于重力观测的MEMS全姿态位姿测量系统

为解决柱塞小体积自主高精度位姿测量的难题,针对柱塞气举工艺,设计了一种基于重力观测的微机电系统（MEMS）全姿态位姿测量系统。首先,利用柱塞工作过程中大部分时间不存在非重力运动加速度的特性,设计了基于重力观测的自主导航算法提高位姿测量精度;其次,考虑到柱塞垂直运动过程中俯仰翻转时无解的问题,设计了全姿态解算算法。最后,对所设计的位姿测量系统进行了实物实验。实验结果表明：所设计的位姿测量系统进行作业时,水平姿态精度不大于0.05°、航向漂移小于0.5°/h、短时位置精度不大于0.8 m,验证了该系统可解决柱塞目前存在的小体积自主高精度位姿测量难题。