一种固定翼飞行器半实物仿真航路规划加速装置及方法

摘要: 本发明涉及半实物仿真与异构并行计算,尤其是涉及一种固定翼飞行器半实物仿真航路规划加速装置及方法。背景技术:1、在固定翼飞行器的研制过程中,半实物仿真是不可缺少的...
一种固定翼飞行器半实物仿真航路规划加速装置及方法

本发明涉及半实物仿真与异构并行计算,尤其是涉及一种固定翼飞行器半实物仿真航路规划加速装置及方法。

背景技术:

1、在固定翼飞行器的研制过程中,半实物仿真是不可缺少的一环。一般将固定翼飞行器的主要部件,如计算机、舵机、imu(惯性测量单元)、载荷等接入半实物仿真系统,提前规划简单航路,模拟单个固定翼飞行器从起飞开始的过程,实现多个固定翼飞行器从不同高度、不同方向对目标进行协同飞行,目前的仿真方法却无法满足对多个固定翼飞行器协同的仿真需求。固定翼飞行器协同飞行受组网边界、环境威胁、飞行器自身性能等诸多因素影响,技术复杂、难度较大。外场实飞试验前,利用半实物仿真对多个固定翼飞行器协同进行仿真验证十分必要,可有效提升实飞试验成功概率,节约大量时间和经济成本。

2、相比于针对一个固定翼飞行器进行半实物仿真,协同仿真需要同时模拟多个固定翼飞行器沿不同航路飞行并完成协同作业,实时并行计算多条航路数据需要占用大量算力,现有半实物仿真系统通常无法满足要求且针对原系统改造难度较高、新增设备价格高昂。

3、因此,提供了一种固定翼飞行器半实物仿真航路规划加速装置及方法。

技术实现思路

1、本发明的目的是提供一种固定翼飞行器半实物仿真航路规划加速装置及方法,通过异构并行计算架构解决现有技术存在的实时并行计算能力不足且改造难度高、成本大的问题。

2、为实现上述目的,本发明提供了一种固定翼飞行器半实物仿真航路规划加速装置,所述航路规划加速装置为pcie板卡样式,可插入半实物仿真系统工控计算机机箱内使用,包括异构核心单元、pcie接口单元、状态指示单元、调试接口单元和电源管理单元;异构核心单元内置有主控芯片,主控芯片具有ps端和pl端,ps端连接状态指示单元和调试接口单元,pl端连接pcie接口单元;电源管理单元与异构核心单元、pcie接口单元、状态指示单元和调试接口单元均相连,用于为各单元供电;pcie接口单元插入半实物仿真系统工控计算机的pcie总线卡槽内,使航路规划加速装置以插卡方式集成于半实物仿真系统中,由pcie总线承载航路规划加速装置与仿真计算机之间的数据交互。

3、优选的,异构核心单元置有主控芯片、时钟电路、内存电路,主控芯片为zynq芯片;主控芯片的ps端为处理系统端,用于运行控制类任务,包括参数配置、任务调度、状态指示和调试信息输出;主控芯片的pl端为可编程逻辑端,用于运行计算类任务,包括航路初始规划、粒子群迭代优化、共享内存读写和pcie通信驱动。

4、优选的,pcie接口单元置有pcie通信总线为pcie gen3×4,并利用板载有源晶振单独为其提供参考时钟,pcie接口单元用于在航路规划加速装置与半实物仿真系统工控计算机之间传输航路任务参数和航路规划结果数据,实现仿真计算机对航路规划加速装置的配置指令下发和航路数据读取。

5、优选的,状态指示单元包括三个led指示灯,通过不同闪烁频率显示自检状态、配置状态和工作状态;自检状态用于指示航路规划加速装置上电后准备就绪状态,配置状态用于指示仿真任务参数和算法约束参数的配置是否完成,工作状态用于指示航路规划计算是否正在进行,以使用户通过led指示灯的闪烁频率获知航路规划加速装置当前所处的工作阶段。

6、优选的,调试接口单元支持串口和网口两种通信方式,串口和网口均用于输出调试信息,两者输出的调试信息内容一致,串口和网口仅在调试阶段可对航路规划加速装置进行配置,航路规划加速装置正式使用后不可配置。

7、本发明还提供了一种固定翼飞行器半实物仿真航路规划加速方法,包括以下步骤:

