一种水下航行器自主式导航-跟踪-避障一体化方法

    公开(公告)号:CN119088065A

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

    申请号:CN202411184375.8

    申请日:2024-08-27

    Abstract: 本发明公开了一种水下航行器自主式导航‑跟踪‑避障一体化方法,包括:建立全驱动水下航行器动力学模型与信息流拓扑结构;基于模型预测控制方法实现水下航行器的队形控制和协同运动;基于改进的人工势场法实现水下航行器的自主式避障控制;在障碍物影响范围内基于扩展卡尔曼滤波对航行器量测轨迹进行优化,优化避障轨迹,从而实现水下航行器的导航‑跟踪‑避障一体化。基于对水下动态障碍物的研究与分析,针对水下航行器避障轨迹建立了扩展卡尔曼滤波预测机理,一定程度上解决了避障轨迹在势场边界震荡的问题,优化了避障轨迹,提高了编队避障安全性。同时算法能够精确控制编队进行动态避障,具有一定的工程应用价值。

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

    公开(公告)号:CN119043307A

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

    申请号:CN202411166230.5

    申请日:2024-08-23

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

    一种DVL多波束标定方法
    53.
    发明授权

    公开(公告)号:CN115031725B

    公开(公告)日:2024-10-15

    申请号:CN202210280446.9

    申请日:2022-03-21

    Abstract: 本发明公开了一种DVL多波束标定方法,包括:建立DVL波束量测结构模型,对模型进行四元数表示,选取状态量和量测信息,建立基于四元数表示的状态预测方程、量测预测方程和非线性量测方程的雅克比矩阵;使用EKF对四波束进行标定,将状态预测方程、量测预测方程和非线性量测方程的雅克比矩阵代入卡尔曼滤波器中得到安装偏差角四元数及结构角误差估计值;重置卡尔曼滤波器中状态量及状态先验协方差矩阵,状态量作为下一次滤波的状态初值,获得载体速度信息的迭代更新公式,重复迭代循环次数n,获得安装偏差角四元数及结构角误差估计值。本发明提高了标定精度,在迭代后具有更稳定的误差均值及标准差。

    一种单领航多AUV协同定位及轨迹跟踪控制方法

    公开(公告)号:CN114840003B

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

    申请号:CN202210279687.1

    申请日:2022-03-21

    Abstract: 本发明公开了一种单领航多AUV协同定位及轨迹跟踪控制方法,步骤一:建立跟踪器运动学模型、领航器运动学模型以及两者之间距离量测的模型;步骤二:根据步骤一建立的模型通过扩展卡尔曼滤波算法对领航器状态进行估计;步骤三:根据可观测性进行协同轨迹规划,确定跟踪器理想跟踪轨迹;步骤四:根据步骤二以及步骤三中的目标状态以及跟踪轨迹,设计控制器,完成对目标的跟踪。本发明所提出的方法具有很强的鲁棒性和有效性。对不同的多个跟踪器均有很好的效果。

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

    公开(公告)号:CN116702479B

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

    申请号:CN202310690334.5

    申请日:2023-06-12

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

    基于惯性导航的地下管线测绘仪器

    公开(公告)号:CN116499435B

    公开(公告)日:2024-01-16

    申请号:CN202310453393.0

    申请日:2023-04-25

    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组合导航系统。

Patent Agency Ranking