CN111123984A - 一种基于位置与速度人工势场法的无人机路径规划方法 - Google Patents
一种基于位置与速度人工势场法的无人机路径规划方法 Download PDFInfo
- Publication number
- CN111123984A CN111123984A CN201911068807.8A CN201911068807A CN111123984A CN 111123984 A CN111123984 A CN 111123984A CN 201911068807 A CN201911068807 A CN 201911068807A CN 111123984 A CN111123984 A CN 111123984A
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- obstacle
- target
- dimensional space
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Withdrawn
Links
- 238000000034 method Methods 0.000 title claims abstract description 60
- 230000004888 barrier function Effects 0.000 claims abstract description 11
- 238000013178 mathematical model Methods 0.000 claims abstract description 10
- 230000008569 process Effects 0.000 claims description 10
- 238000005070 sampling Methods 0.000 claims description 9
- 230000005484 gravity Effects 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000000694 effects Effects 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- MCJGNVYPOGVAJF-UHFFFAOYSA-N quinolin-8-ol Chemical compound C1=CN=C2C(O)=CC=CC2=C1 MCJGNVYPOGVAJF-UHFFFAOYSA-N 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 230000015572 biosynthetic process Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 229910003460 diamond Inorganic materials 0.000 description 1
- 239000010432 diamond Substances 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/12—Target-seeking control
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于位置与速度人工势场法的无人机路径规划方法,主要包括:步骤一是建立基于障碍物三维空间位置的斥力势函数和基于目标三维空间位置的引力势函数;步骤二是建立基于障碍物速度的动态斥力势函数和基于目标速度的动态引力势函数;步骤三是建立基于位置与速度人工势场函数的数学模型,求解出无人机动力学方程进行路径规划。与传统二维的基于位置的人工势场法相比不仅解决了二维空间的局限问题,而且引入速度信息提高无人机路径规划的可靠性。
Description
技术领域
本发明属于无人机路径规划和无人机控制领域,具体涉及一种基于位置与速度人工势场法的无人机路径规划方法。
背景技术
随着计算机技术与电子电路技术的发展,无人机从军事领域逐渐走入民用、商用领域,特别是应用于农业监测、民用航拍、灯光表演等场合。无人机作为一种新型的具备极高机动性的设备,在飞行的过程中需要对其运动轨迹进行路径规划,这是保障飞行器自身不被障碍物损坏与高效到达目标区域的重要措施。人工势场法因具有建模简单、路径规划速度快等优点被广泛用于进行无人机路径规划,目前在应用人工势场法对无人机进行路径规划时存在若干研究上的难题,主要包括两个方面,一是传统的人工势场法局限于二维空间也即平面上的运动,而无人机的运动遍历三维空间,如何将人工势场法扩展至三维空间并单独对其每个轴进行独立权重控制成为无人机路径规划的重要研究方向;二是传统的人工势场法局限于只采用位置信息构建势力函数而忽略速度信息,在障碍物与目标区域都在动态移动的场合难以保证路径规划的安全性与精确度。
发明内容
本发明的目的在于提供种一种基于位置与速度人工势场法的无人机路径规划方法,以解决上述背景技术中提出的问题。
为实现上述目的,本发明提供如下技术方案:种基于位置与速度人工势场法的无人机路径规划方法,包括:
步骤一,建立基于障碍物三维空间位置的斥力势函数和基于目标三维空间位置的引力势函数;
步骤二,建立基于障碍物速度的动态斥力势函数和基于目标速度的动态引力势函数;
步骤三,建立基于位置与速度人工势场函数的数学模型,求解出无人机动力学方程进行路径规划。
进一步地,所述步骤一的建立基于障碍物三维空间位置的斥力势函数和基于目标三维空间位置的引力势函数的过程,包括:位置侦测器接收无人机的三维空间位置,并测量各障碍物的三维空间位置,同时将所述无人机与所述各障碍物的三维空间位置传输至中央服务器,建立基于障碍物三维空间位置的斥力势函数和基于目标三维空间位置的引力势函数。
进一步地,所述位置侦测器接收所述无人机的三维空间位置记为 q=[x,y,z]T,其中x,y,z表示所述无人机在三维空间Oxyz的位置坐标,Ox的方向为水平面内正东方向,Oz的方向为垂直于地面指向正上方,Oy的方向为在水平面内垂直于Ox轴并满足右手法则;
所述位置侦测器测量所述各障碍物的三维空间位置记为qoj=[xoj,yoj,zoj]T,其中xoj,yoj,zoj表示第j个障碍物在三维空间Oxyz的位置坐标,j=1,...,N,其中N 表示空间内障碍物的总个数;所述中央服务器存储所述无人机目标区域的三维空间位置qg=[xg,yg,zg]T,其中xg,yg,zg表示目标区域的中心点在三维空间Oxyz的位置坐标;
所述无人机发送自身三维空间位置的时间间隔是50毫秒,所述位置侦测器的采样周期为50毫秒,所述中央服务器的采样周期为25毫秒;
基于第j个障碍物三维空间位置的斥力势函数的表达式为:
其中表示由所述第j个障碍物引起的斥力势函数,βp,xy为xy平面上的正增益斥力因子,βp,z为z轴上的正增益斥力因子,Kr1和Kr2表示斥力常数;表示所述无人机与所述第j个障碍物在xy投影平面内的单位向量,方向由所述无人机的xy投影中心指向障碍物的xy投影中心,表示所述无人机与所述第j个障碍物在z轴投影的单位向量,方向由所述无人机的z轴投影点指向障碍物的z轴投影点,表示所述无人机与所述第j个障碍物在 xy投影平面内的距离,其中qxy=[x,y]T,表示所述无人机与所述第j个障碍物在z轴投影上的距离,表示所述第j个障碍物在xy投影平面内的位置影响距离,表示所述第j个障碍物在z轴上的位置影响距离;
基于障碍物三维空间位置的斥力势函数的表达式为:
基于目标三维空间位置的引力势函数的表达式为:
其中αp,xy为xy平面上的正增益引力因子,αp,z为z轴上的正增益引力因子;Ep,xy表示所述无人机与目标在xy投影平面内的单位向量,方向由目标的xy投影中心指向所述无人机的xy投影中心,Ep,z表示所述无人机与目标在z轴投影的单位向量,方向由目标的z轴投影点指向所述无人机的z轴投影点,ρg,xy=||qxy-qg,xy||表示所述无人机与目标在xy投影平面内的距离,其中 qg,xy=[xg,yg]T,ρg,z=||z-zg||表示所述无人机与目标在z轴投影上的距离。
进一步地,所述步骤二的建立基于障碍物速度的动态斥力势函数和基于目标速度的动态引力势函数的过程,包括:速度侦测器接收所述无人机的速度,并测量各障碍物的速度,同时将所述无人机与所述各障碍物的速度传输至所述中央服务器,建立基于障碍物速度的动态斥力势函数和基于目标速度的动态引力势函数。
基于所述第j个障碍物速度的动态斥力势函数的表达式为:
其中表示由所述第j个障碍物引起的动态斥力势函数,βv为速度斥力因子,表示所述无人机与所述第j个障碍物在三维空间内的单位向量,方向由所述无人机的中心指向障碍物的中心,表示所述无人机与所述第j个障碍物的相对速度大小,表示所述无人机与所述第j个障碍物在三维空间的距离,表示所述第j个障碍物在三维空间内的速度影响距离;
所述基于障碍物速度的动态斥力势函数的表达式为:
所述基于目标速度的动态引力势函数的表达式为:
其中αv为速度引力因子,Evg表示所述无人机与目标在三维空间内的单位向量,方向由目标的中心指向所述无人机的中心,ρvg=||v-vg||表示所述无人机与目标的相对速度大小。
进一步地,所述步骤三的基于位置与速度人工势场函数的数学模型为:
Λ(q,qo,qg,v,vo,vg)=Λrep,p(q,qo)+Λat,p(q,qg)+Λrep,v(q,qo,v,vo)+Λat,v(q,qg,v,vg)
进一步地,求解所述无人机动力学方程进行路径规划包括:对所述无人机飞行环境进行建模、求解出所述无人机受到的虚拟合外力、求解所述无人机在受到虚拟合外力的作用下向目标飞行的正向动力学和判断所述无人机是否到达目标区域并判断所述目标区域是否停止移动。
进一步地,所述无人机受到的虚拟合外力为:
其中 和分别表示函数队q和v进行负梯度操作,Frep,p(Q,V)表示由障碍物三维空间位置产生的斥力,Fat,p(Q,V)表示由目标三维空间位置产生的引力,Frep,v(Q,V)表示由障碍物速度产生的斥力, Fat,v(Q,V)表示由目标速度产生的引力。
进一步地,所述无人机在受到虚拟合外力的作用下向目标飞行的正向动力学,具体如下:
进一步地,判断所述无人机到达所述目标区域且所述目标区域停止移动,所述无人机路径规划结束,所述无人机进行悬停操作;判断所述无人机未到达目标区域或目标区域正在移动,所述无人机重新对飞行环境进行建模,求解动力学方程进行路径规划。
与现有技术相比,本发明的有益效果是:本发明的基于位置与速度人工势场法的无人机路径规划方法,本发明中的位置与速度人工势场法算法的基本思想是将无人机在空间的运动看作是在障碍物的斥力与目标区域的引力所组成的虚拟合外力驱动下的空间运动,可以不断适应外界空间环境的变化来进行轨迹规划。该方法旨在突破传统的基于位置的二维人工势场函数法的局限性,引入速度信息与三维位置信息解决无人机轨迹规划以及障碍物躲避等问题,利用三维空间位置信息与速度信息对无人机进行高精度路径规划与轨迹控制,同时为无人机队形保持、编队控制提供借鉴作用。
附图说明
图1为本发明基于位置与速度人工势场法的无人机路径规划方法结构图
图2为本发明设有3个移动障碍物的无人机飞行环境简化图;
图3为本发明基于位置与速度人工势场函数的构建流程图;
图4为本发明求解无人机正向动力学的流程图;
图5为本发明方法实施无人机路径规划的仿真示意图。
具体实施方式
下面结合实施例对本发明所提出的一种基于位置与速度人工势场法的无人机路径规划方法做进一步的描述。
以下实施例用于说明本发明,但不能用来限制本发明的保护范围。实施例中的条件可以根据具体条件做进一步的调整,在本发明的构思前提下对本发明的方法简单改进都属于本发明要求保护的范围。
请参阅图1所示,其为本发明基于位置与速度人工势场法的无人机路径规划方法的结构图,本发明实施例主要是根据位置采集器收集各无人机与障碍物的位置信息并传输至中央服务器,并根据速度收集器收集各无人机与障碍物的速度信息并传输至中央服务器,然后中央服务器根据接收到的信息建立基于位置与速度的三维人工势场函数的数学模型,最后通过中央服务器计算无人机受到的合力并发送至对应的无人机进行路径规划模块。
请参阅图2所示,三维空间环境中主要包括移动障碍物1、移动障碍物2、移动障碍物3、移动目标区域4、位置侦测器5、速度侦测器6和无人机7,无人机7的位置与速度信号由其自身的传感器测量,障碍物1、障碍物2和障碍物3的位置与速度由位置侦测器5和速度侦测器6测量,在进行无人机路径规划时要求无人机7能躲避移动的多个障碍物同时高效到达目标区域。
请参阅图3所示,建立无人机7基于位置与速度人工势场函数的过程分三步进行。
步骤一,建立基于障碍物三维空间位置的斥力势函数和基于目标三维空间位置的引力势函数。
具体而言,位置侦测器5接收无人机7的三维空间位置,并测量障碍物1、障碍物2和障碍物3的三维空间位置,同时将无人机7与障碍物1、障碍物2 和障碍物3的三维空间位置传输至中央服务器,建立基于障碍物三维空间位置的斥力势函数和基于目标三维空间位置的引力势函数。
上述步骤一的具体操作过程是位置侦测器5接收无人机的三维空间位置记为q=[x,y,z]T,其中x,y,z表示无人机在三维空间Oxyz的位置坐标,Ox的方向为水平面内正东方向,Oz的方向为垂直于地面指向正上方,Oy的方向为在水平面内垂直于Ox轴并满足右手法则;位置侦测器5测量各障碍物的三维空间位置记为qoj=[xoj,yoj,zoj]T,其中xoj,yoj,zoj表示第j个障碍物在三维空间Oxyz的位置坐标,在本发明实施例中,j={1,2,3}。中央服务器存储无人机目标区域的三维空间位置qg=[xg,yg,zg]T,其中xg,yg,zg表示目标区域的中心点在三维空间Oxyz的位置坐标。无人机7发送自身三维空间位置的时间间隔是50毫秒,位置侦测器5的采样周期为50毫秒,中央服务器的采样周期为25毫秒。
基于第j个障碍物三维空间位置的斥力势函数的表达式为:
其中表示由第j个障碍物引起的斥力势函数,βp,xy为xy平面上的正增益斥力因子,βp,z为z轴上的正增益斥力因子,Kr1和Kr2表示斥力常数;表示无人机7与第j个障碍物在xy投影平面内的单位向量,方向由无人机7 的xy投影中心指向障碍物的xy投影中心,表示无人机7与第j个障碍物在 z轴投影的单位向量,方向由无人机7的z轴投影点指向障碍物的z轴投影点,表示无人机7与第j个障碍物在xy投影平面内的距离,其中 qxy=[x,y]T, 表示无人机7与第j个障碍物在z轴投影上的距离,表示第j个障碍物在xy投影平面内的位置影响距离,表示第j个障碍物在z轴上的位置影响距离。
基于障碍物三维空间位置的斥力势函数的表达式为:
基于目标三维空间位置的引力势函数的表达式为:
其中αp,xy为xy平面上的正增益引力因子,αp,z为z轴上的正增益引力因子,Ep,xy表示无人机7与目标在xy投影平面内的单位向量,方向由目标的xy投影中心指向无人机7的xy投影中心,Ep,z表示无人机7与目标在z轴投影的单位向量,方向由目标的z轴投影点指向无人机7的z轴投影点,ρg,xy=||qxy-qg,xy||表示无人机7与目标在xy投影平面内的距离,其中qg,xy=[xg,yg]T;ρg,z=||z-zg||表示无人机7与目标在z轴投影上的距离。
步骤二,建立基于障碍物速度的动态斥力势函数和基于目标速度的动态引力势函数。
具体而言,上述步骤二的操作过程是速度侦测器6接收无人机7的速度,并测量障碍物1、障碍物2和障碍物3的速度,同时将无人机7与障碍物1、障碍物2和障碍物3的速度传输至中央服务器,建立基于障碍物速度的动态斥力势函数和基于目标速度的动态引力势函数。
基于第j个障碍物速度的动态斥力势函数的表达式为:
其中表示由第j个障碍物引起的动态斥力势函数,βv为速度斥力因子,表示无人机7与第j个障碍物在三维空间内的单位向量,方向由无人机7的中心指向障碍物的中心,表示无人机7与第j个障碍物的相对速度大小,表示无人机7与第j个障碍物在三维空间的距离,表示第j个障碍物在三维空间内的速度影响距离。
基于障碍物速度的动态斥力势函数的表达式为:
基于目标速度的动态引力势函数的表达式为:
其中αv为速度引力因子,Evg表示无人机7与目标在三维空间内的单位向量,方向由目标的中心指向无人机7的中心,ρvg=||v-vg||表示无人机7与目标的相对速度大小。
步骤三,建立基于位置与速度人工势场函数的数学模型。
具体而言,基于位置与速度人工势场函数的数学模型为:
Λ(q,qo,qg,v,vo,vg)=Λrep,p(q,qo)+Λat,p(q,qg)+Λrep,v(q,qo,v,vo)+Λat,v(q,qg,v,vg)
请参阅图4所示,本实施例中,利用上述步骤三中基于位置与速度人工势场函数的数学模型,求解无人机动力学方程进行路径规划的具体步骤分五步进行,按操作顺序分别标记为步骤S31、步骤S32、步骤S33、步骤S34、步骤S35。
步骤S31是对无人机飞行环境进行建模,包括目标区域的定位和速度获取,以及障碍物个数的确定。
步骤S32是根据基于位置与速度人工势场函数的数学模型,求解出无人机受到的虚拟合外力:
其中 和分别表示函数队q和v进行负梯度操作,Frep,p(Q,V)表示由障碍物三维空间位置产生的斥力,Fat,p(Q,V)表示由目标三维空间位置产生的引力,Frep,v(Q,V)表示由障碍物速度产生的斥力, Fat,v(Q,V)表示由目标速度产生的引力。
步骤S33是求解无人机在受到虚拟合外力的作用下向目标飞行的正向动力学,具体如下:
步骤S34是判断无人机是否到达目标区域与目标区域是否停止移动,若已到达且目标区域停止移动则跳转至步骤S35;若未到达目标区域或目标区域正在移动,则跳转至步骤S31。
步骤S35是无人机路径规划结束,无人机进行悬停操作。
请参阅图5所示,在此仿真实验中,参数设定如下:kf=20,kq=10,βp,xy=10,βp,z=5,Kr1=2,Kr2=2,αp,xy=15,αp,z=8,βv=5,αv=5。对障碍物、无人机和目标区域做出以下具体抽象与简化:障碍物中心采用“五角星”表示,目标区域采用“菱形”表示,无人机中心采用“三角形”表示。
障碍物与目标区域的运动轨迹分别为:
从图5中的运动轨迹可知,采用本发明提出的方法可以有效躲闪移动的障碍物,无人机在运动的过程中能有效根据障碍物的移动速度修正自身运动轨迹并远离障碍物,同时无人机能高效到达目标区域,对于移动的目标区域也可实现跟踪控制。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。
Claims (10)
1.一种基于位置与速度人工势场法的无人机路径规划方法,其特征在于,包括:
步骤一,建立基于障碍物三维空间位置的斥力势函数和基于目标三维空间位置的引力势函数;
步骤二,建立基于障碍物速度的动态斥力势函数和基于目标速度的动态引力势函数;
步骤三,建立基于位置与速度人工势场函数的数学模型,求解出无人机动力学方程进行路径规划。
2.根据权利要求1所述的基于位置与速度人工势场法的无人机路径规划方法,其特征在于,所述步骤一的建立基于障碍物三维空间位置的斥力势函数和基于目标三维空间位置的引力势函数的过程,包括:位置侦测器接收无人机的三维空间位置,并测量各障碍物的三维空间位置,同时将所述无人机与所述各障碍物的三维空间位置传输至中央服务器,建立基于障碍物三维空间位置的斥力势函数和基于目标三维空间位置的引力势函数。
3.根据权利要求2所述的基于位置与速度人工势场法的无人机路径规划方法,其特征在于,所述位置侦测器接收所述无人机的三维空间位置记为q=[x,y,z]T,其中x,y,z表示所述无人机在三维空间Oxyz的位置坐标,Ox的方向为水平面内正东方向,Oz的方向为垂直于地面指向正上方,Oy的方向为在水平面内垂直于Ox轴并满足右手法则;
所述位置侦测器测量所述各障碍物的三维空间位置记为qoj=[xoj,yoj,zoj]T,其中xoj,yoj,zoj表示第j个障碍物在三维空间Oxyz的位置坐标,j=1,...,N,其中N表示空间内障碍物的总个数;所述中央服务器存储所述无人机目标区域的三维空间位置qg=[xg,yg,zg]T,其中xg,yg,zg表示目标区域的中心点在三维空间Oxyz的位置坐标;
所述无人机发送自身三维空间位置的时间间隔是50毫秒,所述位置侦测器的采样周期为50毫秒,所述中央服务器的采样周期为25毫秒;
基于第j个障碍物三维空间位置的斥力势函数的表达式为:
其中表示由所述第j个障碍物引起的斥力势函数,βp,xy为xy平面上的正增益斥力因子,βp,z为z轴上的正增益斥力因子,Kr1和Kr2表示斥力常数;表示所述无人机与所述第j个障碍物在xy投影平面内的单位向量,方向由所述无人机的xy投影中心指向障碍物的xy投影中心,表示所述无人机与所述第j个障碍物在z轴投影的单位向量,方向由所述无人机的z轴投影点指向障碍物的z轴投影点,表示所述无人机与所述第j个障碍物在xy投影平面内的距离,其中qxy=[x,y]T,表示所述无人机与所述第j个障碍物在z轴投影上的距离,表示所述第j个障碍物在xy投影平面内的位置影响距离,表示所述第j个障碍物在z轴上的位置影响距离;
基于障碍物三维空间位置的斥力势函数的表达式为:
基于目标三维空间位置的引力势函数的表达式为:
其中αp,xy为xy平面上的正增益引力因子,αp,z为z轴上的正增益引力因子;Ep,xy表示所述无人机与目标在xy投影平面内的单位向量,方向由目标的xy投影中心指向所述无人机的xy投影中心,Ep,z表示所述无人机与目标在z轴投影的单位向量,方向由目标的z轴投影点指向所述无人机的z轴投影点,ρg,xy=||qxy-qg,xy||表示所述无人机与目标在xy投影平面内的距离,其中qg,xy=[xg,yg]T,ρg,z=||z-zg||表示所述无人机与目标在z轴投影上的距离。
4.根据权利要求1所述的基于位置与速度人工势场法的无人机路径规划方法,其特征在于,所述步骤二的建立基于障碍物速度的动态斥力势函数和基于目标速度的动态引力势函数的过程,包括:速度侦测器接收所述无人机的速度,并测量各障碍物的速度,同时将所述无人机与所述各障碍物的速度传输至所述中央服务器,建立基于障碍物速度的动态斥力势函数和基于目标速度的动态引力势函数。
5.根据权利要求4所述的基于位置与速度人工势场法的无人机路径规划方法,其特征在于,所述速度侦测器接收所述无人机的速度记为测量所述各障碍物的速度记为所述中央服务器存储无人机目标的速度记为所述无人机发送自身速度的时间间隔是50毫秒,所述速度侦测器的采样周期为50毫秒;
基于所述第j个障碍物速度的动态斥力势函数的表达式为:
其中表示由所述第j个障碍物引起的动态斥力势函数,βv为速度斥力因子,表示所述无人机与所述第j个障碍物在三维空间内的单位向量,方向由所述无人机的中心指向障碍物的中心,表示所述无人机与所述第j个障碍物的相对速度大小,表示所述无人机与所述第j 个障碍物在三维空间的距离,表示所述第j个障碍物在三维空间内的速度影响距离;
所述基于障碍物速度的动态斥力势函数的表达式为:
所述基于目标速度的动态引力势函数的表达式为:
其中αv为速度引力因子,Evg表示所述无人机与目标在三维空间内的单位向量,方向由目标的中心指向所述无人机的中心,ρvg=||v-vg||表示所述无人机与目标的相对速度大小。
6.根据权利要求1所述的基于位置与速度人工势场法的无人机路径规划方法,其特征在于,所述步骤三的基于位置与速度人工势场函数的数学模型为:
Λ(q,qo,qg,v,vo,vg)=Λrep,p(q,qo)+Λat,p(q,qg)+Λrep,v(q,qo,v,vo)+Λat,v(q,qg,v,vg)
7.根据权利要求1所述的基于位置与速度人工势场法的无人机路径规划方法,其特征在于,求解所述无人机动力学方程进行路径规划包括:对所述无人机飞行环境进行建模、求解出所述无人机受到的虚拟合外力、求解所述无人机在受到虚拟合外力的作用下向目标飞行的正向动力学和判断所述无人机是否到达目标区域并判断所述目标区域是否停止移动。
10.根据权利要求7所述的基于位置与速度人工势场法的无人机路径规划方法,其特征在于,判断所述无人机到达所述目标区域且所述目标区域停止移动,所述无人机路径规划结束,所述无人机进行悬停操作;判断所述无人机未到达目标区域或目标区域正在移动,所述无人机重新对飞行环境进行建模,求解动力学方程进行路径规划。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911068807.8A CN111123984A (zh) | 2019-11-05 | 2019-11-05 | 一种基于位置与速度人工势场法的无人机路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911068807.8A CN111123984A (zh) | 2019-11-05 | 2019-11-05 | 一种基于位置与速度人工势场法的无人机路径规划方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111123984A true CN111123984A (zh) | 2020-05-08 |
Family
ID=70495503
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911068807.8A Withdrawn CN111123984A (zh) | 2019-11-05 | 2019-11-05 | 一种基于位置与速度人工势场法的无人机路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111123984A (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112068598A (zh) * | 2020-09-28 | 2020-12-11 | 西北工业大学 | 一种无人机编队飞行方法及控制*** |
CN112631293A (zh) * | 2020-12-16 | 2021-04-09 | 江苏大学 | 一种基于人工势场法的无人船防碰撞物联网控制***及方法 |
CN112965496A (zh) * | 2021-02-23 | 2021-06-15 | 武汉理工大学 | 基于人工势场算法的路径规划方法、装置及存储介质 |
CN113325852A (zh) * | 2021-06-10 | 2021-08-31 | 浙江大学 | 基于领导跟随者方式的多智能体行进中编队变换的控制方法 |
CN113655810A (zh) * | 2021-08-20 | 2021-11-16 | 上海微电机研究所(中国电子科技集团公司第二十一研究所) | 一种基于速度势场的无人机避障方法和*** |
CN113848914A (zh) * | 2021-09-28 | 2021-12-28 | 福州大学 | 动态环境下碰撞系数人工势场法局部路径规划方法 |
CN115061492A (zh) * | 2022-06-20 | 2022-09-16 | 华南理工大学 | 一种校园外卖配送***及递进式三维空间路径规划方法 |
CN117093010A (zh) * | 2023-10-20 | 2023-11-21 | 清华大学 | 水下多智能体路径规划方法、装置、计算机设备和介质 |
-
2019
- 2019-11-05 CN CN201911068807.8A patent/CN111123984A/zh not_active Withdrawn
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112068598A (zh) * | 2020-09-28 | 2020-12-11 | 西北工业大学 | 一种无人机编队飞行方法及控制*** |
CN112068598B (zh) * | 2020-09-28 | 2021-11-16 | 西北工业大学 | 一种无人机编队飞行方法及控制*** |
CN112631293A (zh) * | 2020-12-16 | 2021-04-09 | 江苏大学 | 一种基于人工势场法的无人船防碰撞物联网控制***及方法 |
CN112965496A (zh) * | 2021-02-23 | 2021-06-15 | 武汉理工大学 | 基于人工势场算法的路径规划方法、装置及存储介质 |
CN113325852A (zh) * | 2021-06-10 | 2021-08-31 | 浙江大学 | 基于领导跟随者方式的多智能体行进中编队变换的控制方法 |
CN113655810A (zh) * | 2021-08-20 | 2021-11-16 | 上海微电机研究所(中国电子科技集团公司第二十一研究所) | 一种基于速度势场的无人机避障方法和*** |
CN113655810B (zh) * | 2021-08-20 | 2024-04-16 | 上海微电机研究所(中国电子科技集团公司第二十一研究所) | 一种基于速度势场的无人机避障方法和*** |
CN113848914A (zh) * | 2021-09-28 | 2021-12-28 | 福州大学 | 动态环境下碰撞系数人工势场法局部路径规划方法 |
CN113848914B (zh) * | 2021-09-28 | 2024-04-26 | 福州大学 | 动态环境下碰撞系数人工势场法局部路径规划方法 |
CN115061492A (zh) * | 2022-06-20 | 2022-09-16 | 华南理工大学 | 一种校园外卖配送***及递进式三维空间路径规划方法 |
CN117093010A (zh) * | 2023-10-20 | 2023-11-21 | 清华大学 | 水下多智能体路径规划方法、装置、计算机设备和介质 |
CN117093010B (zh) * | 2023-10-20 | 2024-01-19 | 清华大学 | 水下多智能体路径规划方法、装置、计算机设备和介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111123984A (zh) | 一种基于位置与速度人工势场法的无人机路径规划方法 | |
Boroujerdian et al. | Mavbench: Micro aerial vehicle benchmarking | |
Xiao et al. | XTDrone: A customizable multi-rotor UAVs simulation platform | |
CN104309803B (zh) | 旋翼飞行器自动降落***及方法 | |
CN112684807A (zh) | 无人机集群三维编队方法 | |
CN110825113A (zh) | 一种适用于四旋翼无人机集群飞行的队形保持方法 | |
CN105759829A (zh) | 基于激光雷达的微型无人机操控方法及*** | |
CN110764531B (zh) | 基于激光雷达与人工势场法的无人机编队飞行避障方法 | |
CN103853156A (zh) | 一种基于机载传感器的小型四旋翼飞行器控制***及方法 | |
CN108710383A (zh) | 一种基于航点规划与跟踪的四旋翼飞行器自主降落控制方法 | |
CN111061266A (zh) | 一种实时场景分析和空间避障的夜间值守机器人 | |
Steiner et al. | A vision-aided inertial navigation system for agile high-speed flight in unmapped environments: Distribution statement a: Approved for public release, distribution unlimited | |
CN110231828A (zh) | 基于nftsm的四旋翼无人机视觉伺服控制方法 | |
CN106155082B (zh) | 一种基于光流的无人机仿生智能避障方法 | |
CN109426147A (zh) | 捕获卫星后组合航天器的自适应增益调整控制方法 | |
CN114200471A (zh) | 基于无人机的森林火源检测***、方法、存储介质、设备 | |
CN114488848A (zh) | 面向室内建筑空间的无人机自主飞行***及仿真实验平台 | |
CN110456663B (zh) | 基于多源信息融合的飞行器导航控制技术仿真装置及方法 | |
Lawrance et al. | Long endurance autonomous flight for unmanned aerial vehicles | |
Wang et al. | Quadrotor autonomous landing on moving platform | |
Proctor et al. | Vision‐only control and guidance for aircraft | |
Garratt et al. | Design of a 3D snapshot based visual flight control system using a single camera in hover | |
Chu et al. | Autonomous Landing System of a VTOL UAV on an Upward Docking Station Using Visual Servoing | |
Zhang et al. | Multi-sensory motion estimation and control of an autonomous quadrotor | |
Shastry et al. | Autonomous detection and tracking of a high-speed ground vehicle using a quadrotor UAV |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WW01 | Invention patent application withdrawn after publication | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20200508 |