一种无人机避障方法技术

本发明专利技术公开了一种无人机避障方法，主要包括以下步骤：为无人机规划初始飞行路径；利用传感器检测无人机飞行过程中，无人机一定距离内障碍物的位置、速度信息；采用碰撞检测算法计算按照初始路径飞行是否会发生碰撞；根据碰撞检测算法预测的碰撞区域信息以及无人机的目的地，利用策略迭代算法计算出规避碰撞路径；利用回溯法修正规避碰撞路径，避免无人机陷入局部障碍物陷阱；根据无人机动力学性能特性，对修正后的规避碰撞路径进行微分平坦处理。本发明专利技术提出的方法满足实际中无人机的飞行包线限制要求，有效避免路径规划算法中常见的局部障碍物陷阱问题，在满足动力学性能的前提下，可实时规避多个障碍。

Obstacle avoidance method for unmanned aerial vehicle

The invention discloses a UAV obstacle avoidance method mainly comprises the following steps: initial flight path planning for UAV; using sensors to detect the UAV flight of UAV, a certain distance from the position and velocity information of obstacles; using collision detection algorithm to calculate flight according to the initial path is collision based on the collision; regional prediction information collision detection algorithm and the destination of the UAV, using the policy iteration algorithm to calculate the collision avoidance path; the use of backtracking correction to avoid the collision path, to avoid falling into local UAV obstacle traps; according to the dynamic performance characteristics of UAV, the modified collision avoidance path Differential Flatness processing. The method to meet the actual flight of UAV in line package requirements, effectively avoid the local obstacle trap problem common path planning algorithm, in order to meet the dynamic performance, can avoid multiple obstacles in real time.

