基于置信度分析的高精度惯导信息融合方法

    公开(公告)号:CN116295375A

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

    申请号:CN202310168156.X

    申请日:2023-02-24

    Abstract: 本发明的目的在于提供基于置信度分析的高精度惯导信息融合方法,包括如下步骤:设计纯惯导系统和高精度惯导的系统的综合误差状态,构造综合误差状态方差;建立观测方程,搭建离散卡尔曼滤波的方程;将纯惯导系统与每一套高精度系统分别进行卡尔曼滤波;计算各系统的置信指标,从而通过置信指标计算归一化置信指标,实现多到高精度系统的加权信息分配。本发明针对多套高精度惯导系统之间缺少信息融合和有效协同定位的问题,借助纯惯导系统建立综合误差状态和状态方程并进行卡尔曼滤波,根据综合速度误差状态的二阶中心距计算各高精度系统的置信指标和归一化置信指标,从而实现基于置信度分析的高精度惯导信息融合,提高了系统的导航精度和可靠性。

    一种适用于光纤陀螺滤波信号的无误差的姿态更新方法

    公开(公告)号:CN110763231B

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

    申请号:CN201910978003.5

    申请日:2019-10-15

    Abstract: 本发明提供了一种适用于光纤陀螺滤波信号的无误差的姿态更新方法,属于捷联惯导领域。包括以下步骤:1.给定初始导航参数;2.系统设置采样周期,姿态解算周期,实时采集三个轴上经过平均滤波处理后的光纤陀螺输出信号;3.相位补偿数字滤波器对采集到的光纤陀螺滤波信号进行相位补偿,得到无相位延迟的陀螺输出信号;4.递推测量tk+1时刻的旋转角速度;5.递推测量tk+1时刻载体坐标系到旋转坐标系的转换矩阵;6.递推测量tk+1时刻旋转坐标系到tk时刻载体坐标系b的转换矩阵;7.递推测量tk+1时刻载体坐标系到tk时刻载体坐标系的转换矩阵,结合上一解算周期的结果就完成了适用于光纤陀螺滤波信号的无误差的姿态更新。本发明解决了光纤陀螺滤波信号的无误差的姿态更新问题。

    一种基于级联卡尔曼滤波算法的水面舰船水平姿态测量方法

    公开(公告)号:CN112504275B

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

    申请号:CN202011276612.5

    申请日:2020-11-16

    Abstract: 本发明提供一种基于级联卡尔曼滤波算法的水面舰船水平姿态测量方法,完成初始对准后,利用实时采集三个轴上陀螺的输出信号和加速度计的输出信号进行捷联惯性导航解算;将GPS给出的位置信息作为量测,利用间接法卡尔曼滤波对实时解算的导航参数进行校正;利用校正的导航参数对运载体机动引起的线加速度和哥氏加速度进行补偿;利用互补滤波获得的陀螺积分误差作为量测量,再次利用卡尔曼滤波对已经校正过的捷联惯性导航解算的水平姿态信息进行校正,获得更高的测量精度。该方法有效利用加速度计的低频高精度特性,对陀螺仪进行不断修正,使水平姿态保持较高精度输出,保证系统在不同运动状态下具有较高的姿态测量精度,有一定的工程应用价值。

    一种水下蛇形机器人曲线路径跟踪控制方法

    公开(公告)号:CN114839866A

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

    申请号:CN202210279689.0

    申请日:2022-03-21

    Abstract: 本发明公开了一种水下蛇形机器人曲线路径跟踪控制方法,步骤一:建立水下蛇形机器人系统动力学模型;步骤二:采用参数三次样条插值曲线的方法生成适合水下蛇形机器人跟踪的光滑路径;步骤三:使用改进视线引导率规则计算机器人当前时刻参考航向;步骤四:根据步骤三得到的参考航向按照反步控制策略推导得到系统的控制输入。本发明提高了系统稳定性和降低跟踪误差,实现水下蛇形机器人更精确地跟踪曲线路径。

    一种无误差的光纤陀螺捷联惯导系统速度更新方法

    公开(公告)号:CN110319833B

    公开(公告)日:2022-07-15

    申请号:CN201910612656.1

    申请日:2019-07-09

    Abstract: 本发明提供的是一种无误差的光纤陀螺捷联惯导系统速度更新方法。1.给定初始导航参数;2、设置采样周期h,实时采集三个轴上陀螺和加速度计的输出信号;3、光纤陀螺捷联惯导系统测量船舶tk时刻姿态信息;4.递推测量tk+1时刻旋转坐标系相对于载体坐标系运动的旋转角速度αk+1;5.递推测量tk+1时刻比力积分转换增量6.递推测量tk+1时刻重力/互补速度增量7.递推测量tk+1时刻的速度完成捷联惯导系统速度更新。本发明在不增加硬件成本的情况下大幅度提高了速度更新的精度,并为下一步的位置更新提供了较高的精度。

    一种采用多重低通滤波单元的捷联惯导升沉测量方法

    公开(公告)号:CN113175943A

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

    申请号:CN202110428787.1

    申请日:2021-04-21

    Abstract: 本发明公开了一种采用多重低通滤波单元的捷联惯导升沉测量方法,首先系统采集陀螺和加速度计数据,利用初始对准得到运载体的姿态信息,再由姿态信息得到载体坐标系和导航坐标系之间的姿态矩阵;再根据地理位置得到导航坐标系和半固定坐标系之间的方向余弦矩阵,利用方向余弦矩阵、加速度计的输出信息和重力信息得到一个粗略的垂向加速度;然后经过二重滤波单元和一次积分环节滤除低频信号得到较为精确的速度信号;同时将垂向加速度经过三重滤波单元和两次积分得到精确的升沉位移。该方法避免了传统加入高通滤波器引起的相位超前问题,可以为舰船减荡操作、舰载体升降机、舰载武器发射和各种海上平台升沉补偿提供参考。

    一种舰船捷联惯导系统航行间粗对准方法

    公开(公告)号:CN112945274A

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

    申请号:CN202110161311.6

    申请日:2021-02-05

    Abstract: 本发明公开了一种舰船捷联惯导系统航行间粗对准方法,通过四元数更新法计算载体系随时间变化的姿态矩阵列写捷联惯导比力方程,两边同时左乘捷联矩阵后,两边再同时求两重积分;根据GPS实时获取的舰船位置信息,计算上式中各参数值;利用捷联惯导系统比力方程和已求得的参数,分别列写两个时间段内的比力方程,根据链式乘法准则,得出和的关系,利用双矢量定姿求出捷联矩阵本发明方法利用二重积分求取各个参数,误差更小,操作更简单、造价成本更低,更具有普适性。

    一种采用因子图和和积算法的多AUV协同导航方法

    公开(公告)号:CN112945224A

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

    申请号:CN202110161315.4

    申请日:2021-02-05

    Abstract: 本发明公开了一种采用因子图和和积算法的多AUV协同导航方法,首先,建立描述AUV导航系统的状态方程和量测方程;其次,根据AUV的状态方程和量测方程建立相应的多AUV协同导航系统因子图模型,该因子图模型含有环结构。为了获得系统的精确解,该含环因子图被等价的转换成含有一个聚合节点的无环因子图模型。最后,根据系统状态方程进行AUV位置和方位角的一步预测更新,然后根据系统获得的AUV之间的观测量结合量测方程估计AUV位置和方位角。本发明采用基于图论的估计方法,方法新颖。另外,能满足实际工程定位精度的同时,计算量更小,该方法展示了更好地系统可扩展性,在实际工程应用中应用性更强。

    一种带有相位补偿的捷联惯导系统升沉测量方法

    公开(公告)号:CN112611382A

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

    申请号:CN202011358976.8

    申请日:2020-11-27

    Abstract: 本发明公开了一种带有相位补偿的捷联惯导系统升沉测量方法,首先对天向加速度计实时测量的信号先进行快速傅里叶变换获取对应海浪的运动频率完成升沉频率估计,然后对测量信号实现升沉滤波,再对升沉滤波器引起的相位超前误差进行补偿实现精确的实时升沉信息输出。本发明相对于现有技术考虑了升沉高通滤波器引起的相位超前误差以及实际应用中动态海况条件,有效解决了现有技术中升沉测量误差大和实时性差的缺点。

Patent Agency Ranking