-
公开(公告)号:CN113776529A
公开(公告)日:2021-12-10
申请号:CN202111067339.X
申请日:2021-09-13
Applicant: 中国人民解放军海军工程大学
Abstract: 本发明涉及一种基于载体系四元数姿态误差的非线性误差模型,包括:使用三种不同的方法推导的基于乘性四元数姿态误差和加性四元数姿态误差的非线性误差模型,通过实验验证此三种方法的等价性,然后和基于导航系四元数姿态误差的非线性误差模型进行对比,通过实验比较两种模型的优劣,本发明改进现有文献对大失准条件下的组合导航模型研究的不足,该模型可在大失准条件下,通过较短时间内完成高精度的非线性组合导航,满足高精度的组合导航的要求。
-
公开(公告)号:CN102419181B
公开(公告)日:2014-03-12
申请号:CN201110264298.3
申请日:2011-09-08
Applicant: 中国人民解放军海军工程大学
IPC: G01C21/16
Abstract: 本发明公开了一种船舶惯导系统自主式无超调状态切换方法,有步骤:确定校正环节阻尼比,确定校正过程的时域参数,确定校正环节的截止频率,确定系统带宽,确定校正环节的两交接频率,确定校正环节低频段,确定校正环节高频段,确定校正环节衔接频段,确定校正环节的传动函数,确定切换时间,确定切换步长,确定校正前后的速度变化量,得到惯性器件输出的加速度和角速度,根据惯性器件的误差源对惯性器件输出进行补偿,对加速度信息进行积分得到速度,得到速度校正量,得到校正后速度,到校正后角速度信息并由舒拉回路反馈,校正后速度进行积分得到校正后的位置。本发明实现了不依赖外界速度的情况下,抑制因状态切换过程中产生的超调误差。
-
公开(公告)号:CN102419181A
公开(公告)日:2012-04-18
申请号:CN201110264298.3
申请日:2011-09-08
Applicant: 中国人民解放军海军工程大学
IPC: G01C21/16
Abstract: 本发明公开了一种船舶惯导系统自主式无超调状态切换方法,有步骤:确定校正环节阻尼比,确定校正过程的时域参数,确定校正环节的截止频率,确定系统带宽,确定校正环节的两交接频率,确定校正环节低频段,确定校正环节高频段,确定校正环节衔接频段,确定校正环节的传动函数,确定切换时间,确定切换步长,确定校正前后的速度变化量,得到惯性器件输出的加速度和角速度,根据惯性器件的误差源对惯性器件输出进行补偿,对加速度信息进行积分得到速度,得到速度校正量,得到校正后速度,到校正后角速度信息并由舒拉回路反馈,校正后速度进行积分得到校正后的位置。本发明实现了不依赖外界速度的情况下,抑制因状态切换过程中产生的超调误差。
-
公开(公告)号:CN113776529B
公开(公告)日:2024-04-19
申请号:CN202111067339.X
申请日:2021-09-13
Applicant: 中国人民解放军海军工程大学
Abstract: 本发明涉及一种基于载体系四元数非线性误差模型的姿态误差估计方法,包括:构建基于乘性四元数姿态误差和加性四元数姿态误差的非线性误差模型,然后通过车载实验得出基于载体系的四元数非线性误差模型性能优于基于导航系的四元数非线性误差模型,尤其是在初始航向角较大时基于载体系的四元数非线性误差模型性能较好。本发明改进现有文献对大失准条件下的组合导航模型研究的不足,该模型可在大失准条件下,通过较短时间内完成高精度的非线性组合导航,满足高精度的组合导航的要求。
-
公开(公告)号:CN116164773A
公开(公告)日:2023-05-26
申请号:CN202211099608.5
申请日:2022-09-06
Applicant: 中国人民解放军海军工程大学
Abstract: 本发明涉及一种基于载体系四元数姿态误差的李群捷联惯导误差模型,包括:四元数姿态误差可分为导航系四元数姿态误差和载体系四元数姿态误差,本发明首先推导基于载体系四元数的姿态误差模型,然后在此基础上提出并推导基于载体系四元数姿态误差的李群捷联惯导误差模型,本发明所提模型在组合导航定位精度、误差收敛速度以及滤波鲁棒性方面都有着显著优势,尤其是在大失准角条件下优势更为突出。通过实验比较四种模型的优劣,本发明改进现有文献对大失准角条件下的组合导航模型研究的不足,该模型可在大失准条件下,通过较短时间内完成高精度的非线性组合导航,满足高精度的组合导航的要求。
-
公开(公告)号:CN112857398B
公开(公告)日:2023-04-28
申请号:CN202110035848.8
申请日:2021-01-12
Applicant: 中国人民解放军海军工程大学
IPC: G01C25/00
Abstract: 本发明实施例提供了一种系泊状态下舰船的快速初始对准方法和装置,主要步骤包括:获取舰船上的传感器的实时数据;建立初始对准参考坐标系;建立系泊状态下的改进非线性初始对准误差模型及其离散化;基于所述获取的舰船传感器实时数据进行导航解算,生成所述舰船的姿态和速度;然后采用四元数无味估计器进行滤波估计;利用所述滤波器估计的状态参数,对所述姿态和速度进行闭环反馈校正,将校正后的姿态四元数转换成姿态欧拉角实时输出,直至对准过程结束。本发明优点在于考虑了矢量投影坐标系的一致性问题,将姿态四元数误差和速度误差统一投影至计算导航坐标系中,优化了误差模型,具有缩短对准时间,提升对准精度的特点。
-
公开(公告)号:CN113340297B
公开(公告)日:2022-08-09
申请号:CN202110438121.4
申请日:2021-04-22
Applicant: 中国人民解放军海军工程大学
Abstract: 本发明属于惯性导航技术领域,公开了一种基于坐标系传递的姿态估计方法、系统、终端、介质及应用,建立用于姿态计算的参考坐标系r、载体坐标系以及用于滤波的参考坐标系进行姿态误差定义,进行sigma点采样并构造全局姿态所对应的sigma点;将姿态sigma点在姿态运动学方程中传递并构造传递后的姿态误差sigma点;进行UKF预测及预测方差计算,并分别进行UKF量测更新以及全局姿态更新;进行姿态误差估计置零;进入滤波流程。本发明能充分发挥UKF在非线性状态估计中的优势,实现对载体姿态信息的有效估计。从坐标系的角度明确姿态误差的含义,避免了传统以位置作为姿态误差区分而引起的含义不明确的问题。
-
公开(公告)号:CN113051757A
公开(公告)日:2021-06-29
申请号:CN202110312139.X
申请日:2021-03-23
Applicant: 中国人民解放军海军工程大学
IPC: G06F30/20 , G01C21/16 , G01C25/00 , G06F119/02
Abstract: 本发明公开了一种捷联惯导广义PSI角误差模型及其构建方法,本发明通过坐标系分解,将载体姿态矩阵分解为载体角运动激励项和线运动激励项,其中角运动激励项所对应的误差方程即为广义PSI角误差模型中的姿态误差方程,线运动激励项所对应的误差方程即为广义PSI角误差模型中的位置误差方程。本发明在不引入近似速度误差项的前提下,实现姿态角误差模型独立于速度和位置误差的优势;同时,所有误差方程推导中严格遵守姿态矩阵(四元数)的链式相乘法则,一方面使得推导过程清晰明了,另一方面也使得推导的误差方程在滤波应用中更为直观地进行惯导解算结果修正;此外,速度误差方程考虑到中蕴含的误差,提高误差模型精度。
-
公开(公告)号:CN113051757B
公开(公告)日:2022-08-09
申请号:CN202110312139.X
申请日:2021-03-23
Applicant: 中国人民解放军海军工程大学
IPC: G06F30/20 , G01C21/16 , G01C25/00 , G06F119/02
Abstract: 本发明公开了一种捷联惯导广义PSI角误差模型构建方法,本发明通过坐标系分解,将载体姿态矩阵分解为载体角运动激励项和线运动激励项,其中角运动激励项所对应的误差方程即为广义PSI角误差模型中的姿态误差方程,线运动激励项所对应的误差方程即为广义PSI角误差模型中的位置误差方程。本发明在不引入近似速度误差项的前提下,实现姿态角误差模型独立于速度和位置误差的优势;同时,所有误差方程推导中严格遵守姿态矩阵(四元数)的链式相乘法则,一方面使得推导过程清晰明了,另一方面也使得推导的误差方程在滤波应用中更为直观地进行惯导解算结果修正;此外,速度误差方程考虑到中蕴含的误差,提高误差模型精度。
-
公开(公告)号:CN113340297A
公开(公告)日:2021-09-03
申请号:CN202110438121.4
申请日:2021-04-22
Applicant: 中国人民解放军海军工程大学
Abstract: 本发明属于惯性导航技术领域,公开了一种基于坐标系传递的姿态估计方法、系统、终端、介质及应用,建立用于姿态计算的参考坐标系r、载体坐标系以及用于滤波的参考坐标系进行姿态误差定义,进行sigma点采样并构造全局姿态所对应的sigma点;将姿态sigma点在姿态运动学方程中传递并构造传递后的姿态误差sigma点;进行UKF预测及预测方差计算,并分别进行UKF量测更新以及全局姿态更新;进行姿态误差估计置零;进入滤波流程。本发明能充分发挥UKF在非线性状态估计中的优势,实现对载体姿态信息的有效估计。从坐标系的角度明确姿态误差的含义,避免了传统以位置作为姿态误差区分而引起的含义不明确的问题。
-
-
-
-
-
-
-
-
-