【技术实现步骤摘要】
一种无人机避障方法
本专利技术涉及无人机
，具体涉及一种无人机避障方法。
技术介绍
相比载人飞行器，无人机在军事与民用领域具有显著优势，现已广泛应用于航拍摄影、环境监测、森林防火等多种领域，且成本低廉。为促进无人机进入更为广阔的应用领域且与载人飞行器共享飞行空间，如何确保无人机的空中飞行安全成为当前需要解决的难题。目前，国内外学者陆续提出了关于无人机避障方法的专利以及文献，例如：文献1(A.G.Shem,T.A.Mazzuchi,andS.Sarkani,”AddressinguncertaintyinUAVnavigationdecision-making,”IEEETransactionsonAerospaceandElectronicSystems,vol.44,no.1,pp.295-313,2008.)作者为使无人机做出特定的机动达到规避碰撞的目的，在面对多个飞行器的情况下采取基于数值仿真的马尔科夫决策过程方法，规划路径并对无人机进行导航。文献2(A.G.Shem,T.A.Mazzuchi,andS.Sarkani,”AddressinguncertaintyinUAVnavigationdecision-making,”IEEETransactionsonAerospaceandElectronicSystems,vol.44,no.1,pp.295-313,2008.)作者考虑到环境的不确定性，采用动态规划法，结合势场法对无人机机组制导、跟踪目标。文献3(S.Temizer,M.J.Kochenderfer,L.P.Kaelbling,T.Lozano-Perez,andJ.K.Kuchar.”CollisionavoidanceforunmannedaircraftusingMarkovdecisionprocesses,”InProceedingsofAIAAGuidance,Navigation,andControlConference,Toronto,Ontario,Canada,2010.)根据多种传感器的模态、成本函数、飞行器性能以及入侵者的轨迹，作者提出了采用马尔科夫决策过程实时规避碰撞的算法。以上文献基于马氏决策应对飞行碰撞做出的无人机路径规划的方法缺少对无人机飞行包线限制的考虑，实际上无人机因为飞行器动力学限制，无法按照规划路径飞行。此外，应用马氏决策规划的路径存在局部陷阱，求解得到的航路容易出现来回震荡现象。中国专利号为CN105549014A的专利公布了一种无人机的激光避障系统，该系统能通过接受外界反射的激光信号来计算障碍物位置，实现无人机的自动避障。该系统主要创新在于利用激光器转动，扩大观测范围，确定障碍物位置信息，局限在于缺少应对碰撞时无人机所须做出轨迹调整的方法。中国专利号为CN105807786A的专利公布了一种无人机自动避障的方法及系统，无人机根据空间环境类型来启动合适的测距装置，提高了无人机避障的成功率。该系统主要创新点在于组合多种检测装置来精确定位障碍物，但同时也增加了无人机的负载，且缺少系统的路径规划方法。中国专利号为CN103365299A的专利公布了一种基于人类避障行为的无人机避障方法及其装置，通过持续探测环境信息以读取障碍物信息并构建避障行为区，计算出无人机理想的前进航线与步长，直至抵达目标点。该方法存在计算量大，没有考虑到无人机动力学性能限制的缺点。综上所述，现有专家已提出的涉及无人机避障方法的文献和专利，存在局限于定位障碍物，缺乏考虑无人机动力学限制及飞行包线要求的问题，无法实现实际中无人机的自主避障。
技术实现思路
本专利技术的目的在于克服上述提出方案的不足，提供了一种利用传感器检测无人机周围环境信息，将障碍物的位置及速度信息发送给控制系统，规划航迹的同时考虑无人机动力学性能限制，使之符合无人机飞行包线限制的要求，以规避碰撞的无人机避障方法。为达到上述目的，本专利技术的技术方案是这样实现的：一种无人机避障方法，主要包括以下步骤：步骤一、无人机规划直达目的地的初始飞行路径；步骤二、利用传感器检测无人机飞行过程中，无人机以及障碍物的位置、速度信息；步骤三、根据步骤二采集的信息，采用碰撞检测算法计算按初始规划轨迹飞行是否会发生碰撞，若否，则继续飞行，如是，则进入步骤四；步骤四、根据无人机的目的地、以及碰撞检测算法计算出预测碰撞区域信息，利用策略迭代算法计算出规避碰撞路径；步骤五、利用回溯法修正规避碰撞路径，以便规避局部障碍物陷阱；步骤六、根据无人机动力学性能特性，利用微分平坦理论对修正后的规避碰撞路径做调整，使无人机满足实际飞行要求，直至抵达目的地。本专利技术所采用的技术方案具有以下有益效果：本专利技术通过传感器检测无人机及周围障碍物的位置速度信息，将相关信息传递给控制系统，根据碰撞检测算法计算碰撞区域及碰撞时间；基于马尔科夫决策过程中的策略迭代理论，结合回溯法可以得到状态转移函数、补偿函数等数据，最终得到理想策略；将理想策略代入航迹规划方程，即可得到期望的碰撞规避路径，可以避免无人机陷入路径规划常见的局部陷阱问题。利用微分平坦理论，提升上述规划航迹的实用性，可以得到满足无人机动力学限制的路径，引导无人机规避障碍。本专利技术提供的无人机避障方法，能够主动检测障碍物并实施碰撞规避。其优点包括满足实际中无人机存在的飞行包线限制，避免路径规划算法中常见的局部障碍物陷阱问题，在满足动力学性能的前提下，可实时规避多个障碍。附图说明图1是无人机避障方法流程示意图；图2是无人机和潜在障碍物的相对运动示意图；图3是无人机的基本动作示意图；图4是无人机基本动作的概率分配图；图5是策略迭代流程示意图；图6是根据本专利技术方案的仿真结果图；图7是期望路径与经微分平坦理论处理后的路径对比图。具体实施方式下面结合附图及具体实例对本专利技术作进一步的详细描述。然而可以理解的是，下述具体实施方式仅仅是本专利技术的优选技术方案，而不应该理解为对本专利技术的限制。如图1所示，一种无人机避障方法，该避障方法主要包括以下步骤：步骤一、无人机规划直达目的地的初始飞行路径。无人机从起点开始，沿初始规划路径出发。步骤二、利用传感器检测无人机飞行过程中，无人机以及无人机800m范围内障碍物的位置、速度信息。如图2所示，对于无人机与障碍物的相对运动，利用机载传感器检测包括无人机速度矢量障碍物速度矢量两者相对速度矢量两者相对位置矢量在内的数据。步骤三、根据步骤二采集的信息，采用碰撞检测算法计算按初始规划轨迹飞行是否会发生碰撞，若否，则继续飞行，如是，则进入步骤四；所述碰撞检测算法计算过程如下：假定通过传感器检测时，障碍物沿着初始航迹运动而无任何机动调整，则根据检测数据可以计算得到无人机和障碍物最近点距离矢量，如下所示：这里表示两者最接近时间点相对位置矢量，表示无人机相对障碍物的单位速度矢量，可以由以下公式得到，无人机和障碍物最近点相对位置矢量也可由以下公式得到，根据两者最近点相对速度矢量和相对位置矢量关系可得：由公式(3)和公式(4)得：如果计算出来的结果τ>0,并且就意味无人机与障碍物之间将发生碰撞，有必要对无人机进行航迹调整。当传感器检测到障碍物时，将障碍物信息传递给无人机控制系统，然后利用上述碰撞检测算法本文档来自技高网...

【技术保护点】
一种无人机避障方法，其特征在于，该避障方法主要包括以下步骤：步骤一、无人机规划直达目的地的初始飞行路径；步骤二、利用传感器检测无人机飞行过程中，无人机以及障碍物的位置、速度信息；步骤三、根据步骤二采集的信息，采用碰撞检测算法计算按初始规划轨迹飞行是否会发生碰撞，若否，则继续飞行，如是，则进入步骤四；步骤四、根据碰撞检测算法计算出预测碰撞区域信息、以及无人机的目的地，利用利用策略迭代算法计算出规避碰撞路径；步骤五、利用回溯法修正规避碰撞路径，以便规避局部障碍物陷阱；步骤六、根据无人机动力学性能特性，利用微分平坦理论对修正后的规避碰撞路径做调整，使无人机满足实际飞行要求，直至抵达目的地。

【技术特征摘要】
1.一种无人机避障方法，其特征在于，该避障方法主要包括以下步骤：步骤一、无人机规划直达目的地的初始飞行路径；步骤二、利用传感器检测无人机飞行过程中，无人机以及障碍物的位置、速度信息；步骤三、根据步骤二采集的信息，采用碰撞检测算法计算按初始规划轨迹飞行是否会发生碰撞，若否，则继续飞行，如是，则进入...

【专利技术属性】
技术研发人员：余翔，周忠宝，宋秉华，余洪山，王立峰，林重重，
申请(专利权)人：湖南大学，
类型：发明
国别省市：湖南,43