一种导航设备的标定方法、装置、飞行器、存储介质制造方法及图纸

技术编号:37959169 阅读:10 留言:0更新日期:2023-06-30 09:34
本发明专利技术实施例提供了一种导航设备的标定方法、装置、飞行器、存储介质,该方法应用于飞行器,飞行器中设有主导航设备和至少一个从导航设备,该方法包括:对飞行器上电后,在主导航设备和从导航设备开始工作且飞行器静止时,检测主导航设备、从导航设备的初始导航参数值,在从导航设备的初始导航参数值与主导航设备的差大于第一阈值时,控制飞行器进行匀速机动以对从导航设备的导航参数值进行标定;本发明专利技术通过将主导航设备的IMU器件测量的值作为有效真值来标定从导航设备中的IMU器件,可以减少导航设备的算法收敛时间,提高了导航设备的导航精度和稳定性。航精度和稳定性。航精度和稳定性。

【技术实现步骤摘要】
一种导航设备的标定方法、装置、飞行器、存储介质


[0001]本专利技术涉及飞行器
,特别是涉及一种导航设备的标定方法、装置、飞行器、存储介质。

技术介绍

[0002]随着惯性导航系统的不断发展,其在飞行器设备中得到了广泛地应用,在应用过程中惯性导航设备的导航精度也越来越重要,现有技术中,导航设备的IMU(Inertial Measurement Unit,惯性测量单元)一般通过转台离线标定后安装到飞行器设备中,在使用过程中不再进行二次标定,由于IMU的物理特征导致导航设备在使用的过程中加速度计和陀螺仪的零偏会发生缓慢的变化,甚至会发生较大的突变,这会降低导航设备的导航精度。

技术实现思路

[0003]鉴于上述问题,提出了本专利技术实施例以便提供一种克服上述问题或者至少部分地解决上述问题的一种导航设备的标定方法、装置、飞行器、存储介质。
[0004]为了解决上述问题,本专利技术实施例公开了一种导航设备的标定方法,应用于飞行器,所述飞行器中设有主导航设备和至少一个从导航设备,所述方法包括:
[0005]对所述飞行器上电,在所述主导航设备、从导航设备开始工作且所述飞行器静止时,检测所述主导航设备、从导航设备的初始导航参数值;
[0006]当所述从导航导航设备的初始导航参数值与所述主导航设备的初始导航参数值的差大于第一阈值时,控制所述飞行器进行匀速机动以对所述从导航设备的导航参数值进行标定。
[0007]可选地,所述控制所述飞行器进行匀速机动以对所述从导航设备的导航参数值进行标定,包括:
[0008]控制所述飞行器进行预设方向的匀速机动,检测所述主导航设备、从导航设备在所述预设方向上的导航参数测量值;所述预设方向包括:前、后、左、右、上、下;
[0009]根据所述从导航设备在所述预设方向上的导航参数测量值,确定所述从导航设备在所述预设方向上的导航参数真实值;
[0010]当所述从导航设备在所述预设方向上的导航参数真实值与所述主导航设备在所述预设方向上的导航参数测量值的差小于第二阈值时,结束标定。
[0011]可选地,所述根据所述从导航设备在所述预设方向上的导航参数测量值,确定所述从导航设备在所述预设方向上的导航参数真实值,包括:
[0012]根据所述从导航设备在所述预设方向上的导航参数测量值,确定所述从导航设备的导航参数误差系数矩阵值;
[0013]根据所述从导航设备的导航参数误差系数矩阵值,确定所述从导航设备在所述预设方向上的导航参数真实值。
[0014]可选地,所述确定所述从导航设备的导航参数误差系数矩阵值,包括:
[0015]按照预设公式D=K*M,计算所述从导航设备的导航参数误差系数矩阵值,其中D为所述主导航设备在所述预设方向上的导航参数测量值,K为导航参数误差系数矩阵值,M为所述从导航设备在所述预设方向上的导航参数测量值。
[0016]可选地,所述导航参数真实值包括加速度真实值和陀螺仪真实值,所述确定所述从导航设备在所述预设方向上的导航参数真实值,包括:
[0017]按照预设公式ACC=K_acc*acc+B_acc计算所述从导航设备在所述预设方向上的加速度真实值;
[0018]按照预设公式GYR=K_gyr*gyr+B_gyr计算所述从导航设备在所述预设方向上的陀螺仪真实值;
[0019]其中,ACC表示所述从导航设备在所述预设方向上的加速度真实值,GYR表示所述从导航设备在所述预设方向上的陀螺仪真实值,K_acc表示表示加速度误差系数矩阵值,acc表示加速度的测量值,B_acc表示加速度计的零偏;K_gyr表示陀螺仪的误差系数矩阵值,gyr表示陀螺仪的测量值,B_gyr表示陀螺仪的零偏。
[0020]可选地,所述按照预设公式D=K*M,计算所述从导航设备的导航参数误差系数矩阵值,包括:
[0021]将所述从导航设备在所述预设方向上的导航参数测量值M、所述主导航设备在所述预设方向上的导航参数测量值D,代入所述预设公式D=K*M中,由最小二乘法计算所述从导航设备的导航参数误差系数矩阵值。
[0022]可选地,所述方法还包括:
[0023]将所述从导航设备标定后的导航参数误差系数矩阵值存储到所述从导航设备的内存中。
[0024]本专利技术还公开了一种导航设备的标定装置,应用于飞行器,所述飞行器中设有主导航设备和至少一个从导航设备,所述装置包括:
[0025]检测模块,用于对所述飞行器上电,在所述主导航设备、从导航设备开始工作且所述飞行器静止时,检测所述主导航设备、从导航设备的初始导航参数值;
[0026]控制模块,用于当所述从导航导航设备的初始导航参数值与所述主导航设备的初始导航参数值的差大于第一阈值时,控制所述飞行器进行匀速机动以对所述从导航设备的导航参数值进行标定。
[0027]可选地,所述控制模块,包括:
[0028]控制子模块,用于控制所述飞行器进行预设方向的匀速机动,检测所述主导航设备、从导航设备在所述预设方向上的导航参数测量值;所述预设方向包括:前、后、左、右、上、下;
[0029]确定子模块,用于根据所述从导航设备在所述预设方向上的导航参数测量值,确定所述从导航设备在所述预设方向上的导航参数真实值;
[0030]结束子模块,用于当所述从导航设备在所述预设方向上的导航参数真实值与所述主导航设备在所述预设方向上的导航参数测量值的差小于第二阈值时,结束标定。
[0031]可选地,所述确定子模块,包括:
[0032]误差系数矩阵值确定单元,用于根据所述从导航设备在所述预设方向上的导航参数测量值,确定所述从导航设备的导航参数误差系数矩阵值;
[0033]导航参数真实值确定单元,用于根据所述从导航设备的导航参数误差系数矩阵值,确定所述从导航设备在所述预设方向上的导航参数真实值。
[0034]可选地,所述误差系数矩阵值确定单元,包括:
[0035]第一计算子单元,用于按照预设公式D=K*M,计算所述从导航设备的导航参数误差系数矩阵值,其中D为所述主导航设备在所述预设方向上的导航参数测量值,K为导航参数误差系数矩阵值,M为所述从导航设备在所述预设方向上的导航参数测量值。
[0036]可选地,所述导航参数真实值包括加速度真实值和陀螺仪真实值,所述导航参数真实值确定单元,包括:
[0037]第二计算子单元,用于按照预设公式ACC=K_acc*acc+B_acc计算所述从导航设备在所述预设方向上的加速度真实值;
[0038]第三计算子单元,用于按照预设公式GYR=K_gyr*gyr+B_gyr计算所述从导航设备在所述预设方向上的陀螺仪真实值;
[0039]其中,ACC表示所述从导航设备在所述预设方向上的加速度真实值,GYR表示所述从导航设备在所述预设方向上的陀螺仪真实值,K_acc表示表示加速度误差系数矩阵值,acc表示加速度的测量值,B_acc表示加速度计的零偏;K本文档来自技高网
...