8、s1、参数配置阶段:在半实物仿真系统工控计算机中进行航路设定,将设定的仿真任务参数和算法约束参数通过pcie总线下发至主控芯片的ps端,ps端接收并存储仿真任务参数和算法约束参数,完成配置后向pl端发送准备就绪通知;所述仿真任务参数包括仿真航路目标位置、任务类型和伴飞航路数量,所述算法约束参数包括航路步长、约束权重和迭代次数;

9、s2、任务下发阶段:pl端接收准备就绪通知后反馈准备就绪确认信号,ps端确认pl端准备就绪后,通过axi总线将仿真任务参数和算法约束参数下发至pl端,并通知pl端开始执行航路规划计算;

10、s3、航路规划执行阶段:pl端接收仿真任务参数和算法约束参数后,先按固定步长和转弯策略进行初始规划,生成一条初始可行航路作为粒子群优化的初始解;然后以所述初始航路为起点,启动粒子群迭代优化计算:对每个粒子根据预设的代价函数评估适应度,所述代价函数包含障碍物代价、平滑代价、边界代价和航程代价,各代价项加权求和得到粒子的适应度值;按照速度更新公式更新每个粒子的速度,按照位置更新公式更新每个粒子的位置,生成新一代粒子群;重复执行适应度评估、速度更新和位置更新,直至满足迭代终止条件时停止迭代,输出当前全局最优粒子对应的航路作为规划结果,生成航路数据;

11、s4、结果读取阶段:pl端将生成的航路数据写入共享内存,ps端通过axi总线读取pl端返回的航路数据,供半实物仿真系统工控计算机通过pcie总线获取并使用。

12、优选的,所述s3中pl端通过对异构核心单元内部的主控芯片编程实现包括:

13、初始规划模块,用于根据仿真任务参数和算法约束参数,按固定步长和转弯策略初步完成航路规划,生成一条初始可行航路,作为粒子群迭代优化的初始解,其中固定步长由算法约束参数中的航路步长确定,转弯策略根据飞行器自身性能约束设定;

14、粒子群迭代模块,用于以初始规划模块生成的初始航路为起点,执行粒子群迭代优化计算;首先初始化粒子群,每个粒子代表一条候选航路,粒子的维度为3n,其中n为航路点数量,每个粒子的位置向量包含所有航路点的三维坐标信息;然后根据预设的代价函数:

15、;

16、评估每个粒子的适应度,为障碍物代价,根据每个航段与威胁源的距离半径计算,用于检查航路是否进入禁飞区;为平滑代价,平滑惩罚相比硬阈值,具有梯度友好优势;为边界代价,当航路超出电子围栏设定的安全区时对航路点施加指数惩罚;为航程代价,为所有航段长度之和与起点终点直线距离的比值;分别为对应的权重系数

17、按照速度更新公式:

18、;

19、更新每个粒子的速度,按照位置更新公式:

20、;

21、更新每个粒子的位置,其中为惯性权重,、为学习因子,、为随机数,为粒子个体历史最优位置,为群体全局最优位置;重复执行适应度评估、速度更新和位置更新,直至满足迭代终止条件时停止迭代,输出当前全局最优粒子对应的航路作为规划结果;

22、共享内存模块,用于半实物仿真系统工控计算机与主控芯片pl端之间共享数据,存储格式包括char、int、float和double等基本数据类型,共享内存中划分有仿真任务指令区、仿真任务参数区、算法约束参数区、当前航行状态区和当前航路数据区,pl端从仿真任务指令区读取仿真任务指令,从仿真任务参数区和算法约束参数区读取仿真任务参数和算法约束参数,并将当前航行状态和当前航路数据分别写入当前航行状态区和当前航路数据区,供半实物仿真系统工控计算机通过pcie总线读取;

23、pcie通信模块,用于实现pcie通信总线驱动,通过pcie通信总线与半实物仿真系统工控计算机进行数据交互,使仿真计算机能够通过pcie总线向航路规划加速装置下发航路任务参数和配置指令,并通过共享内存读取pl端生成的航路规划结果数据。

24、因此,本发明采用上述一种固定翼飞行器半实物仿真航路规划加速装置及方法,具有以下好处:

25、(1在本发明中,利用航路规划加速装置异构核心单元主控芯片fpga的并行计算优势。

26、(2)在本发明中,应用时只需插入到半实物仿真系统工控计算机pcie总线卡槽内,降低了改造原有半实物仿真系统的难度。

27、(3)在本发明中,相比于额外购买新设备,节省了改造原有半实物仿真系统所需的时间和经济成本。

28、下面通过附图和实施例,对本发明的技术方案做进一步的详细描述。