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

    公开(公告)号:CN111323049A

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

    申请号:CN202010196578.4

    申请日:2020-03-19

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

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

    公开(公告)号:CN115855038B

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

    申请号:CN202211465410.4

    申请日:2022-11-22

    Abstract: 本发明公开一种短时高精度姿态保持方法,包括:获取陀螺仪输出和加速度计输出;基于加速度计输出和当地重力加速度,得到自身初始姿态信息;基于自身初始姿态信息和陀螺仪输出,得到航向角,作为航向输出;基于加速度计输出和当地重力加速度,得到俯仰角和横揺角,并进行低通滤波处理,将低通滤波处理后的俯仰角和横揺角作为水平姿态输出,实现姿态测量。本发明能够在不依赖任何外界信息的条件下快速完成初始姿态的确定,后续姿态测量也无需接受任何外界信息,抗干扰能力强。经过剧烈角运动后仍能实现高精度的姿态测量,提高姿态计算的精度,实现较低成本条件下的高精度姿态测量。(56)对比文件申强等《.多传感器信息融合导航技术》.北京理工大学出版社,2020,34-35.Bo Xu等.Error Modeling and SimulationAnalysis for the Vehicle Launching SystemErecting《.Advanced Materials Research》.2012,全文.高薪;卞鸿巍;傅中泽;张礼伟.捷联惯导晃动基座四元数估计对准算法.中国惯性技术学报.2014,(第06期),全文.孙立江;周召发;陈河;刘朋朋;郭琦.激光捷联惯导多矢量定姿法晃动基座粗对准.压电与声光.2016,(第02期),全文.

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

    公开(公告)号:CN113819906A

    公开(公告)日:2021-12-21

    申请号:CN202111115235.1

    申请日:2021-09-23

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

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

    公开(公告)号:CN113008239A

    公开(公告)日:2021-06-22

    申请号:CN202110225859.2

    申请日:2021-03-01

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

    一种基于鸽群优化的多无人机紧密编队控制方法

    公开(公告)号:CN111158395A

    公开(公告)日:2020-05-15

    申请号:CN202010031399.5

    申请日:2020-01-13

    Abstract: 本发明提供一种基于鸽群优化的多无人机紧密编队控制方法,通过分析长机翼尖涡流对僚机影响建立紧密编队条件下气动耦合效应的数学模型,输入长机控制指令和改进人工势场法获得多无人机紧密编队的理想状态。利用改进鸽群优化算法估计可使下一时刻僚机状态量最接近理想状态下的僚机控制量,从而完成编队任务。本发明意义在于提供了一种在紧密编队条件下的多无人机编队控制方案,收敛速度快,稳态精度高,具有较高的工程应用价值。

    一种基于多水听器提高多AUV协同定位性能的方法

    公开(公告)号:CN109596128A

    公开(公告)日:2019-04-09

    申请号:CN201910033292.1

    申请日:2019-01-14

    Abstract: 本发明属于自主式水下航行领域,具体涉及一种基于多水听器提高多AUV协同定位性能的方法。该方法包括:在跟随AUV上配置多个水听器,设置水听器的位置并固定水听器;领航AUV与跟随AUV通过水听器进行水声测距,同时领航AUV将自身位置广播发送给跟随AUV;建立单领航AUV模式的协同定位系统状态空间模型;利用EKF滤波方法,对跟随AUV定位。通过设计多个水听器在跟随AUV上的位置,增加状态空间模型量测矩阵维数,系统的可观测性大大提高,有效降低了对单领航方案中的各AUV高机动性要求;减少了多AUV协同导航系统领航AUV数量,避免了由于设置多个领航AUV所需要配备的高精度惯性测量单元,降低成本;不涉及到多领航AUV时间同步的问题,容易实施,而且定位精度较高。

Patent Agency Ranking