首页 / 专利库 / 物理 / 加速 / 角加速度 / 制导弹药外弹道半实物仿真平台及方法

制导弹药外弹道半实物仿真平台及方法

阅读:496发布:2022-05-18

专利汇可以提供制导弹药外弹道半实物仿真平台及方法专利检索,专利查询,专利分析的服务。并且本 发明 公开了一种制导弹药外弹道 半实物仿真 平台,其特征在于:它包括主控机、三轴转台、转台控制柜、以及固定在三轴转台上的控制舱单元,所述控制舱单元包括微 控制器 、 舵 机 驱动器 、 俯仰 通道电动舵机、 偏航 通道电动舵机、俯仰通道电位器、偏航通道电位器、地磁装置、北斗卫星接收器和北斗卫星 模拟器 ;本发明的制导弹药外弹道半实物仿真平台及方法结合了半实物仿真技术的优势和制导弹药外弹道的特性,将嵌入式 微控制器 技术和半实物仿真技术相结合,通过RS485串行通信总线装定程序、装定参数、控制平台,并实时传输、接收、存储、显示参数,方便用户轻松完成制导弹药外弹道的半实物仿真和选取可信度较高的结构与参数。,下面是制导弹药外弹道半实物仿真平台及方法专利的具体信息内容。

1.一种制导弹药外弹道半实物仿真平台,其特征在于:它包括主控机(1.1)、三轴转台(2.1)、转台控制柜(2.2)、以及固定在三轴转台(2.1)上的控制舱单元(3),所述控制舱单元(3)包括微控制器(3.1)、驱动器(3.2)、俯仰通道电动舵机(3.3)、偏航通道电动舵机(3.4)、俯仰通道电位器(3.5)、偏航通道电位器(3.6)、地磁装置(3.10)、北斗卫星接收器(3.12)和北斗卫星模拟器(4.1);
所述控制舱单元(3)用于模拟制导弹药的外弹道运动过程;
所述主控机(1.1)用于向微控制器(3.1)输送外弹道控制程序、仿真控制指令和仿真控制参数,微控制器(3.1)的舵机指令输出端连接舵机驱动器(3.2)的指令输入端,舵机驱动器(3.2)的偏航通道电动舵机控制信号输出端连接偏航通道电动舵机(3.4)的信号输入端,舵机驱动器(3.2)的俯仰通道电动舵机控制信号输出端连接俯仰通道电动舵机(3.3)的信号输入端,偏航通道电动舵机(3.4)的输出轴与偏航通道电位器(3.6)的输入轴固定连接,俯仰通道电动舵机(3.3)的输出轴与俯仰通道电位器(3.5)的输入轴固定连接,偏航通道电位器(3.6)的偏航通道电动舵机输出轴偏转度信号输出端连接微控制器(3.1)的偏航通道反馈数据输入端,俯仰通道电位器(3.5)的俯仰通道电动舵机输出轴偏转角度信号输出端连接微控制器(3.1)的俯仰通道反馈数据输入端;
微控制器(3.1)的转台控制通信端连接转台控制柜(2.2)的通信端,控制柜(2.2)用于控制三轴转台(2.1)运动,微控制器(3.1)的姿态通信端连接地磁装置(3.10)的通信端,地磁装置(3.10)用于获取当前时刻制导弹药的姿态角,微控制器(3.1)用于向转台控制柜(2.2)输送姿态驱动指令,并接收地磁装置(3.10)的制导弹药姿态和滚转角反馈信息;
微控制器(3.1)的制导弹药位置与速度控制及反馈信号通信端分别连接北斗卫星模拟器(4.1)的信号输入端和北斗卫星接收器(3.12)的反馈数据输出端,北斗卫星模拟器(4.1)用于在微控制器(3.1)发出的制导弹药位置与速度控制信号的控制下模拟制导弹药的位置与速度信号,北斗卫星接收器(3.12)用于获取当前时刻北斗卫星模拟器(4.1)模拟的制导弹药位置与速度信号;
微控制器(3.1)用于根据北斗卫星接收器(3.12)反馈的模拟制导弹药位置信号计算当前时刻制导弹药与目标之间的弹目距离、制导弹药与目标之间的视线倾角和制导弹药与目标之间的视线偏角,微控制器(3.1)还用于根据北斗卫星接收器(3.12)反馈的模拟制导弹药速度信号计算当前时刻的制导弹药弹道倾角、制导弹药弹道偏角,微控制器(3.1)还用于根据制导弹药弹道倾角、制导弹药弹道偏角以及地磁装置(3.10)反馈的当前时刻控制舱单元(3)的姿态角计算当前时刻的制导弹药准攻角与制导弹药准侧滑角;微控制器(3.1)还用于根据俯仰通道电动舵机输出轴偏转角度信号、偏航通道电动舵机输出轴偏转角度信号以及地磁装置(3.10)反馈的制导弹药滚转角计算当前时刻的俯仰通道电动舵机等效偏角和偏航通道电动舵机等效偏角;微控制器(3.1)还用于根据制导弹药准攻角、制导弹药准侧滑角、俯仰通道电动舵机等效偏角和偏航通道电动舵机等效偏角计算当前时刻作用于制导弹药的法向、侧向力、俯仰力矩和偏航力矩;微控制器(3.1)还用于根据所述制导弹药的法向力、侧向力、俯仰力矩、偏航力矩、地磁装置(3.10)的制导弹药姿态反馈信息、北斗卫星接收器(3.12)反馈的模拟制导弹药位置与速度信号,通过四阶龙格库塔法得到下一时刻模拟制导弹药外弹道的参数与控制信息。
2.根据权利要求1所述的制导弹药外弹道半实物仿真平台,其特征在于:所述下一时刻模拟制导弹药外弹道的参数与控制信息包括制导弹药与目标之间的弹目距离、制导弹药与目标之间的视线倾角、制导弹药与目标之间的视线偏角、制导弹药弹道倾角、制导弹药弹道偏角、制导弹药位置、制导弹药速度、俯仰通道舵机输出轴偏角、偏航通道舵机输出轴偏角以及制导弹药的姿态角。
3.根据权利要求1所述的制导弹药外弹道半实物仿真平台,其特征在于:它还包括卫星射频天线(4.2),卫星射频天线(4.2)用于发射北斗卫星模拟器(4.1)所模拟的弹体的位置与速度信号。
4.根据权利要求1所述的制导弹药外弹道半实物仿真平台,其特征在于:它还包括第一RS485至USB转换器(1.2)、第一TTL至485转换器(3.7)、第二TTL至485转换器(3.8)、第二RS485至USB转换器(2.3)、存储装置(3.9)、TTL至RJ45转换器(3.11);
主控机(1.1)的外弹道控制程序输出端连接微控制器(3.1)的控制程序输入端,主控机(1.1)的仿真控制指令和仿真控制参数输出端依次通过第一RS485至USB转换器(1.2)和第一TTL至485转换器(3.7)连接微控制器(3.1)的串口数据输入端,微控制器(3.1)的转台控制通信端依次通过第二TTL至485转换器(3.8)和第二RS485至USB转换器(2.3)连接转台控制柜(2.2)的通信端,存储装置(3.9)的数据存储端连接微控制器(3.1)的数据存储端,微控制器(3.1)的北斗卫星模拟器通信端通过TTL至RJ45转换器(3.11)连接北斗卫星模拟器(4.1)的信号输入端,微控制器(3.1)的北斗卫星接收器通信输入端连接北斗卫星接收器(3.12)的通信输出端。
5.根据权利要求1所述的制导弹药外弹道半实物仿真平台,其特征在于:所述三轴转台(2.1)的姿态角包括俯仰角、偏航角和滚转角;
所述转台控制柜(2.2)能根据微控制器(3.1)发送的转台姿态驱动指令,驱动三轴转台(2.1)进行俯仰、偏航、滚转运动,姿态角范围为俯仰角-80°~+80°、偏航角-60°~+60°、滚转角连续旋转。
6.根据权利要求1所述的制导弹药外弹道半实物仿真平台,其特征在于:三轴转台(2.1)的角速度范围为俯仰-10°/s~+10°/s、偏航-10°/s~+10°/s、滚转-3600°/s~3600°/s,角加速度范围为-100°/s2~+100°/s2。
7.根据权利要求4所述的制导弹药外弹道半实物仿真平台,其特征在于:所述主控机(1.1)和第一RS485至USB转换器(1.2)构成主控单元(1),三轴转台(2.1)、控制柜(2.2)和第二RS485至USB转换器(2.3)构成弹体姿态模拟单元(2),所述微控制器(3.1)、舵机驱动器(3.2)、俯仰通道电动舵机(3.3)、偏航通道电动舵机(3.4)、俯仰通道电位器(3.5)、偏航通道电位器(3.6)、第一TTL至485转换器(3.7)、第二TTL至485转换器(3.8)、存储装置(3.9)、地磁装置(3.10)、TTL至RJ45转换器(3.11)和北斗卫星接收器(3.12)构成控制舱单元(3),北斗卫星模拟器(4.1)和卫星射频天线(4.2)构成弹体运动模拟单元(4)。
8.根据权利要求1所述的制导弹药外弹道半实物仿真平台,其特征在于:所述控制舱单元(3)具有轴对称外形,控制舱单元(3)通过机械方式固定安装在三轴转台(2.1)上,控制舱单元(3)的纵轴与三轴转台(2.1)滚转方向轴线重合。
9.一种制导弹药外弹道半实物仿真方法,其特征在于,它包括如下步骤:
步骤1:主控机(1.1)通过外弹道软件向微控制器(3.1)发送仿真控制指令、装定仿真控制程序和仿真控制参数;
在外弹道软件上选择已经编译好的仿真控制程序,通过发送装定程序控制指令将仿真控制程序装定到微控制器(3.1)中,仿真控制程序包括微分方程组和四阶龙格库塔算法,微分方程组包括弹体六自由度动力学模型、目标三自由度运动学模型、弹目空间相对运动模型、中制导律模型和末制导律模型;
在外弹道软件上选取或输入仿真环境参数、制导弹药属性参数、目标属性参数、中制导律参数和末制导律参数,通过发送装定参数控制指令将仿真环境参数、制导弹药属性参数、目标属性参数、中制导律参数和末制导律参数装定到微控制器(3.1)中;
步骤2:微控制器(3.1)根据仿真环境参数中的制导弹药射向角度αN、制导弹药初始的经纬高[λ0、φ0、h0]T和北斗卫星接收器(3.12)反馈的制导弹药在WGS-84系中当前时刻的位置[xd1,yd1,zd1]T信号通过如下公式1解算当前时刻制导弹药在基准系中当前时刻的位置[xP1,yP1,zP1]T;
其中,B为由WGS-84系向基准系转换的矩阵,λ0、φ0分别表示制导弹药初始的经纬度,xd1,yd1,zd1分别表示WGS-84系中当前时刻的滚转轴,航向轴,俯仰轴坐标值,xP1,yP1,zP1分别表示基准系中当前时刻的滚转轴,航向轴,俯仰轴坐标值;
微控制器(3.1)根据制导弹药在基准系中当前时刻的位置[xP1,yP1,zP1]T和目标属性参数中的目标在基准系中的位置(xT,yT,zT)通过如下公式2解算当前时刻的弹目距离R1;
其中,xT,yT,zT分别表示目标在基准系中的滚转轴,航向轴,俯仰轴坐标;
微控制器(3.1)根据制导弹药在基准系中当前时刻的位置[xP1,yP1,zP1]T、目标属性参数中的目标在基准系中的位置(xT,yT,zT)以及弹目距离R1通过如下公式3解算当前时刻的制导弹药与目标之间的视线倾角θQ1;
微控制器(3.1)根据制导弹药在基准系中当前时刻的位置[xP1,yP1,zP1]T、目标属性参数中的目标在基准系中的位置(xT,yT,zT)通过如下公式4解算当前时刻的制导弹药与目标之间的视线偏角ψQ1;
微控制器(3.1)根据北斗卫星接收器(3.12)反馈的制导弹药在WGS-84系中当前时刻的速度[vxd1,vyd1,vzd1]T信号通过如下公式5解算当前时刻的制导弹药合速度vP1;
其中,vxd1,vyd1,vzd1分别表示制导弹药在WGS-84系中当前时刻的滚转轴,航向轴,俯仰轴上当前时刻的速度;
微控制器(3.1)根据北斗卫星接收器(3.12)反馈的制导弹药在WGS-84系中当前时刻的速度[vxd1,vyd1,vzd1]T信号和制导弹药当前时刻的合速度vP1通过如下公式6解算当前时刻的弹道倾角θP1;
微控制器(3.1)根据北斗卫星接收器(3.12)反馈的制导弹药在WGS-84系中当前时刻的速度[vxd1,vyd1,vzd1]T信号、制导弹药当前时刻的合速度vP1和弹道倾角θP1通过如下公式7解算当前时刻的弹道偏角ψP1;
微控制器(3.1)根据弹道倾角信号θP1和地磁装置(3.10)反馈的俯仰角信号θ1通过如下公式8解算当前时刻制导弹药的准攻角
微控制器(3.1)根据弹道偏角信号ψP1和地磁装置(3.10)反馈的偏航角信号ψ1通过如下公式9解算当前时刻弹体的准侧滑角
微控制器(3.1)根据当前时刻俯仰通道电动舵机输出轴偏转角度δz1、偏航通道电动舵机输出轴偏转角度δy1与地磁装置(3.10)反馈的制导弹药滚转角γ1通过如下公式10解算当前时刻俯仰通道电动舵机输出轴等效偏角δzeq1和偏航通道电动舵机输出轴等效偏角δyeq1;
结合当前时刻制导弹药准攻角 当前时刻制导弹药准侧滑角 当前时刻俯仰通
道电动舵机输出轴等效偏角δzeq1、当前时刻偏航通道电动舵机输出轴等效偏角δyeq1与步骤1中装定的仿真控制参数,通过步骤1中装定的弹体六自由度动力学模型解算当前时刻作用于制导弹药的法向力、侧向力、俯仰力矩和偏航力矩;
步骤3:微控制器(3.1)根据步骤1中装定的微分方程组与四阶龙格库塔法解算下一时刻的外弹道控制参数与微分方程组中所需要求解的变量参数,包括下一时刻的弹目距离R2、制导弹药与目标之间的视线倾角θQ2、制导弹药与目标之间的视线偏角ψQ2、弹道倾角θP2、T T
弹道偏角ψP2、制导弹药在基准系中的位置[xP2,yP2,zP2]与速度[vxP2,vyP2,vzP2] 、俯仰通道舵机输出轴等效偏角δzeq2、偏航通道舵机输出轴等效偏角δyeq2和三轴转台的俯仰角θ2、偏航角ψ2和滚转角γ2,vxP2,vyP2,vzP2为基准系中的滚转轴,航向轴,俯仰轴速度;
微控制器(3.1)根据下一时刻俯仰通道舵机输出轴等效偏角δzeq2、下一时刻偏航通道舵机输出轴等效偏角δyeq2和下一时刻三轴转台的滚转角γ2通过如下公式(11)解算下一时刻俯仰通道电动舵机输出轴偏角δz2、偏航通道电动舵机输出轴偏角δy2;
微控制器(3.1)根据仿真环境参数中的制导弹药射向角度αN、制导弹药初始的经纬高制导弹药在WGS-84系中初始的位置[xd0,yd0,zd0]T以及下一时刻制导弹药
在基准系中的位置[xP2,yP2,zP2]T通过如下公式12解算下一时刻制导弹药在WGS-84系中下一时刻的位置[xd2,yd2,zd2]T;
其中,xP2,yP2,zP2为基准系中下一时刻的滚转轴,航向轴,俯仰轴坐标值,xd0,yd0,zd0为WGS-84系中下一时刻的滚转轴,航向轴,俯仰轴坐标值,xd2,yd2,zd2为WGS-84系中下一时刻的滚转轴,航向轴,俯仰轴坐标值;
微控制器(3.1)根据仿真环境参数中的制导弹药射向角度αN、制导弹药初始的经纬高以及下一时刻制导弹药射在基准系中的速度[vxP2,vyP2,vzP2]T通过如下公式
13解算下一时刻制导弹药射在WGS-84系中的速度[vxd2,vyd2,vzd2]T;
B-1为由WGS-84系向基准系转换的逆矩阵,vxP2,vyP2,vzP2为基准系中滚转轴,航向轴,俯仰轴上的速度值,vxd2,vyd2,vzd2为WGS-84系中基准系中滚转轴,航向轴,俯仰轴上的速度值;
步骤4:微控制器(3.1)根据下一时刻俯仰通道电动舵机输出轴偏角δz2和偏航通道电动舵机输出轴偏角δy2向舵机驱动器(3.2)发送偏航通道电动舵机控制指令和俯仰通道电动舵机控制指令;
舵机驱动器(3.2)根据偏航通道电动舵机控制指令控制偏航通道电动舵机(3.4)运动,偏航通道电动舵机(3.4)的运动带动偏航通道电位器(3.6)的输入轴运动,偏航通道电位器(3.6)将偏航通道电动舵机输出轴偏转角度反馈给微控制器(3.1);
舵机驱动器(3.2)根据俯仰通道电动舵机控制指令控制俯仰通道电动舵机(3.3)运动,俯仰通道电动舵机(3.3)的运动带动俯仰通道电位器(3.5)的输入轴运动,俯仰通道电位器(3.5)将俯仰通道电动舵机输出轴偏转角度反馈给微控制器(3.1);
微控制器(3.1)根据下一时刻三轴转台(2.1)的俯仰角θ2、偏航角ψ2和滚转角γ2向控制柜(2.2)发送姿态驱动指令,三轴转台(2.1)在姿态驱动指令的驱动下运动,微控制器(3.1)获取地磁装置(3.10)反馈的姿态角;
微控制器(3.1)根据下一时刻弹体在WGS-84系中的位置[xd2,yd2,zd2]T与速度[vxd2,vyd2,vzd2]T向北斗卫星模拟器(4.1)发送弹体运动驱动指令,北斗卫星模拟器(4.1)根据弹体运动驱动指令模拟弹体的位置与速度信号,再通过卫星射频天线(4.2)发送出,北斗卫星接收器(3.12)通过接收天线接收到北斗卫星模拟器(4.1)模拟的弹体的位置与速度信号,微控制器(3.1)获取北斗卫星接收器(3.12)反馈的弹体的位置与速度信号,并回到步骤2,进行步骤2~4的依次循环直到弹目距离参数R1小于等于设定的距离常数,跳出循环,每个循环中微控制器(3.1)通过存储装置(3.9)进行数据存储,并发送给主控机(1.1),即本次制导弹药外弹道半实物仿真结束。
10.根据权利要求1搜索的制导弹药外弹道半实物仿真方法,其特征在于:步骤4中,所述设定的距离常数为毁伤半径rs,跳出循环的条件为根据当前时刻弹目相对距离参数R1与毁伤半径rs的大小关系判断弹体是否命中目标,若R1≤rs表示弹体命中目标,本次半实物仿真结束。

