一种基于法向量的全球SINS/DVL/PS组合导航方法

    公开(公告)号:CN119043307A

    公开(公告)日:2024-11-29

    申请号:CN202411166230.5

    申请日:2024-08-23

    Abstract: 本发明属于组合导航技术领域,具体涉及一种基于法向量的全球SINS/DVL/PS组合导航方法,本发明的目的通过如下技术方法来实现,包括以下步骤:提出基于虚拟圆球法向量的位置表示方法;推导基于法向量的捷联式惯性导航机械编排;建立SINS/DVL/PS组合导航系统的状态空间模型;应用虚拟极区技术将中低纬度数据转换到高纬度;利用仿真试验和湖面试验对所提算法的有效性和优越性进行验证,本发明采用无奇异的法向量来表示运载体的水平位置,基于此设计的SINS/DVL/PS组合导航系统能够在单一机械编排的条件下实现全球范围内的组合导航,与现有的全球组合导航方案相比无需对导航坐标系进行切换,且具有更高的导航精度。

    一种水下航行器未知输入与位置估计方法及系统

    公开(公告)号:CN116702479B

    公开(公告)日:2024-02-06

    申请号:CN202310690334.5

    申请日:2023-06-12

    Abstract: 本申请公开了一种水下航行器未知输入与位置估计方法及系统,方法包括:获取水下航行器的航行数据,并基于航行数据构建系统状态空间模型;对系统状态空间模型中的量测方程进行第一次优化,得到优化后量测方程,并基于优化后量测方程构建延时递推框架;基于延时递推框架,搭建未知非线性控制输入和延时到达观测信息之间的递推关联;基于递推关联得到未知非线性控制输入估计值;基于未知非线性控制输入估计值,得到位置状态后验估计表达式和第一估计误差协方差表达式;对后验估计表达式进行第二次优化,得到最终位置状态表达式和第二估计误差协方差表达式。本申请缓解观测值中的延时偏

    水下航行器在非高斯噪声干扰下的位置估计方法及系统

    公开(公告)号:CN116680500A

    公开(公告)日:2023-09-01

    申请号:CN202310690292.5

    申请日:2023-06-12

    Abstract: 本发明公开了水下航行器在非高斯噪声干扰下的位置估计方法及系统,所述方法包括以下步骤:根据获取的水下航行器的位置数据、速度数据与航向数据,构建协同定位系统状态空间模型;在得到基于线性化误差补偿的优化量测方程的基础上,构建增广状态模型;利用增广状态模型,基于student'st核函数和最小误差熵准则,构建代价函数;基于代价函数,求得后验状态估计的加权最小二乘表达形式;基于后验状态估计的加权最小二乘表达形式,使用矩阵求逆引理得到后验状态估计及相应的估计误差协方差矩阵的最终表达形式,完成水下航行器的位置估计。本发明能够有效削弱非高斯噪声对位置估计的影响,提高水下航行器在非理想作业环境中的定位精度。

    一种基于统计相似度量的组合导航鲁棒滤波方法

    公开(公告)号:CN113819906B

    公开(公告)日:2023-07-21

    申请号:CN202111115235.1

    申请日:2021-09-23

    Abstract: 本发明属于非理想条件下的组合导航技术领域,具体涉及一种基于统计相似度量的组合导航鲁棒滤波方法。本发明考虑SINS/DVL紧组合系统中正常的DVL波束测量信息和大误差的波束测量信息同时出现的情形,针对目前现有的组合导航系统鲁棒滤波器对量测信息处理粗糙,导致正常量测信息易丢失的问题,基于多维量测方程分解和统计相似度量提出了新的鲁棒滤波方法。本发明在将SINS/DVL紧组合导航系统的多维量测方程进行分解的同时,引入统计相似度量(SSM)理论,协助每个波束的测量噪声方差在大测量误差出现时完成各自的自适应更新,最终保证每个波束测量信息处理的独立性。本发明可用于非理想条件下的水下航行器组合导航领域。

    一种短时高精度姿态保持方法

    公开(公告)号:CN115855038A

    公开(公告)日:2023-03-28

    申请号:CN202211465410.4

    申请日:2022-11-22

    Abstract: 本发明公开一种短时高精度姿态保持方法,包括:获取陀螺仪输出和加速度计输出;基于加速度计输出和当地重力加速度,得到自身初始姿态信息;基于自身初始姿态信息和陀螺仪输出,得到航向角,作为航向输出;基于加速度计输出和当地重力加速度,得到俯仰角和横揺角,并进行低通滤波处理,将低通滤波处理后的俯仰角和横揺角作为水平姿态输出,实现姿态测量。本发明能够在不依赖任何外界信息的条件下快速完成初始姿态的确定,后续姿态测量也无需接受任何外界信息,抗干扰能力强。经过剧烈角运动后仍能实现高精度的姿态测量,提高姿态计算的精度,实现较低成本条件下的高精度姿态测量。

    一种INS/DVL组合导航系统鲁棒智能协同校准方法

    公开(公告)号:CN112525218B

    公开(公告)日:2023-01-03

    申请号:CN202011318583.4

    申请日:2020-11-23

    Abstract: 本发明公开了一种INS/DVL组合导航系统鲁棒智能协同校准方法,步骤一:建立包括状态方程和量测方程在内的传统INS/DVL系统模型;步骤二:采用基于声测距的交替校正算法对海洋无人运动平台进行校正;步骤三:利用基于统计相似度度量的鲁棒卡尔曼滤波器滤除输出异常值。本发明涉及的基于水声测距的交替校正算法不需要参考站点或者母船的支持,不仅扩大了海洋无人运动平台的工作范围,而且进一步提高了其定位精度;本发明鲁棒滤波器计算量小于现有的鲁棒滤波器,在高采样频率的导航应用中更具优势,而且对于异常值造成的非高斯场景其鲁棒性强于现有的鲁棒滤波器,本发明定位精度优于传统的INS/DVL组合导航系统。

    一种改进ANFIS的多AUV协同定位量测异常检测方法

    公开(公告)号:CN114199249A

    公开(公告)日:2022-03-18

    申请号:CN202111448261.6

    申请日:2021-11-30

    Abstract: 本发明属于多AUV协同定位技术领域,具体涉及一种改进ANFIS的多AUV协同定位量测异常检测方法。针对水下声学测距误差对AUV协同定位系统定位性能的影响,本发明以准确识别并隔离异常信息、保留准确信息为目标,利用ACKF提取特征信息,并基于预定义的量测异常状态,建立满足伯努利分布的混合数据库,实现了ANFIS规则的在线更新,有效提高了检测系统在少量“样本数据”情况下的可靠性和准确性。本发明将在线数据训练机制与基于ANFIS的异常检测系统相结合,利用ANFIS规则的检测输出对异常时刻的量测信息进行隔离,设置伯努利分布的标志位对滤波方程进行更改,有效提高了协同定位系统定位精度及稳定性。

    一种INS/DVL组合导航系统鲁棒智能协同校准方法

    公开(公告)号:CN112525218A

    公开(公告)日:2021-03-19

    申请号:CN202011318583.4

    申请日:2020-11-23

    Abstract: 本发明公开了一种INS/DVL组合导航系统鲁棒智能协同校准方法,步骤一:建立包括状态方程和量测方程在内的传统INS/DVL系统模型;步骤二:采用基于声测距的交替校正算法对海洋无人运动平台进行校正;步骤三:利用基于统计相似度度量的鲁棒卡尔曼滤波器滤除输出异常值。本发明涉及的基于水声测距的交替校正算法不需要参考站点或者母船的支持,不仅扩大了海洋无人运动平台的工作范围,而且进一步提高了其定位精度;本发明鲁棒滤波器计算量小于现有的鲁棒滤波器,在高采样频率的导航应用中更具优势,而且对于异常值造成的非高斯场景其鲁棒性强于现有的鲁棒滤波器,本发明定位精度优于传统的INS/DVL组合导航系统。

    一种粒子群算法的粗对准方法

    公开(公告)号:CN111323049A

    公开(公告)日:2020-06-23

    申请号:CN202010196578.4

    申请日:2020-03-19

    Abstract: 本发明公开了一种粒子群算法的粗对准方法,包括:步骤一:建立多矢量定姿模型,求解水平姿态;步骤二:建立粒子群算法模型;步骤三:构建粒子群适应度函数;步骤四:粒子早熟收敛问题的解决;步骤五:进行载体坐标系对导航坐标系姿态矩阵 的更新;本发明充分利用惯性系对准算法水平姿态收敛较快的特点,极大降低了构造粒子群算法适应度函数的难度。本发明利用粒子群算法的快速估计能力,将粒子群算法应用到惯性系的粗对准之中,极大缩短了摇摆基座的对准时间。

Patent Agency Ranking