【技术实现步骤摘要】
激光制导灭火炸弹偏置导引律设计方法及系统
[0001]本专利技术涉及智能制造技术中的导航
,尤其涉及一种激光制导灭火炸弹偏置导引律设计方法及系统。
技术介绍
[0002]当激光制导灭火炸弹实施灭火行动时,着火点周围布满烟尘,严重影响导引头测量性能,致使制导信号产生偏差或丢失,从而导致灭火炸弹不能到达目标区域。
[0003]目前工程上常用的方法为,跟踪着火点(真实目标)附近的一个固定参考物体,根据参考物体与着火点的相对位置关系和导引头的跟踪信息,控制灭火炸弹导引着火点。原理是根据几何方法推导出真实目标视线角速度与导引头跟踪参考目标的视线角速度的数学关系,最后用真实目标视线角速度信息生成制导指令,导引灭火炸弹飞向着火点,实施灭火工作。该方法需要准确测量参考物体与着火点的距离与方位关系,而实际情况是难以测量该信息,或者在测量过程中存在较大的安全隐患。
技术实现思路
[0004]本专利技术目的在于公开一种激光制导灭火炸弹偏置导引律设计方法及系统,以规避参考物体与着火点之间的距离与方位关系进行精确制导。
[0005]为达上述目的,本专利技术公开一种激光制导灭火炸弹偏置导引律设计方法,包括:
[0006]步骤S1、获取对应着火点的真实目标坐标信息。
[0007]步骤S2、在灭火炸弹发射后,计算激光照射器所照射参考物体方向在当前迭代次数所对应的法向、侧向和前向加速度指令a
′
ys
、a
z
′
s
、a
′ />xs
。
[0008]步骤S3、计算参考物体视线系与真实目标视线系的转换矩阵所述转换矩阵根据相关联坐标系进行中间转换的相关角度、炸弹飞行中实时发射系坐标和真实目标在所述发射系中的坐标信息得出,所述相关联坐标系包括:弹上视线系、测量系、弹体系及发射系。
[0009]步骤S4、根据所述转换矩阵T
ss
′
和所述参考物体方向的法向、侧向和前向加速度指令a
′
ys
、a
z
′
s
、a
′
xs
计算得出真实目标方向的视线加速度指令a
ys
、a
zs
以进行制导飞行;然后循环至步骤S2以执行下一迭代,直至灭火炸弹达到着火点进行灭火。
[0010]优选地,所述步骤S2中,参考物体方向的法向与侧向加速度指令的计算公式为:
[0011][0012]其中,K
n
为导航比;分别为激光导引头输出的高低视线角速度与方位视线角速度;V是炸弹速度。
[0013]优选地,参考物体方向前向加速度指令的计算过程包括:
[0014]步骤S21、计算弹上视线系到测量系的转换矩阵
[0015][0016]其中,ε
α
,ε
β
为导引头输出的高低方向与方位方向的失调角。
[0017]步骤S22、计算测量系与弹体系的转换矩阵
[0018][0019]其中,φ
α
,φ
β
为导引头输出的高低方向与方位方向的框架角。
[0020]步骤S23、针对参考物体,计算弹上视线系与参考物体视线系的转换矩阵
[0021][0022]其中,γ
s1
为弹上视线系与参考物体视线系之间的扭角。
[0023]步骤S24、计算参考物体视线系与弹体系的转换矩阵:
[0024][0025]其中,为的转置矩阵。
[0026]步骤S25、构造参考物体前向方向加速度指令a
′
xs
:
[0027][0028]其中,a
xb
为弹体系下的加速度。
[0029]优选地,计算参考物体视线系与真实目标视线系的转换矩阵的过程包括:
[0030]步骤S41、计算视线高低角与视线方位角λ
t
、λ
p
:
[0031][0032]其中,x
m
,y
m
,z
m
为炸弹飞行中实时发射系坐标,x
t
,y
t
,z
t
为目标在发射系坐标。步骤S42、计算发射系到真实目标视线系的转换矩阵
[0033][0034]这里的真实目标位置也即是着火点坐标参数,是由飞机装订给灭火炸弹的。
[0035]步骤S43、以投弹点与目标点建立发射系,计算发射系到弹体系的转换矩阵
[0036][0037]其中,φ,ψ,γ为发射系与弹体系之间相互转换的俯仰角、偏航角与滚转角。
[0038]步骤S44、计算弹体系到真实目标视线系的转换矩阵
[0039][0040]其中,为的装置矩阵。
[0041]步骤S45、计算参考物体视线系与真实目标视线系的转换矩阵
[0042][0043]优选地,所述步骤S4的具体计算公式为:
[0044][0045]其中,下标xs、ys和zs中的x、y和z分别代表前向、法向和侧向。
[0046]优选地,在所述步骤S1之前还包括:
[0047]步骤S0、所述灭火炸弹的载机确定所述着火点的真实目标坐标信息并根据惯导信息向着火点飞行,在飞行至发射区域后,将所述着火点的真实目标坐标信息装订给所述灭火炸弹。
[0048]为达上述目的,本专利技术还公开一种激光制导灭火炸弹偏置导引律设计系统,包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述计算机程序时用以实现上述的方法。
[0049]本专利技术具有以下有益效果:
[0050]本专利技术原理简单,工程应用性强,首先生成参考物体方向的法向和侧向加速度指令,并构造出前向加速度指令,通过坐标系转换解算出目标视线加速度指令。目前工程上一般根据几何方法推导出真实目标视线角速度与导引头跟踪参考目标的视线角速度的数学关系,最后用真实目标视线角速度信息生成制导指令,导引炸弹飞向着火点,实施灭火工作。该方法需要准确测量参考物体与着火点的距离与方位关系,而实际情况是难以测量该信息,或者在测量过程中存在较大的安全隐患。而本专利技术不需要测量参考物体与目标的距离与方位关系,实施更加便捷。
[0051]下面将参照附图,对本专利技术作进一步详细的说明。
附图说明
[0052]构成本申请的一部分的附图用来提供对本专利技术的进一步理解,本专利技术的示意性实施例及其说明用于解释本专利技术,并不构成对本专利技术的不当限定。在附图中:
[0053]图1是本专利技术实施例公开的激光制导灭火炸弹偏置导引律设计方法流程示意图。
具体实施方式
[0054]以下结合附图对本专利技术的实施例进行详细说明,但是本专利技术可以由权利要求限定和覆盖的多种不同方式实施。
[0055]实施例1
[0056]本实施例公开一种激光制导灭火炸弹偏置导引律设本文档来自技高网...
【技术保护点】
【技术特征摘要】
1.一种激光制导灭火炸弹偏置导引律设计方法,其特征在于,包括:步骤S1、获取对应着火点的真实目标坐标信息;步骤S2、在灭火炸弹发射后,计算激光照射器所照射参考物体方向在当前迭代次数所对应的法向、侧向和前向加速度指令a
′
ys
、a
z
′
s
、a
′
xs
;步骤S3、计算参考物体视线系与真实目标视线系的转换矩阵所述转换矩阵根据相关联坐标系进行中间转换的相关角度、炸弹飞行中实时发射系坐标和真实目标在所述发射系中的坐标信息得出,所述相关联坐标系包括:弹上视线系、测量系、弹体系及发射系;步骤S4、根据所述转换矩阵和所述参考物体方向的法向、侧向和前向加速度指令a
′
ys
、a
z
′
s
、a
′
xs
计算得出真实目标方向的视线加速度指令a
ys
、a
zs
以进行制导飞行;然后循环至步骤S2以执行下一迭代,直至灭火炸弹达到着火点进行灭火。2.根据权利要求1所述的方法,其特征在于,所述步骤S2中,参考物体方向的法向与侧向加速度指令的计算公式为:其中,K
n
为导航比;分别为激光导引头输出的高低视线角速度与方位视线角速度;V是炸弹速度。3.根据权利要求2所述的方法,其特征在于,参考物体方向前向加速度指令的计算过程包括:步骤S21、计算弹上视线系到测量系的转换矩阵步骤S21、计算弹上视线系到测量系的转换矩阵其中,ε
α
,ε
β
为导引头输出的高低方向与方位方向的失调角;步骤S22、计算测量系与弹体系的转换矩阵步骤S22、计算测量系与弹体系的转换矩阵其中,φ
α
,φ
β
为导引头输出的高低方向与方位方向的框架角;步骤S23、针对参考物体,计算弹上视线系与参考物体视线系的转换矩阵步骤S23、针对参考物体,计算弹上视线系与参考物体视线系的转换矩阵其中,γ
s1
...
【专利技术属性】
技术研发人员:凡建超,鱼小军,王鸿睿,张飞飞,高晨阳,杨勇,李格,杨浩瀚,刘胜,段国栋,
申请(专利权)人:湖南云箭科技有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。