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

    公开(公告)号:CN115855038A

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

    申请号:CN202211465410.4

    申请日:2022-11-22

    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期),全文.

    一种基于状态变换的多普勒辅助捷联惯导系统初始对准方法

    公开(公告)号:CN115031727B

    公开(公告)日:2023-06-20

    申请号:CN202210344869.2

    申请日:2022-03-31

    Abstract: 本发明提供一种基于状态变换的多普勒辅助捷联惯导系统初始对准方法,具体包括:步骤一:构建基于载体系速度误差的捷联惯导系统误差方程。步骤二:构建基于状态变换的多普勒测速仪辅助捷联惯性导航系统初始对准的卡尔曼滤波模型。步骤三:利用卡尔曼滤波器对SINS初始误差状态进行估计,完成对准任务。本发明是一种适用于初始大方位失准角条件下的SINS/DVL组合导航系统初始对准方法,具有较高的工程应用价值。本发明利用载体系速度误差模型,并构建了SINS和DVL安装偏差角模型,模型精度高,实验证明所提方法对准精度高。

    SINS/DVL紧组合系统DVL波束故障处理方法

    公开(公告)号:CN115031724A

    公开(公告)日:2022-09-09

    申请号:CN202210279711.1

    申请日:2022-03-21

    Abstract: 本发明公开了一种SINS/DVL紧组合系统DVL波束故障处理方法,步骤一、进行捷联惯性导航系统初始对准,然后将声学多普勒计程仪波束量测信息传送到捷联惯性导航系统;步骤二:构建捷联惯性导航系统状态参量X及状态方程;步骤三、选取捷联惯性导航系统量测量Z并构建量测方程,步骤四:利用基于新息的χ2检验方法对接收到的DVL波束量测信息进行故障检测,步骤五、根据不同波束故障情况,重构故障波束速度信息。本发明直接使用了DVL原始的波束量测信息,能够更加充分的获得可利用的有效信息,当部分波束量测出现故障时,本发明通过相应的波束信息故障处理方法使组合导航系统依旧维持较高的导航精度。

    一种雷达辅助机载捷联惯性导航系统初始对准方法

    公开(公告)号:CN110487301B

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

    申请号:CN201910882454.9

    申请日:2019-09-18

    Abstract: 本发明提供一种雷达辅助机载捷联惯性导航系统初始对准方法,通过计算雷达和机载惯性导航设备之间的斜距和角位置,获得雷达辅助惯性导航系统初始对准的非线性量测方程。利用无迹卡尔曼滤波算法估计捷联惯性导航系统的误差量并进行补偿,从而完成初始对准任务。本发明意义在于提供了一种全球定位系统受限时的飞行中初始对准方案,收敛速度快,估计精度高具有较高的工程应用价值。

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

    公开(公告)号:CN111158395B

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

    申请号:CN202010031399.5

    申请日:2020-01-13

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

    基于RBF神经网络辅助容积卡尔曼滤波的多AUV协同定位方法

    公开(公告)号:CN109459040A

    公开(公告)日:2019-03-12

    申请号:CN201910033350.0

    申请日:2019-01-14

    Abstract: 本发明属于定位技术领域,具体涉及一种基于RBF神经网络辅助容积卡尔曼滤波的多AUV协同定位方法。本发明包括以下步骤:建立多AUV协同定位状态空间模型;创建一个RBF神经网络;在基准参考位置可用时,通过CKF进行多AUV协同定位估计;收集RBF神经网络的训练数据;对RBF神经网络进行训练;基准信号中断,停止训练RBF神经网络,继续进行CKF协同定位估计;估计CKF协同定位滤波误差;补偿滤波状态更新估计值。本发明在多AUV协同定位情况下,考虑跟随AUV航向漂移误差、洋流速度影响及与距离相关的水声噪声,具有更高的实用价值;利用RBF神经网络对CKF滤波估计值进行补偿,协同定位精度和稳定性显著提高;本发明算法易于实现。

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

    公开(公告)号:CN115031725B

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

    申请号:CN202210280446.9

    申请日:2022-03-21

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

Patent Agency Ranking