说明书全文

制导弹药外弹道半实物仿真平台及方法

技术领域

[0001] 本发明涉及制导弹药外弹道半实物仿真技术领域,具体地指制导弹药外弹道半实物仿真平台及方法。

背景技术

[0002] 随着电光技术、信息技术、控制技术、微电子技术的应用,出现了许多新型制导弹药,它们在作用原理、飞行原理和弹道特性上都与传统弹药有很大差别,这促进着新型外弹道理论的建立与发展,不可避免地,其结构与参数将更加复杂。
[0003] 近年来,各国大发展高精度低成本的新型制导弹药,目前主要是通过数字仿真选取无控段、中制导段与末制导段的外弹道结构参数,但这种方式只适用于结构简单、参数较少的传统制导方法,对于新型中、末制导律,却难以确定出可信度较高的结构与参数,无法进行成本高、周期长的实弹飞行检验,阻碍了新型外弹道理论的发展及其在新型制导弹药上的应用。

发明内容

[0004] 本发明的目的就是要提供一种制导弹药外弹道半实物仿真平台及方法,该平台和方法能实现对俯仰偏航通道电动机、三轴转台和北斗卫星模拟器的实时驱动,获取俯仰和偏航通道电动舵机、地磁装置和北斗卫星接收器的反馈数据,以及外弹道的半实物仿真,有利于提高所选取结构与参数的可信度,并缩短研制周期、降低研制成本。
[0005] 为实现此目的,本发明所设计的制导弹药外弹道半实物仿真平台,其特征在于:它包括主控机、三轴转台、转台控制柜、以及固定在三轴转台上的控制舱单元,所述控制舱单元包括微控制器、舵机驱动器、俯仰通道电动舵机、偏航通道电动舵机、俯仰通道电位器、偏航通道电位器、地磁装置、北斗卫星接收器和北斗卫星模拟器;
[0006] 所述控制舱单元用于模拟制导弹药的外弹道运动过程;
[0007] 所述主控机用于向微控制器输送外弹道控制程序、仿真控制指令和仿真控制参数,微控制器的舵机指令输出端连接舵机驱动器的指令输入端,舵机驱动器的偏航通道电动舵机控制信号输出端连接偏航通道电动舵机的信号输入端,舵机驱动器的俯仰通道电动舵机控制信号输出端连接俯仰通道电动舵机的信号输入端,偏航通道电动舵机的输出轴与偏航通道电位器的输入轴固定连接,俯仰通道电动舵机的输出轴与俯仰通道电位器的输入轴固定连接,偏航通道电位器的偏航通道电动舵机输出轴偏转度信号输出端连接微控制器的偏航通道反馈数据输入端,俯仰通道电位器的俯仰通道电动舵机输出轴偏转角度信号输出端连接微控制器的俯仰通道反馈数据输入端;
[0008] 微控制器的转台控制通信端连接转台控制柜的通信端,控制柜用于控制三轴转台运动,微控制器的姿态通信端连接地磁装置的通信端,地磁装置用于获取当前时刻制导弹药的姿态角,微控制器用于向转台控制柜输送姿态驱动指令,并接收地磁装置的制导弹药姿态和滚转角反馈信息;
[0009] 微控制器的制导弹药位置与速度控制及反馈信号通信端分别连接北斗卫星模拟器的信号输入端和北斗卫星接收器的反馈数据输出端,北斗卫星模拟器用于在微控制器发出的制导弹药位置与速度控制信号的控制下模拟制导弹药的位置与速度信号,北斗卫星接收器用于获取当前时刻北斗卫星模拟器模拟的制导弹药位置与速度信号;
[0010] 微控制器用于根据北斗卫星接收器反馈的模拟制导弹药位置信号计算当前时刻制导弹药与目标之间的弹目距离、制导弹药与目标之间的视线倾角和制导弹药与目标之间的视线偏角,微控制器还用于根据北斗卫星接收器反馈的模拟制导弹药速度信号计算当前时刻的制导弹药弹道倾角、制导弹药弹道偏角,微控制器还用于根据制导弹药弹道倾角、制导弹药弹道偏角以及地磁装置反馈的当前时刻控制舱单元的姿态角计算当前时刻的制导弹药准攻角与制导弹药准侧滑角;微控制器还用于根据俯仰通道电动舵机输出轴偏转角度信号、偏航通道电动舵机输出轴偏转角度信号以及地磁装置反馈的制导弹药滚转角计算当前时刻的俯仰通道电动舵机等效偏角和偏航通道电动舵机等效偏角;微控制器还用于根据制导弹药准攻角、制导弹药准侧滑角、俯仰通道电动舵机等效偏角和偏航通道电动舵机等效偏角计算当前时刻作用于制导弹药的法向力、侧向力、俯仰力矩和偏航力矩;微控制器还用于根据所述制导弹药的法向力、侧向力、俯仰力矩、偏航力矩、地磁装置的制导弹药姿态反馈信息、北斗卫星接收器反馈的模拟制导弹药位置与速度信号,通过四阶龙格库塔法得到下一时刻模拟制导弹药外弹道的参数与控制信息。
[0011] 一种制导弹药外弹道半实物仿真方法,它包括如下步骤:
[0012] 步骤1:主控机通过外弹道软件向微控制器发送仿真控制指令、装定仿真控制程序和仿真控制参数;
[0013] 在外弹道软件上选择已经编译好的仿真控制程序,通过发送装定程序控制指令将仿真控制程序装定到微控制器中,仿真控制程序包括微分方程组和四阶龙格库塔算法,微分方程组包括弹体六自由度动力学模型、目标三自由度运动学模型、弹目空间相对运动模型、中制导律模型和末制导律模型;
[0014] 在外弹道软件上选取或输入仿真环境参数、制导弹药属性参数、目标属性参数、中制导律参数和末制导律参数,通过发送装定参数控制指令将仿真环境参数、制导弹药属性参数、目标属性参数、中制导律参数和末制导律参数装定到微控制器中;
[0015] 步骤2:微控制器根据仿真环境参数中的制导弹药射向角度αN、制导弹药初始的经纬高[λ0、φ0、h0]T和北斗卫星接收器反馈的制导弹药在WGS-84系中当前时刻的位置[xd1,yd1,zd1]T信号通过如下公式1解算当前时刻制导弹药在基准系中当前时刻的位置[xP1,yP1,zP1]T;
[0016]
[0017] 其中,B为由WGS-84系向基准系转换的矩阵,λ0、φ0分别表示制导弹药初始的经纬度,xd1,yd1,zd1分别表示WGS-84系中当前时刻的滚转轴,航向轴,俯仰轴坐标值,xP1,yP1,zP1分别表示基准系中当前时刻的滚转轴,航向轴,俯仰轴坐标值;
[0018] 微控制器根据制导弹药在基准系中当前时刻的位置[xP1,yP1,zP1]T和目标属性参数中的目标在基准系中的位置(xT,yT,zT)通过如下公式2解算当前时刻的弹目距离R1;
[0019]
[0020] 其中,xT,yT,zT分别表示目标在基准系中的滚转轴,航向轴,俯仰轴坐标;
[0021] 微控制器根据制导弹药在基准系中当前时刻的位置[xP1,yP1,zP1]T、目标属性参数中的目标在基准系中的位置(xT,yT,zT)以及弹目距离R1通过如下公式3解算当前时刻的制导弹药与目标之间的视线倾角θQ1;
[0022]
[0023] 微控制器根据制导弹药在基准系中当前时刻的位置[xP1,yP1,zP1]T、目标属性参数中的目标在基准系中的位置(xT,yT,zT)通过如下公式4解算当前时刻的制导弹药与目标之间的视线偏角ψQ1;
[0024]
[0025] 微控制器根据北斗卫星接收器反馈的制导弹药在WGS-84系中当前时刻的速度[vxd1,vyd1,vzd1]T信号通过如下公式5解算当前时刻的制导弹药合速度vP1;
[0026]
[0027] 其中,vxd1,vyd1,vzd1分别表示制导弹药在WGS-84系中当前时刻的滚转轴,航向轴,俯仰轴上当前时刻的速度;
[0028] 微控制器根据北斗卫星接收器反馈的制导弹药在WGS-84系中当前时刻的速度[vxd1,vyd1,vzd1]T信号和制导弹药当前时刻的合速度vP1通过如下公式6解算当前时刻的弹道倾角θP1;
[0029]
[0030] 微控制器根据北斗卫星接收器反馈的制导弹药在WGS-84系中当前时刻的速度[vxd1,vyd1,vzd1]T信号、制导弹药当前时刻的合速度vP1和弹道倾角θP1通过如下公式7解算当前时刻的弹道偏角ψP1;
[0031]
[0032] 微控制器根据弹道倾角信号θP1和地磁装置反馈的俯仰角信号θ1通过如下公式8解算当前时刻制导弹药的准攻角
[0033]
[0034] 微控制器根据弹道偏角信号ψP1和地磁装置反馈的偏航角信号ψ1通过如下公式9解算当前时刻弹体的准侧滑角
[0035]
[0036] 微控制器根据当前时刻俯仰通道电动舵机输出轴偏转角度δz1、偏航通道电动舵机输出轴偏转角度δy1与地磁装置反馈的制导弹药滚转角γ1通过如下公式10解算当前时刻俯仰通道电动舵机输出轴等效偏角δzeq1和偏航通道电动舵机输出轴等效偏角δyeq1;
[0037]
[0038] 结合当前时刻制导弹药准攻角 当前时刻制导弹药准侧滑角 当前时刻俯仰通道电动舵机输出轴等效偏角δzeq1、当前时刻偏航通道电动舵机输出轴等效偏角δyeq1与步骤1中装定的仿真控制参数,通过步骤1中装定的弹体六自由度动力学模型解算当前时刻作用于制导弹药的法向力、侧向力、俯仰力矩和偏航力矩;
[0039] 步骤3:微控制器根据步骤1中装定的微分方程组与四阶龙格库塔法解算下一时刻的外弹道控制参数与微分方程组中所需要求解的变量参数,包括下一时刻的弹目距离R2、制导弹药与目标之间的视线倾角θQ2、制导弹药与目标之间的视线偏角ψQ2、弹道倾角θP2、弹道偏角ψP2、制导弹药在基准系中的位置[xP2,yP2,zP2]T与速度[vxP2,vyP2,vzP2]T、俯仰通道舵机输出轴等效偏角δzeq2、偏航通道舵机输出轴等效偏角δyeq2和三轴转台的俯仰角θ2、偏航角ψ2和滚转角γ2,vxP2,vyP2,vzP2为基准系中的滚转轴,航向轴,俯仰轴速度;
[0040] 微控制器根据下一时刻俯仰通道舵机输出轴等效偏角δzeq2、下一时刻偏航通道舵机输出轴等效偏角δyeq2和下一时刻三轴转台的滚转角γ2通过如下公式解算下一时刻俯仰通道电动舵机输出轴偏角δz2、偏航通道电动舵机输出轴偏角δy2;
[0041]
[0042] 微控制器根据仿真环境参数中的制导弹药射向角度αN、制导弹药初始的经纬高制导弹药在WGS-84系中初始的位置[xd0,yd0,zd0]T以及下一时刻制导弹药T
在基准系中的位置[xP2,yP2,zP2] 通过如下公式12解算下一时刻制导弹药在WGS-84系中下一时刻的位置[xd2,yd2,zd2]T;
[0043]
[0044] 其中,xP2,yP2,zP2为基准系中下一时刻的滚转轴,航向轴,俯仰轴坐标值,xd0,yd0,zd0为WGS-84系中下一时刻的滚转轴,航向轴,俯仰轴坐标值,xd2,yd2,zd2为WGS-84系中下一时刻的滚转轴,航向轴,俯仰轴坐标值;
[0045] 微控制器根据仿真环境参数中的制导弹药射向角度αN、制导弹药初始的经纬高以及下一时刻制导弹药射在基准系中的速度[vxP2,vyP2,vzP2]T通过如下公式13解算下一时刻制导弹药射在WGS-84系中的速度[vxd2,vyd2,vzd2]T;
[0046]
[0047] B-1为由WGS-84系向基准系转换的逆矩阵,vxP2,vyP2,vzP2为基准系中滚转轴,航向轴,俯仰轴上的速度值,vxd2,vyd2,vzd2为WGS-84系中基准系中滚转轴,航向轴,俯仰轴上的速度值;
[0048] 步骤4:微控制器根据下一时刻俯仰通道电动舵机输出轴偏角δz2和偏航通道电动舵机输出轴偏角δy2向舵机驱动器发送偏航通道电动舵机控制指令和俯仰通道电动舵机控制指令;
[0049] 舵机驱动器根据偏航通道电动舵机控制指令控制偏航通道电动舵机运动,偏航通道电动舵机的运动带动偏航通道电位器的输入轴运动,偏航通道电位器将偏航通道电动舵机输出轴偏转角度反馈给微控制器;
[0050] 舵机驱动器根据俯仰通道电动舵机控制指令控制俯仰通道电动舵机运动,俯仰通道电动舵机的运动带动俯仰通道电位器的输入轴运动,俯仰通道电位器将俯仰通道电动舵机输出轴偏转角度反馈给微控制器;
[0051] 微控制器根据下一时刻三轴转台的俯仰角θ2、偏航角ψ2和滚转角γ2向控制柜发送姿态驱动指令,三轴转台在姿态驱动指令的驱动下运动,微控制器获取地磁装置反馈的姿态角;
[0052] 微控制器根据下一时刻弹体在WGS-84系中的位置[xd2,yd2,zd2]T与速度[vxd2,vyd2,vzd2]T向北斗卫星模拟器发送弹体运动驱动指令,北斗卫星模拟器根据弹体运动驱动指令模拟弹体的位置与速度信号,再通过卫星射频天线发送出,北斗卫星接收器通过接收天线接收到北斗卫星模拟器模拟的弹体的位置与速度信号,微控制器获取北斗卫星接收器反馈的弹体的位置与速度信号,并回到步骤2,进行步骤2~4的依次循环直到弹目距离参数R1小于等于设定的距离常数,跳出循环,每个循环中微控制器通过存储装置进行数据存储,并发送给主控机,即本次制导弹药外弹道半实物仿真结束。
[0053] 本发明的制导弹药外弹道半实物仿真平台及方法结合了半实物仿真技术的优势和制导弹药外弹道的特性,将嵌入式微控制器技术和半实物仿真技术相结合,并将舵机、三轴转台、地磁装置、北斗卫星模拟器和北斗卫星接收器纳入半实物仿真回路,解决了数字仿真因舵机动态特性、姿态角测量误差、弹体位置测量误差和弹体速度测量误差等难以精确建模而导致仿真可信度较低的问题,通过串行通信总线装定程序、装定参数和控制平台,并实时传输、接收、存储与显示参数,方便用户轻松完成制导弹药外弹道的半实物仿真和选取可信度较高的结构与参数,降低实验成本、缩短实验周期,有助于推动新型外弹道理论的发展及其在制导弹药上的应用。附图说明
[0054] 图1为本发明的结构示意图。
[0055] 其中,1—主控单元、1.1—主控机、1.2—第一RS485至USB转换器、2—姿态模拟单元、2.1—三轴转台、2.2—转台控制柜、2.3—第二RS485至USB转换器、3—控制舱单元、3.1—微控制器、3.2—舵机驱动器、3.3—俯仰通道电动舵机、3.4—偏航通道电动舵机、
3.5—俯仰通道电位器、3.6—偏航通道电位器、3.7—第一TTL至485转换器、3.8—第二TTL至485转换器、3.9—存储装置、3.10—地磁装置、3.11—TTL至RJ45转换器、3.12—北斗卫星接收器、4—弹体运动模拟单元、4.1—北斗卫星模拟器、4.2—卫星射频天线。

