-
公开(公告)号:CN110763188A
公开(公告)日:2020-02-07
申请号:CN201910976972.7
申请日:2019-10-15
Applicant: 哈尔滨工程大学
IPC: G01C5/00
Abstract: 本发明涉及一种适用于捷联惯导系统的带杆臂补偿的升沉测量方法,所述方法包括如下步骤:给定初始导航参数t=0时刻:捷联惯导系统初始对准得到初始纵摇姿态角θ(0)、初始横摇姿态角γ(0)、初始艏摇角ψ(0)、主航向角ζ(0);系统设置采样周期h,实时采集三个轴上陀螺和加速度计的输出信号;递推测量tk时刻载体坐标系b与半固定坐标系s的关系矩阵;利用方向余弦矩阵 和加速度计的输出计算得到捷联惯导系统安装点处的升沉加速度;利用陀螺的输出和捷联惯导系统安装点与舰船重力中心点之间的杆臂误差在载体坐标系的投影得到重力中心处的升沉加速度;升沉滤波器F(k)对重力中心处的升沉加速度进行滤波处理。本发明实现了捷联惯导系统带杆臂补偿的的升沉测量,提高了船舶的可操作性。
-
公开(公告)号:CN110763188B
公开(公告)日:2021-07-23
申请号:CN201910976972.7
申请日:2019-10-15
Applicant: 哈尔滨工程大学
IPC: G01C5/00
Abstract: 本发明涉及一种适用于捷联惯导系统的带杆臂补偿的升沉测量方法,所述方法包括如下步骤:给定初始导航参数t=0时刻:捷联惯导系统初始对准得到初始纵摇姿态角θ(0)、初始横摇姿态角γ(0)、初始艏摇角ψ(0)、主航向角ζ(0);系统设置采样周期h,实时采集三个轴上陀螺和加速度计的输出信号;递推测量tk时刻载体坐标系b与半固定坐标系s的关系矩阵;利用方向余弦矩阵和加速度计的输出计算得到捷联惯导系统安装点处的升沉加速度;利用陀螺的输出和捷联惯导系统安装点与舰船重力中心点之间的杆臂误差在载体坐标系的投影得到重力中心处的升沉加速度;升沉滤波器F(k)对重力中心处的升沉加速度进行滤波处理。本发明实现了捷联惯导系统带杆臂补偿的的升沉测量,提高了船舶的可操作性。
-