【技术保护点】

【技术特征摘要】
1.一种导航设备的标定方法,其特征在于,应用于飞行器,所述飞行器中设有主导航设备和至少一个从导航设备,所述方法包括:对所述飞行器上电,在所述主导航设备、从导航设备开始工作且所述飞行器静止时,检测所述主导航设备、从导航设备的初始导航参数值;当所述从导航导航设备的初始导航参数值与所述主导航设备的初始导航参数值的差大于第一阈值时,控制所述飞行器进行匀速机动以对所述从导航设备的导航参数值进行标定。2.根据权利要求1所述的方法,其特征在于,所述控制所述飞行器进行匀速机动以对所述从导航设备的导航参数值进行标定,包括:控制所述飞行器进行预设方向的匀速机动,检测所述主导航设备、从导航设备在所述预设方向上的导航参数测量值;所述预设方向包括:前、后、左、右、上、下;根据所述从导航设备在所述预设方向上的导航参数测量值,确定所述从导航设备在所述预设方向上的导航参数真实值;当所述从导航设备在所述预设方向上的导航参数真实值与所述主导航设备在所述预设方向上的导航参数测量值的差小于第二阈值时,结束标定。3.根据权利要求2所述的方法,其特征在于,所述根据所述从导航设备在所述预设方向上的导航参数测量值,确定所述从导航设备在所述预设方向上的导航参数真实值,包括:根据所述从导航设备在所述预设方向上的导航参数测量值,确定所述从导航设备的导航参数误差系数矩阵值;根据所述从导航设备的导航参数误差系数矩阵值,确定所述从导航设备在所述预设方向上的导航参数真实值。4.根据权利要求3所述的方法,其特征在于,所述确定所述从导航设备的导航参数误差系数矩阵值,包括:按照预设公式D=K*M,计算所述从导航设备的导航参数误差系数矩阵值,其中D为所述主导航设备在所述预设方向上的导航参数测量值,K为导航参数误差系数矩阵值,M为所述从导航设备在所述预设方向上的导航参数测量值。5.根据权利要求4所述的方法,其特征在于,所述导航参数真实值包括加速度真实值和陀螺仪真实值,所述确定所述从导航设备在所述预设方向上的导航参数真实值,包括:按照预设公式ACC=K_acc*acc+B_acc计算所述从导航设备在...

【专利技术属性】
技术研发人员:方玮陶永康孙宾姿张明明
申请(专利权)人:广东汇天航空航天科技有限公司
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1