具体实施方式

[0056] 以下结合附图和具体实施例对本发明作进一步的详细说明:
[0057] 如图1所示的制导弹药外弹道半实物仿真平台,它包括主控机1.1、三轴转台2.1、转台控制柜2.2、以及固定在三轴转台2.1控制舱内部的控制舱单元3,所述控制舱单元3包括微控制器3.1、舵机驱动器3.2、俯仰通道电动舵机3.3、偏航通道电动舵机3.4、俯仰通道电位器3.5、偏航通道电位器3.6、地磁装置3.10、北斗卫星接收器3.12和北斗卫星模拟器4.1;
[0058] 所述控制舱单元3用于模拟制导弹药的外弹道运动过程;
[0059] 所述主控机1.1用于向微控制器3.1输送外弹道控制程序、仿真控制指令和仿真控制参数,微控制器3.1的舵机指令输出端连接舵机驱动器3.2的指令输入端,舵机驱动器3.2的偏航通道电动舵机控制信号输出端连接偏航通道电动舵机3.4的信号输入端,舵机驱动器3.2的俯仰通道电动舵机控制信号输出端连接俯仰通道电动舵机3.3的信号输入端,偏航通道电动舵机3.4的输出轴与偏航通道电位器3.6的输入轴固定连接,俯仰通道电动舵机3.3的输出轴与俯仰通道电位器3.5的输入轴固定连接,偏航通道电位器3.6的偏航通道电动舵机输出轴偏转角度信号输出端连接微控制器3.1的偏航通道反馈数据输入端,俯仰通道电位器3.5的俯仰通道电动舵机输出轴偏转角度信号输出端连接微控制器3.1的俯仰通道反馈数据输入端;
[0060] 微控制器3.1的转台控制通信端连接转台控制柜2.2的通信端,控制柜2.2用于控制三轴转台2.1运动,微控制器3.1的姿态通信端连接地磁装置3.10的通信端,地磁装置3.10用于获取当前时刻制导弹药的姿态角(即控制舱单元3或三轴转台2.1的姿态角),微控制器3.1用于向转台控制柜2.2输送姿态驱动指令,并接收地磁装置3.10的制导弹药姿态和滚转角反馈信息,即三轴转台2.1的姿态反馈信息;
[0061] 微控制器3.1的制导弹药位置与速度控制及反馈信号通信端分别连接北斗卫星模拟器4.1的信号输入端和北斗卫星接收器3.12的反馈数据输出端,北斗卫星模拟器4.1用于在微控制器3.1发出的制导弹药位置与速度控制信号的控制下模拟制导弹药的位置与速度信号,北斗卫星接收器3.12用于获取当前时刻北斗卫星模拟器4.1模拟的制导弹药位置与速度信号;
[0062] 微控制器3.1用于根据北斗卫星接收器3.12反馈的模拟制导弹药位置信号计算当前时刻制导弹药与目标之间的弹目距离、制导弹药与目标之间的视线倾角和制导弹药与目标之间的视线偏角,微控制器3.1还用于根据北斗卫星接收器3.12反馈的模拟制导弹药速度信号计算当前时刻的制导弹药弹道倾角、制导弹药弹道偏角,微控制器3.1还用于根据制导弹药弹道倾角、制导弹药弹道偏角以及地磁装置3.10反馈的当前时刻控制舱单元3的姿态角计算当前时刻的制导弹药准攻角与制导弹药准侧滑角;微控制器3.1还用于根据俯仰通道电动舵机输出轴偏转角度信号、偏航通道电动舵机输出轴偏转角度信号以及地磁装置3.10反馈的制导弹药滚转角计算当前时刻的俯仰通道电动舵机等效偏角和偏航通道电动舵机等效偏角;微控制器3.1还用于根据制导弹药准攻角、制导弹药准侧滑角、俯仰通道电动舵机等效偏角和偏航通道电动舵机等效偏角计算当前时刻作用于制导弹药的法向力、侧向力、俯仰力矩和偏航力矩;微控制器3.1还用于根据所述制导弹药的法向力、侧向力、俯仰力矩、偏航力矩、地磁装置3.10的制导弹药姿态反馈信息、北斗卫星接收器3.12反馈的模拟制导弹药位置与速度信号,通过四阶龙格库塔法得到下一时刻模拟制导弹药外弹道的参数与控制信息。
[0063] 上述设计方案中,所述下一时刻模拟制导弹药外弹道的参数与控制信息包括制导弹药与目标之间的弹目距离、制导弹药与目标之间的视线倾角、制导弹药与目标之间的视线偏角、制导弹药弹道倾角、制导弹药弹道偏角、制导弹药位置、制导弹药速度、俯仰通道舵机输出轴偏角、偏航通道舵机输出轴偏角以及制导弹药的姿态角。
[0064] 上述设计方案中,它还包括卫星射频天线4.2,卫星射频天线4.2用于发射北斗卫星模拟器4.1所模拟的弹体的位置与速度信号。
[0065] 上述设计方案中,它还包括第一RS485至USB转换器1.2、第一TTL至485转换器3.7、第二TTL至485转换器3.8、第二RS485至USB转换器2.3、存储装置3.9、TTL至RJ45转换器3.11;
[0066] 主控机1.1的外弹道控制程序输出端连接微控制器3.1的控制程序输入端,主控机1.1的仿真控制指令和仿真控制参数输出端依次通过第一RS485至USB转换器1.2和第一TTL至485转换器3.7连接微控制器3.1的串口数据输入端,微控制器3.1的转台控制通信端依次通过第二TTL至485转换器3.8和第二RS485至USB转换器2.3连接转台控制柜2.2的通信端,存储装置3.9的数据存储端连接微控制器3.1的数据存储端,微控制器3.1的北斗卫星模拟器通信端通过TTL至RJ45转换器3.11连接北斗卫星模拟器4.1的信号输入端,微控制器3.1的北斗卫星接收器通信输入端连接北斗卫星接收器3.12的通信输出端。
[0067] 上述技术方案中,所述三轴转台2.1的姿态角包括俯仰角、偏航角和滚转角;
[0068] 所述转台控制柜2.2能根据微控制器3.1发送的转台姿态驱动指令,驱动三轴转台2.1进行俯仰、偏航、滚转运动,姿态角范围为俯仰角-80°~+80°、偏航角-60°~+60°、滚转角连续旋转,姿态角精度为10’(单位为分)。
[0069] 上述设计方案中,三轴转台2.1的角速度范围为俯仰-10°/s~+10°/s、偏航-10°/s~+10°/s、滚转-3600°/s~3600°/s,角加速度范围为-100°/s2~+100°/s2。
[0070] 上述设计方案中,所述主控机1.1和第一RS485至USB转换器1.2构成主控单元1,三轴转台2.1、控制柜2.2和第二RS485至USB转换器2.3构成弹体姿态模拟单元2,所述微控制器3.1、舵机驱动器3.2、俯仰通道电动舵机3.3、偏航通道电动舵机3.4、俯仰通道电位器3.5、偏航通道电位器3.6、第一TTL至485转换器3.7、第二TTL至485转换器3.8、存储装置
3.9、地磁装置3.10、TTL至RJ45转换器3.11和北斗卫星接收器3.12构成控制舱单元3,北斗卫星模拟器4.1和卫星射频天线4.2构成弹体运动模拟单元4。
[0071] 上述设计方案中,所述控制舱单元3具有轴对称外形,控制舱单元3通过机械方式固定安装在三轴转台2.1上,控制舱单元3的纵轴与三轴转台2.1滚转方向轴线重合。
[0072] 上述技术方案中,三轴转台2.1在运行时,对极限位置采取了三级保护:(1)软件限位,转台控制软件自动对计算当前位置,一旦计算出某个方向上超限,就禁止向超限方向运动,仅允许反方向运动;(2)硬件限位,各极限位置安装有限位开关,当机构运动触及限位开关时,强行终止三轴转台2-1的运动;机械限位:(3)各极限位置安装有机械挡,确保机构运动到极限位置不再继续运动。
[0073] 上述技术方案中,北斗卫星模拟器4.1在运行时,可以产生12颗卫星信号,支持BD3频点(1268.52MHz±10.23MHz)的信号仿真输出,位置精度≤10m(PDOP≤3),高程精度≤20m(PDOP≤3),速度精度≤0.2m/s(PDOP≤3),秒脉冲授时精度≤100ns,捕获灵敏度≤-136dBm,跟踪灵敏度≤-140dBm,适用动态条件的速度范围为0m/s~1000m/s,并且能够提供高稳定度的标准1PPS脉冲信号输出。
[0074] 上述技术方案中,北斗卫星模拟器4.1与微控制器3.1之间通过RJ45网络链路进行连接,采用UDP协议进行传输,弹体位置数据命令的交互UDP端口号为6789,其他所有命令交互UDP端口号为8990。
[0075] 一种制导弹药外弹道半实物仿真方法,它包括如下步骤:
[0076] 步骤1:主控机1.1通过外弹道软件(外弹道软件在主控机1.1上使用)向微控制器3.1发送仿真控制指令、装定仿真控制程序和仿真控制参数,仿真控制指令是主控机1.1控制微控制器3.1的一系列已经在外弹道软件中设定好的控制指令,包括连接串口、装定程序、装定参数、检查装定参数、初始转台、初始北斗卫星模拟器、启动仿真、关闭串口和平台回零等;
[0077] 在外弹道软件上选择已经编译好的仿真控制程序,通过发送装定程序控制指令将仿真控制程序装定到微控制器3.1中,仿真控制程序包括微分方程组和四阶龙格库塔算法,微分方程组包括弹体六自由度动力学模型(参考文献韩子鹏.弹箭外弹道学[M].北京:北京理工大学出版社,2014.)、目标三自由度运动学模型、弹目空间相对运动模型、中制导律模型和末制导律模型;
[0078] 在外弹道软件上选取或输入仿真环境参数、制导弹药属性参数、目标属性参数、中制导律参数和末制导律参数,通过发送装定参数控制指令将仿真环境参数、制导弹药属性参数、目标属性参数、中制导律参数和末制导律参数装定到微控制器3.1中;
[0079] 步骤2:微控制器3.1根据仿真环境参数中的制导弹药射向角度αN、制导弹药的初始经纬高[λ0、φ0、h0]T和北斗卫星接收器3.12反馈的制导弹药在WGS-84系中的当前时刻位置[xd1,yd1,zd1]T信号通过如下公式1解算当前时刻制导弹药在基准系中的当前时刻位置[xP1,yP1,zP1]T,WGS-84系和基准系的详细说明见(参考文献韩子鹏.弹箭外弹道学[M].北京:北京理工大学出版社,2014.);
[0080]
[0081] 其中,B为由WGS-84系向基准系转换的矩阵,λ0、φ0分别表示制导弹药的初始经纬度,xd1,yd1,zd1分别表示WGS-84系中当前时刻的滚转轴,航向轴,俯仰轴坐标值,xP1,yP1,zP1分别表示基准系中当前时刻的滚转轴,航向轴,俯仰轴坐标值;
[0082] 微控制器3.1根据制导弹药在基准系中的当前时刻位置[xP1,yP1,zP1]T和目标属性参数中的目标在基准系中的位置(xT,yT,zT)通过如下公式2解算当前时刻的弹目距离R1;
[0083]
[0084] 其中,xT,yT,zT分别表示目标在基准系中的滚转轴,航向轴,俯仰轴坐标;
[0085] 微控制器3.1根据制导弹药在基准系中的当前时刻位置[xP1,yP1,zP1]T、目标属性参数中的目标在基准系中的位置(xT,yT,zT)以及弹目距离R1通过如下公式3解算当前时刻的制导弹药与目标之间的视线倾角θQ1;
[0086]
[0087] 微控制器3.1根据制导弹药在基准系中的当前时刻位置[xP1,yP1,zP1]T、目标属性参数中的目标在基准系中的位置(xT,yT,zT)通过如下公式4解算当前时刻的制导弹药与目标之间的视线偏角ψQ1;
[0088]
[0089] 微控制器3.1根据北斗卫星接收器3.12反馈的制导弹药在WGS-84系中的当前时刻速度[vxd1,vyd1,vzd1]T信号通过如下公式5解算当前时刻的制导弹药合速度vP1;
[0090]
[0091] 其中,vxd1,vyd1,vzd1分别表示制导弹药在WGS-84系中当前时刻的滚转轴,航向轴,俯仰轴上当前时刻的速度;
[0092] 微控制器3.1根据北斗卫星接收器3.12反馈的制导弹药在WGS-84系中当前时刻的速度[vxd1,vyd1,vzd1]T信号和制导弹药当前时刻的合速度vP1通过如下公式6解算当前时刻的弹道倾角θP1;
[0093]
[0094] 微控制器3.1根据北斗卫星接收器3.12反馈的制导弹药在WGS-84系中当前时刻的速度[vxd1,vyd1,vzd1]T信号、制导弹药合当前时刻的速度vP1和弹道倾角θP1通过如下公式7解算当前时刻的弹道偏角ψP1;
[0095]
[0096] 微控制器3.1根据弹道倾角信号θP1和地磁装置3.10反馈的俯仰角信号θ1通过如下公式8解算当前时刻制导弹药的准攻角
[0097]
[0098] 微控制器3.1根据弹道偏角信号ψP1和地磁装置3.10反馈的偏航角信号ψ1通过如下公式9解算当前时刻弹体的准侧滑角
[0099]
[0100] 微控制器3.1根据当前时刻俯仰通道电动舵机输出轴偏转角度δz1、偏航通道电动舵机输出轴偏转角度δy1与地磁装置3.10反馈的制导弹药滚转角γ1通过如下公式10解算当前时刻俯仰通道电动舵机输出轴等效偏角δzeq1和偏航通道电动舵机输出轴等效偏角δyeq1;
[0101]
[0102] 结合当前时刻制导弹药准攻角 当前时刻制导弹药准侧滑角 当前时刻俯仰通道电动舵机输出轴等效偏角δzeq1、当前时刻偏航通道电动舵机输出轴等效偏角δyeq1与步骤1中装定的仿真控制参数,通过步骤1中装定的弹体六自由度动力学模型解算当前时刻作用于制导弹药的法向力、侧向力、俯仰力矩和偏航力矩;
[0103] 步骤3:微控制器3.1根据步骤1中装定的微分方程组与四阶龙格库塔法解算下一时刻的外弹道控制参数与微分方程组中所需要求解的变量参数,包括下一时刻的弹目距离R2、制导弹药与目标之间的视线倾角θQ2、制导弹药与目标之间的视线偏角ψQ2、弹道倾角θP2、弹道偏角ψP2、制导弹药在基准系中的位置[xP2,yP2,zP2]T与速度[vxP2,vyP2,vzP2]T、俯仰通道舵机输出轴等效偏角δzeq2、偏航通道舵机输出轴等效偏角δyeq2和三轴转台的俯仰角θ2、偏航角ψ2和滚转角γ2,vxP2,vyP2,vzP2为基准系中的滚转轴,航向轴,俯仰轴速度;
[0104] 微控制器3.1根据下一时刻俯仰通道舵机输出轴等效偏角δzeq2、下一时刻偏航通道舵机输出轴等效偏角δyeq2和下一时刻三轴转台的滚转角γ2通过如下公式(11)解算下一时刻俯仰通道电动舵机输出轴偏角δz2、偏航通道电动舵机输出轴偏角δy2;
[0105]
[0106] 微控制器3.1根据仿真环境参数中的制导弹药射向角度αN、制导弹药初始的经纬高 制导弹药在WGS-84系中初始的位置[xd0,yd0,zd0]T以及制导弹药在基准系中下一时刻的位置[xP2,yP2,zP2]T通过如下公式12解算下一时刻制导弹药在WGS-84系中下一时刻的位置[xd2,yd2,zd2]T;
[0107]
[0108] 其中,xP2,yP2,zP2为基准系中下一时刻的滚转轴,航向轴,俯仰轴坐标值,xd0,yd0,zd0为WGS-84系中初始的滚转轴,航向轴,俯仰轴坐标值,xd2,yd2,zd2为WGS-84系中下一时刻的滚转轴,航向轴,俯仰轴坐标值;
[0109] 微控制器3.1根据仿真环境参数中的制导弹药射向角度αN、制导弹药初始的经纬高 以及下一时刻制导弹药射在基准系中的速度[vxP2,vyP2,vzP2]T通过如下公式13解算下一时刻制导弹药射在WGS-84系中的速度[vxd2,vyd2,vzd2]T;
[0110]
[0111] B-1为由WGS-84系向基准系转换的逆矩阵,vxP2,vyP2,vzP2为基准系中滚转轴,航向轴,俯仰轴上的速度值,vxd2,vyd2,vzd2为WGS-84系中基准系中滚转轴,航向轴,俯仰轴上的速度值;
[0112] 步骤4:微控制器3.1根据下一时刻俯仰通道电动舵机输出轴偏角δz2和偏航通道电动舵机输出轴偏角δy2向舵机驱动器3.2发送偏航通道电动舵机控制指令和俯仰通道电动舵机控制指令;
[0113] 舵机驱动器3.2根据偏航通道电动舵机控制指令控制偏航通道电动舵机3.4运动,偏航通道电动舵机3.4的运动带动偏航通道电位器3.6的输入轴运动,偏航通道电位器3.6将偏航通道电动舵机输出轴偏转角度反馈给微控制器3.1;
[0114] 舵机驱动器3.2根据俯仰通道电动舵机控制指令控制俯仰通道电动舵机3.3运动,俯仰通道电动舵机3.3的运动带动俯仰通道电位器3.5的输入轴运动,俯仰通道电位器3.5将俯仰通道电动舵机输出轴偏转角度反馈给微控制器3.1;
[0115] 微控制器3.1根据下一时刻三轴转台2.1的俯仰角θ2、偏航角ψ2和滚转角γ2向控制柜2.2发送姿态驱动指令,三轴转台2.1在姿态驱动指令的驱动下运动,微控制器3.1获取地磁装置3.10反馈的姿态角;
[0116] 微控制器3.1根据下一时刻弹体在WGS-84系中的位置[xd2,yd2,zd2]T与速度[vxd2,vyd2,vzd2]T向北斗卫星模拟器4.1发送弹体运动驱动指令,北斗卫星模拟器4.1根据弹体运动驱动指令模拟弹体的位置与速度信号,再通过卫星射频天线4.2发送出,北斗卫星接收器3.12通过接收天线接收到北斗卫星模拟器4.1模拟的弹体的位置与速度信号,微控制器3.1获取北斗卫星接收器3.12反馈的弹体的位置与速度信号,并回到步骤2,进行步骤2~4的依次循环直到弹目距离参数R1小于等于设定的距离常数,跳出循环,每个循环中微控制器3.1通过存储装置3.9进行数据存储,并发送给主控机1.1,即本次制导弹药外弹道半实物仿真结束,清空微控制器参数,归零三轴转台2.1、俯仰通道电动舵机3.3、偏航通道电动舵机3.4和北斗卫星模拟器4.1。
[0117] 上述技术方案的步骤4中,所述设定的距离常数为毁伤半径rs,跳出循环的条件为根据当前时刻弹目相对距离参数R1与毁伤半径rs的大小关系判断弹体是否命中目标,若R1≤rs表示弹体命中目标,本次半实物仿真结束,主控机1.1向微控制器3.1发送平台回零控制指令,触发微控制器3.1分别向转台控制柜2.2、舵机驱动器3.2、北斗卫星模拟器4.1发送转台回零、舵机回零和北斗卫星模拟器回零的驱动指令,驱动三轴转台2.1、俯仰通道电动舵机3.3、偏航通道电动舵机3.4和北斗卫星模拟器4.1回零。
[0118] 本发明在步骤1之前,舵机驱动器3.2驱动俯仰通道电动舵机3.3和偏航通道电动舵机3.4回零,在转台控制柜2.2上操作转台控制软件驱动三轴转台2.1在俯仰、偏航和滚装方向回零,在北斗卫星模拟器4.1上操作北斗卫星模拟器控制软件使北斗卫星模拟器4.1回零,并检查各设备的独自工作情况。
[0119] 本发明中微控制器3.1将每次循环中解算的下一时刻参数通过DMA(Direct Memory Access,直接存储器存取)传输给存储装置3.9,存储装置3.9进行存储,微控制器3.1每进行五次循环将第五次循环中解算的下一时刻参数传输给主控机1.1,主控机1.1进行下一时刻参数的接收、存储与显示。在外弹道软件上通过离线回放或结合MATLAB等专业软件处理分析本次半实物仿真的数据,数据包括主控机1.1与存储装置3.9的存储记录。
[0120] 本说明书未作详细描述的内容属于本领域专业技术人员公知的现有技术
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