一种基于重心拉格朗日插值法的捷联惯导姿态解算方法

    公开(公告)号:CN107741228A

    公开(公告)日:2018-02-27

    申请号:CN201710372344.9

    申请日:2017-05-24

    Applicant: 北京大学

    Abstract: 本发明公开了一种基于重心拉格朗日插值法的捷联惯导姿态解算方法。该方法可以在器件带宽受限,不降低更新频率的前提下,提高更新周期内的采样点个数,利用多子样的等效旋转矢量算法进行姿态解算,提高解算精度。具体来说,该方法首先根据前几个周期采样的角速率信息,利用重心拉格朗日插值法计算当前更新周期内的插入角速率,再结合真实采样点进行本周期旋转矢量的计算,利用四元数更新方程求解姿态矩阵,并求解出更新周期内的姿态信息(姿态角)。本发明可以有效减少插值过程中的计算量,同时提高算法的解算精度。仿真实验表明:在同等传感器精度,相同更新频率和采样率的条件下,该方法可以将解算精度提升75%。

Patent Agency Ranking