[发明专利]一种飞行器的避障方法及系统

说明书

本发明涉及一种飞行器的避障方法及系统，首先基于障碍物信息、飞行器信息和目标信息得到系统状态、躲避奖励函数和驶向奖励函数；其次基于所述系统状态、躲避奖励函数和驶向奖励函数，对路径规划神经网络进行训练，得到训练好的所述路径规划神经网络；最后基于训练好的所述路径规划神经网络实现飞行的最优路径规划。本发明实现了飞行器在连续的状态、动作空间下的不确定环境中的路径规划是的飞行器能准确迅速地躲避静态和动态障碍物，到达目标点。

技术领域

本发明涉及飞行器技术领域，特别是涉及一种飞行器的避障方法及系统。

背景技术

不确定环境下的动态避障航路规划是飞行器控制中的难点问题，基于已知环境信息的传统路径规划算法不能适应未知的复杂环境，无法对飞行器的飞行路径进行有效的规划，而现有的基于强化学习的路径规划算法难以处理庞大的状态空间，亦无法取得较好的求解效果。

发明内容

有鉴于此，本发明提供了一种飞行器的避障方法及系统，通过对飞行器路径的有效规划，以使飞行器在不确定环境中准确迅速地躲避静态和动态障碍物，安全达到目标点。

为实现上述目的，本发明提供了如下方案：

一种飞行器的避障方法，包括：

基于障碍物信息、飞行器信息和目标信息得到系统状态、躲避奖励函数和驶向奖励函数；

基于所述系统状态、躲避奖励函数和驶向奖励函数，对路径规划神经网络进行训练，得到训练好的所述路径规划神经网络；

基于训练好的所述路径规划神经网络实现飞行的最优路径规划。

优选地，所述基于障碍物信息、飞行器信息和目标信息得到系统状态、躲避奖励函数和驶向奖励函数，包括：

基于障碍物的位置数据与飞行器的位置数据得到初始躲避奖励函数；对所述初始躲避奖励函数进行模糊化，得到所述躲避奖励函数；

基于所述飞行器的位置数据和所述目标位置信息得到初始驶向奖励函数，对所述初始驶向奖励函数进行模糊化，得到所述驶向奖励函数；

基于所述飞行器位置数据、速度数据和航向角以及所述障碍物的位置数据、速度数据和航向角，得到所述系统状态；所述障碍物信息包括所述障碍物的位置数据、速度数据和航向角；所述飞行器信息包括所述飞行器位置数据、速度数据和航向角。

优选地，所述基于所述飞行器位置数据、速度数据和航向角以及所述障碍物的位置数据、速度数据和航向角，得到所述系统状态，包括：

对每个所述障碍物均执行下述过程，得到每个所述障碍物的编码数据，将每个所述障碍物的编码数据与所述飞行器信息进行整合，得到所述系统状态；

基于所述飞行器位置数据和速度数据以及所述障碍物的位置数据和速度数据，建立障碍锥，并得到所述飞行器与所述障碍物之间的位置矢量和相对速度矢量，进一步得到相对速度矢量与位置矢量之间的夹角和障碍锥的半顶角；

对所述夹角与所述半顶角进行比较，若所述夹角大于所述半顶角，则舍弃所述障碍物信息；若所述夹角小于或等于所述半顶角，则获取所述飞行器相对于所述障碍物的最优避障方向，将所述最优避障方向以及所述障碍物的位置数据、速度数据和航向角进行编码，得到所述障碍物的编码数据。

优选地，所述基于所述系统状态、躲避奖励函数和驶向奖励函数，对路径规划神经网络进行训练，得到训练好的所述路径规划神经网络，包括：

将所述系统状态输入所述路径规划神经网络，得到避障动作；

获取所述飞行器执行所述避障动作后的状态空间；

基于所述目标信息、所述躲避奖励函数和所述驶向奖励函数，得到飞行器执行所述避障动作后的躲避奖励值和驶向奖励值；