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

    公开(公告)号:CN114840003B

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

    申请号:CN202210279687.1

    申请日:2022-03-21

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

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

    公开(公告)号: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)理论,协助每个波束的测量噪声方差在大测量误差出现时完成各自的自适应更新,最终保证每个波束测量信息处理的独立性。本发明可用于非理想条件下的水下航行器组合导航领域。

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

    公开(公告)号:CN114199249A

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

    申请号:CN202111448261.6

    申请日:2021-11-30

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

    一种绳索牵引仿生软骨机器鱼

    公开(公告)号:CN109941415B

    公开(公告)日:2021-01-05

    申请号:CN201910348677.7

    申请日:2019-04-28

    Abstract: 本发明一种绳索牵引仿生软骨机器鱼,包含鱼头、鱼身和鱼尾,其特征是,所述鱼身内部设置有鱼体关节结构和绳索牵引结构;所述绳索牵引结构包括绳索驱动结构、扩张作用力臂结构和绳索;多个所述鱼体关节结构串联且一端与鱼头连接,另一端与鱼尾连接;所述绳索驱动结构和扩张作用力臂结构固定设置在鱼体关节结构上且绳索驱动结构靠近鱼头一侧;所述绳索一端与绳索驱动结构连接,另一端与鱼体关节结构/鱼尾连接,所述绳索的中间段穿过扩张作用力臂结构。本发明通过使用蜕变的鱼体关节结构使仿生软骨机器鱼具有较高的柔性且可以实现鱼体变刚度特性,可以更好的拟合软骨鱼的游动模型;具有有结构简单,重量轻,易于控制,惯量小及响应速度快的优点。

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

    公开(公告)号:CN116702479A

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

    申请号:CN202310690334.5

    申请日:2023-06-12

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

    一种多AUV协同定位鲁棒延迟滤波方法

    公开(公告)号:CN113008239B

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

    申请号:CN202110225859.2

    申请日:2021-03-01

    Abstract: 本发明公开了一种多AUV协同定位鲁棒延迟滤波方法,包括步骤一:建立多AUV协同定位模型;步骤二:通过将延迟转换为量测偏置构建存在时变量测延迟的非线性协同定位系统模型;步骤三:构建时变延迟模型下向量与向量预测值的统计相似性度量;步骤四:将后验概率密度函数近似为高斯分布,最大化代价函数下界求得近似解;步骤五:通过求解代价函数优化解,完成辅助变量更新;步骤六:通过辅助变量对量测噪声协方差矩阵进行修正。本发明在水声通讯延迟与量测噪声异常值共同存在的情形下,可同时削弱延迟与非高斯噪声对定位精度的影响。

Patent Agency Ranking