一种用于水下无人航行器在极区导航的初始粗对准方法

    公开(公告)号:CN107894240A

    公开(公告)日:2018-04-10

    申请号:CN201711173667.1

    申请日:2017-11-22

    CPC classification number: G01C25/005

    Abstract: 本发明公开了一种用于水下无人航行器在极区导航的初始粗对准方法。根据在极区所处位置经纬度,确定初始对准时刻,地心地固坐标系e到格网坐标系G之间的方向余弦矩阵 根据时间间隔Δt确定惯性坐标系与地心地固坐标系之间的方向余弦矩阵 根据捷联惯导系统中陀螺仪输出,确定载体坐标系b到初始时刻与惯性坐标系相固连的载体坐标系b0之间的方向余弦矩阵 ;确定初始对准时刻与惯性坐标系固连的载体坐标系b0到惯性坐标系i的方向余弦矩阵 ;确定载体坐标系b到格网坐标系G方向余弦矩阵 ;解算提取经过初始粗对准后得到的φx,φy和φz以及δφx,δφy和δφz。本发明可有效实现水下无人航行器在极区航行过程中的粗对准,相比于传统粗对准方法在极区应用有更好的精度。

Patent Agency Ranking