CN107085438A - 基于准均匀样条曲线的无人机路径修正方法及*** - Google Patents
基于准均匀样条曲线的无人机路径修正方法及*** Download PDFInfo
- Publication number
- CN107085438A CN107085438A CN201710299939.6A CN201710299939A CN107085438A CN 107085438 A CN107085438 A CN 107085438A CN 201710299939 A CN201710299939 A CN 201710299939A CN 107085438 A CN107085438 A CN 107085438A
- Authority
- CN
- China
- Prior art keywords
- control point
- curve
- unmanned plane
- path
- control
- 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.)
- Granted
Links
- 238000002715 modification method Methods 0.000 title claims abstract description 23
- 230000004888 barrier function Effects 0.000 claims abstract description 31
- 238000000034 method Methods 0.000 claims abstract description 18
- 238000010586 diagram Methods 0.000 claims description 13
- 238000000605 extraction Methods 0.000 claims description 2
- 101710097688 Probable sphingosine-1-phosphate lyase Proteins 0.000 description 22
- 101710105985 Sphingosine-1-phosphate lyase Proteins 0.000 description 22
- 101710122496 Sphingosine-1-phosphate lyase 1 Proteins 0.000 description 22
- 230000008859 change Effects 0.000 description 8
- 239000012634 fragment Substances 0.000 description 3
- 238000012937 correction Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000011218 segmentation Effects 0.000 description 2
- 230000008901 benefit Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 238000000263 scanning probe lithography Methods 0.000 description 1
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/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06Q—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES; SYSTEMS OR METHODS SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES, NOT OTHERWISE PROVIDED FOR
- G06Q10/00—Administration; Management
- G06Q10/04—Forecasting or optimisation specially adapted for administrative or management purposes, e.g. linear programming or "cutting stock problem"
- G06Q10/047—Optimisation of routes or paths, e.g. travelling salesman problem
Landscapes
- Engineering & Computer Science (AREA)
- Business, Economics & Management (AREA)
- Human Resources & Organizations (AREA)
- General Physics & Mathematics (AREA)
- Economics (AREA)
- Physics & Mathematics (AREA)
- Strategic Management (AREA)
- Quality & Reliability (AREA)
- Development Economics (AREA)
- Operations Research (AREA)
- Entrepreneurship & Innovation (AREA)
- Tourism & Hospitality (AREA)
- Game Theory and Decision Science (AREA)
- General Business, Economics & Management (AREA)
- Marketing (AREA)
- Theoretical Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开一种基于准均匀样条曲线的无人机路径修正方法及***,其通过建立动态障碍物模型,规划一条连接起点和终点的直线段路径;并以直线段之间的交点为管制点,直线段路径为控制多边形,绘制准均匀三次B样条曲线;找出与障碍物相交的曲线段以及相交曲线段所对应直线段,在对应直线段上添加控制点,调整曲线使其通过该控制点;更新管制点组和曲线,并根据无人机的曲率约束和安全约束微调管制点,最终得到无人机飞行路径。本发明采用增加控制点的办法来修正B样条曲线,使曲线逐渐靠近由控制点构成的多边形,从而使无人机飞行路径能够精确避开障碍物,同时既满足飞行路径全段C2曲率连续性,又使不需要修正的曲线段尽可能多地保持原样。
Description
技术领域
本发明涉及通用航空管制领域技术,特别涉及一种基于准均匀样条曲线的 无人机路径修正方法及***。
背景技术
随着各种无人机的普及和小型化,有关无人机管制技术的研究也变得越来 越多,研究方向也越来越细致。无人机楼宇穿行除了障碍物不规则、陡变的特 征外,还有一个显著的特征就是密集排列。当需要规划的路径非常长的时候, 路径也有很大的概率会变得很复杂,如果路径是由控制点所控制的曲线,那远 远不是3、5个控制点所能解决的;而密集的楼宇还有一个问题,就是如果某一 区域的路径规划没问题的话,我们并不希望它改变,因为改变会引发不确定性。 也就是说,当一个区域的路径与障碍冲突需要修正的时候,其它区域的路径能 保持不变。而Bezier曲线、PH曲线都是全局曲线,改变一处,整条曲线都会跟着改变,这种特性对于复杂的长路径规划和密集排列的楼宇障碍非常不利。
对于无人机的路径规划问题,除了考虑避障,还要考虑的是无人机的跟随 问题。如果规划的路径,无人机无法按照路径飞行,那这样的路径规划出来其 效果也会打折扣。通常,无人机的跟随性和无人机本身的物理特性有关,不同 的无人机跟随性也会不同。但它们基本上的飞行路径都是曲率连续(C2连续) 的,所以,对无人机规划出的路径也必须是曲率连续的。
因此,亟待研发一种既能够满足飞行路径全段C2曲率连续性,整条B样条 曲线中出现直线段并不会影响到无人机的跟随性,且不需要修正的曲线段尽可 能多地保持原样的无人机路径修正方法及***。
发明内容
有鉴于此,有必要提供一种既能够满足飞行路径全段C2曲率连续性,整条 B样条曲线中出现直线段并不会影响到无人机的跟随性,且不需要修正的曲线段 尽可能多地保持原样的无人机路径修正方法及***。
一种基于准均匀样条曲线的无人机路径修正方法,所述基于准均匀样条曲 线的无人机路径修正方法包括如下步骤:
S1、建立动态障碍物模型,规划一条连接起点和终点的直线段路径;
S2、以直线段之间的交点为管制点,直线段路径为控制多边形,绘制准均 匀三次B样条曲线;
S3、找出与障碍物相交的曲线段以及相交曲线段所对应直线段,在对应直 线段上添加控制点,调整曲线使其通过该控制点;
S4、更新管制点组和曲线,并根据无人机的曲率约束和安全约束微调管制 点。
一种基于准均匀样条曲线的无人机路径修正***,所述基于准均匀样条曲 线的无人机路径修正***包括如下功能模块:
初级线路规划模块,用于建立动态障碍物模型,规划一条连接起点和终点 的直线段路径;
B样条曲线绘制模块,用于以直线段之间的交点为管制点,直线段路径为控 制多边形,绘制准均匀三次B样条曲线;
曲线调整模块,用于找出与障碍物相交的曲线段以及相交曲线段的四个管 制点,根据顺序连接四个管制点的形状,对曲线进行相应调整;
线路更新模块,用于更新管制点组和曲线,并根据无人机的曲率约束和安 全约束微调管制点。
本发明提供一种基于准均匀样条曲线的无人机路径修正方法及***,其基 于控制点越多,曲线的局部特性越突出的原理,并结合B样条曲线的特性,本 发明采用增加控制点的办法来修正B样条曲线,使曲线逐渐靠近由控制点构成 的多边形,从而得到一条能够精确避开障碍物的,既满足了飞行路径全段C2曲 率连续性,又使不需要修正的曲线段尽可能多地保持原样的无人机飞行路径。
附图说明
图1是本发明所述的基于准均匀样条曲线的无人机路径修正方法的步骤流 程图;
图2是本发明所述的基于准均匀样条曲线的无人机路径修正方法流程图;
图3是图1中步骤S1的子流程图;
图4是图1中步骤S3的子流程图;
图5为模型中用Vorinoi图法和A*搜索算法产生直线段路径的示意图;
图6为模型中初始的B样条曲线的示意图;
图7为在线段中间***单个控制点的路径调整示意图;
图8为在线段中间***两个控制点的路径调整示意图;
图9为移动中间控制点的路径调整示意图;
图10为计算***控制点的曲率和安全距离的示意图;
图11为两条相信曲线段与同一个障碍相交的示意图;
图12为在相领两条控制线段上添加两个控制点的示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实 施例,对本发明进行进一步详细说明,应当理解,此处所描述的具体实施例仅 仅用以解释本发明,并不用于限定本发明。
如图1所示,本发明实施例提供一种基于准均匀样条曲线的无人机路径修 正方法,如图2所示,所述基于准均匀样条曲线的无人机路径修正方法包括如 下步骤:
S1、建立动态障碍物模型,规划一条连接起点和终点的直线段路径。
具体如图3所示,所述步骤S1包括以下分步骤:
S11、绘制初始路径周围的障碍,每一个障碍用矩形表示;
S12、用Voronoi图法产生连接图,如图5所示;
S13、结合无人机具体执行任务的需求,通过A*搜索算法得到一条连接起 点和终点的直线段路径,如图5(b)所示;
S2、以直线段之间的交点为管制点,直线段路径为控制多边形,绘制准均 匀三次B样条曲线,如图6所示。
具体的,在得到准均匀三次B样条曲线后,需要对管制点进行微调,使其 满足无人机的曲率约束和安全约束。
所述三次B样条曲线是由任意数量的曲线段组成的完全的分段三次多项式。 系数变化引起某一区间上的三次片段变化,并从一个区间到另一个区间逐个进 行。B样条曲线不通过其控制点。
对于任意一个B样条片段,其公式为:
其中Qi为第i个B样条片段,Pi是按控制点顺序排列的一个四个点的集合。
在这样的表示形式下,一条B样条曲线是m-2个曲线段的系列。为方便起 见,将其标记为Q3、Q4、Q5、……、Qm,这些曲线段由m+1个控制点P0、 P1、……、Pm来定义的,其同m≥3。每一个曲线段都是由四个控制点来定义 的,而每一个控制点会影响连续的四条且只有这四条曲线段。这就是B样条曲 线的局部控制特性。
准均匀B样条曲线是非均匀B样条曲线的一种特殊形式,它通过在两端插 入结点,而在其它地方采用均匀的结点。这样就使起点和终点的连续结点值区 间减小到零,从而使B样条曲线与两个端点相交。经常会使用的结点序列为 [0,0,0,0,1,2,…,n-2,n-1,n,n,n,n]。
B样条曲线表现出位置连续性(切线连续性(C1)和曲率连续性(C2))、 局部性、凸包性、保凸性、对称性、递推性、几何及仿射不变性等性能。其中, 连续性是最重要的特征,且曲线上的控制点可以任意移动而不影响连续性;而 局部性也是很重要的特征,以三次曲线为例,每一个曲线段都是由四个控制点 来定义的,而每一个控制点会影响连续的四条且只有这四条曲线段。
由于所述准均匀三次B样条曲线仅与起点和终点相交,与其它控制点不相 交,所以尽管所有的控制点和控制多边形都能避开障碍物,但B样条曲线本身 却未必能避开。因此,规划出来的初始路径难免会有与障碍物相交的情况出现, 因此,需要进行步骤S3,进行相应的修正措施。
S3、找出与障碍物相交的曲线段以及相交曲线段所对应直线段,在对应直 线段上添加控制点,调整曲线使其通过该控制点。
具体的,分段的样条曲线具有如下特性:首先,它是曲线连续的;第二, 理论上样条曲线的控制点可以无限增加而不影响它的计算复杂度,因此样条曲 线的形式可以很复杂,适合长距离的路径规划;第三,样条曲线是由若干条曲 线段构成的,因此它是局部性的,改变一个控制点,只会改变与该控制点有关 的相邻几条曲线段,而其它的曲线段可以保持不变,这种性质很适合密集楼宇 的路径规划。
B样条曲线具有如下特性:当三个控制点在同一条直线上时,那么B样条 曲线就经过中点的那个控制点;而当四个控制点在同一条直线上时,那么B样 条曲线在中间两个控制点之前是一条直线段,对于无人机来说,其采纳路径优 先度为直线>C2曲线>C1曲线>C0曲线,只要满足全段C2曲率连续性,整条B 样条曲线中出现直线段并不会影响到无人机的跟随性。
结合分段的样条曲线以及B样条曲线的特性,所述步骤S3的具体修正措施 如下。
如图4所示,所述步骤S3包括以下分步骤:
S31、找出与障碍物相交的曲线段,以及相交曲线段所对应直线段的四个管 制点,
S32、根据顺序连接四个管制点的形状,确定在对应直线段上添加控制点以 及添加控制点的数量;
S33、根据控制点对曲线进行调整,使曲线通过添加的控制点。
其中,步骤S32包括下列情况;
情况一:如果四个管制点的连接形状为四边形,则在对应直线段上添加一 个控制点,使曲线通过该控制点;如果四个管制点的连接形状为四边形,且在 对应直线段上添加一个控制点之后仍无法避开障碍,则取消该控制点,并在对 应直线段上添加两个控制点,将修正的曲线的中间段变成直线段,使曲线通过 该直线段。
如图7(a)所示,假设四个管制点分别为P0、P1、P2、P3,如果P0、P1、 P2、P3之间的连线构成四边形,根据B样条曲线凸包特性,在P1和P2之间的 线段上添加一个控制点P12,曲线段将变成如图7(b)所示,则曲线避开障碍 物,满足无人机路径规划要求。
如果进行上述调整后还不能避开障碍物,如图8(a)所示,则表示两个障 碍物之间通道很窄,对于这种情况,以直线通过这个通道则更安全。因此,取 消P12,在P1和P2之间添加两个控制点P12和P21,将修正的曲线的中间段变成 直线,如图8(b)所示,避开障碍物,满足无人机路径规划要求。
情况二:如果四个管制点的连接形状为闪电形,则将位于四个管制点中间 的两个管制点中的其中一个管制点向相邻两个管制点的方向进行调整,使闪电 形调整为四边形,之后再根据四边形的规则进行调整。
如图9(a)所示,如果P0、P1、P2、P3之间的连线构成闪电形,即线段 P0P3和P1P2相交,则首先要将闪电形调整为四边形,即将P1向线段P0P2之间移 动,或P2向P1P3之间移动,本实施例中是将P2向P1P3之间移动;之后在P1和 P2之间的线段上添加一个控制点P12,在P2和P3之间的线段上添加一个控制 点P23,使曲线段将变成如图9(b)所示,则曲线避开障碍物,满足无人机路 径规划要求。
上述路径规划中,如图10所示,最佳控制点的求取步骤如下:
1)在对应直线段上选择多个点,分别以每一个点为添加控制点来修正路径;
2)判断每一条修正路径是否还与障碍物相交,剔除相交的路径,保留不相 交路径所对应的控制点;
3)根据控制点的曲率和安全距离的权值,计算出每一个控制点修正后曲线 的最大曲率和最短安全距离,代入到下列公式中:
式中,k为修正曲线在P12处的曲率;l为P12到障碍物最短安全距离;k越 小越能保障无人机的通行能力,而l越大越能保障无人机的飞行安全,w1和w2分别为k和的权值,不同的使用者可以设定不同的权值,当无人机对最大曲率 的要求严格时,可提高w1的比重;当无人机大小比较大时,则可提高w2的比重。
选择的最小值,其对应的控制点即是最佳添加控制点。
步骤S32还包括情况三;
情况三:如果四个管制点的连接形状为四边形,且同一个障碍物与连续两 个曲线段相交,则取两条对应直线段的四个管制点的合集得到五个管制点,在 两条对应直线段上分别添加一个控制点,使曲线同时通过这两个控制点。
在某种极端情况下,可能会出现同一个障碍物与连续两个曲线段相交的情 况,如图11所示,那么令这两个曲线段的管制点分别为P0、P1、P2、P3和P1、 P2、P3、P4,可以认为两个曲线段的管制点为P0、P1、P2、P3、P4五个点。 这种极端情况很大的可能性是该障碍物与它周围的障碍物之间的距离较近,因 此控制多边形离该障碍物较近所致(按Voronoi法,控制多边形不会与障碍相 交),如图9所示。
出现这样的情况时,用移动管制点的方法会十分受限,因此还是采用添加 控制点的方法,在线段P1P2和P2P3上分别添加两个控制点P12和P23,则修 正后的路径如图12所示。
情况三中,所述两条对应直线段上添加的两个控制点组成一个控制点组, 其中最佳的控制点组的求取步骤如下:
1)在两条对应直线段上分别选择m和n个点构成m*n个点组,分别以每 一个点组为添加控制点组来修正路径;
2)判断每一条修正路径是否还与障碍物相交,剔除相交的路径,保留不相 交路径所对应的控制点组;
3)根据控制点的曲率和安全距离的权值,计算出每一控制点组修正后曲线 的最大曲率和最短安全距离,代入到下列公式中:
选择的最小值,其对应的控制点即是最佳添加控制点组。
S4、更新管制点组和曲线,并根据无人机的曲率约束和安全约束微调管制 点。
根据上述基于准均匀样条曲线的无人机路径修正方法,本发明还提供一种 基于准均匀样条曲线的无人机路径修正***,所述基于准均匀样条曲线的无人 机路径修正***包括如下功能模块:
初级线路规划模块,用于建立动态障碍物模型,规划一条连接起点和终点 的直线段路径;
B样条曲线绘制模块,用于以直线段之间的交点为管制点,直线段路径为控 制多边形,绘制准均匀三次B样条曲线;
曲线调整模块,用于找出与障碍物相交的曲线段以及相交曲线段的四个管 制点,根据顺序连接四个管制点的形状,对曲线进行相应调整;
线路更新模块,用于更新管制点组和曲线,并根据无人机的曲率约束和安 全约束微调管制点。
其中,所述初级线路规划模块包括如下功能单元:
模型建立单元,用于绘制初始路径周围的障碍,每一个障碍用矩形表示;
图形生成单元,用于用Voronoi图法产生连接图;
路径计算单元,用于结合无人机具体执行任务的需求,通过A*搜索算法得 到一条连接起点和终点的直线段路径。
其中,所述曲线调整模块包括如下功能单元:
管制点提取单元、用于找出与障碍物相交的曲线段,以及相交曲线段所对 应直线段的四个管制点,
控制点确定单元、用于根据顺序连接四个管制点的形状,确定在对应直线 段上添加控制点以及添加控制点的数量;
路径调整单元、用于根据控制点对曲线进行调整,使曲线通过添加的控制 点。
本发明提供了一种基于准均匀样条曲线的无人机路径修正方法及***,其 基于控制点越多,曲线的局部特性越突出的原理,并结合B样条曲线的特性, 本发明采用增加控制点的办法来修正B样条曲线,使曲线逐渐靠近由控制点构 成的多边形,从而得到一条能够精确避开障碍物的,既满足了飞行路径全段C2 曲率连续性,又使不需要修正的曲线段尽可能多地保持原样的无人机飞行路径。
本发明应用在低空无人机飞跃山地和城市楼宇的情况下,能够具有较高的 避障效率,能够提升能充分提高无人机飞行的效能,能够规划出复杂的路径而 不显著增加运算量。因此,可广泛应用于无人机路径规划的实际任务应用。
以上装置实施例与方法实施例是一一对应的,装置实施例简略之处,参见 方法实施例即可。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是 与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。
专业人员还可以进一步意识到,结合本文中所公开的实施例描述的各示例 的单元及算法步骤,能够以电子硬件、计算机软件或者二者的结合来实现,为 了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能性一般性地 描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行,取决 于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用 来使用不同方法来实现所描述的功能,但是这种实现不应超过本发明的范围。
结合本文中所公开的实施例描述的方法或算法的步骤可以直接用硬件、处 理器执行的软件模块,或者二者的结合来实施。软件模块可以置于随机储存器、 内存、只读存储器、电可编程ROM、电可擦除可编程ROM、寄存器、硬盘、 可移动磁盘、CD-ROM、或技术领域内所公知的任意其他形式的存储介质中。
上面结合附图对本发明的实施例进行了描述,但是本发明并不局限于上述 的具体实施方式,上述的具体实施方式仅仅是示意性的,而不是限制性的,本 领域的普通技术人员在本发明的启示下,在不脱离本发明宗旨和权利要求所保 护的范围情况下,还可做出很多形式,这些均属于本发明的保护之内。
Claims (10)
1.一种基于准均匀样条曲线的无人机路径修正方法,其特征在于,所述基于准均匀样条曲线的无人机路径修正方法包括如下步骤:
S1、建立动态障碍物模型,规划一条连接起点和终点的直线段路径;
S2、以直线段之间的交点为管制点,直线段路径为控制多边形,绘制准均匀三次B样条曲线;
S3、找出与障碍物相交的曲线段以及相交曲线段所对应直线段,在对应直线段上添加控制点,调整曲线使其通过该控制点;
S4、更新管制点组和曲线,并根据无人机的曲率约束和安全约束微调管制点。
2.根据权利要求1所述基于准均匀样条曲线的无人机路径修正方法,其特征在于,所述步骤S1包括以下分步骤:
S11、绘制初始路径周围的障碍,每一个障碍用矩形表示;
S12、用Voronoi图法产生连接图;
S13、结合无人机具体执行任务的需求,通过A*搜索算法得到一条连接起点和终点的直线段路径。
3.根据权利要求1所述基于准均匀样条曲线的无人机路径修正方法,其特征在于,所述基于准均匀样条曲线的无人机路径修正方法包括步骤S2a:
S2a、根据无人机的曲率约束和安全约束微调管制点。
4.根据权利要求1所述基于准均匀样条曲线的无人机路径修正方法,其特征在于,所述步骤S3包括以下分步骤:
S31、找出与障碍物相交的曲线段,以及相交曲线段所对应直线段的四个管制点;
S32、根据顺序连接四个管制点的形状,确定在对应直线段上添加控制点以及添加控制点的数量;
S33、根据控制点对曲线进行调整,使曲线通过添加的控制点。
5.根据权利要求4所述基于准均匀样条曲线的无人机路径修正方法,其特征在于,步骤S32包括下列情况;
情况一:如果四个管制点的连接形状为四边形,则在对应直线段上添加一个控制点,使曲线通过该控制点;
情况二:如果四个管制点的连接形状为闪电形,则将位于四个管制点中间的两个管制点中的其中一个管制点向相邻两个管制点的方向进行调整,使闪电形调整为四边形,之后再根据四边形的规则进行调整。
6.根据权利要求5所述基于准均匀样条曲线的无人机路径修正方法,其特征在于,如果四个管制点的连接形状为四边形,且在对应直线段上添加一个控制点之后仍无法避开障碍,则取消该控制点,并在对应直线段上添加两个控制点,将修正的曲线的中间段变成直线段,使曲线通过该直线段。
7.根据权利要求6所述基于准均匀样条曲线的无人机路径修正方法,其特征在于,最佳控制点的求取步骤如下:
1)在对应直线段上选择多个点,分别以每一个点为添加控制点来修正路径;
2)判断每一条修正路径是否还与障碍物相交,剔除相交的路径,保留不相交路径所对应的控制点;
3)根据控制点的曲率和安全距离的权值,计算出每一个控制点修正后曲线的最大曲率和最短安全距离,代入到下列公式中:
选择的最小值,其对应的控制点即是最佳添加控制点。
8.一种基于准均匀样条曲线的无人机路径修正***,其特征在于,所述基于准均匀样条曲线的无人机路径修正***包括如下功能模块:
初级线路规划模块,用于建立动态障碍物模型,规划一条连接起点和终点的直线段路径;
B样条曲线绘制模块,用于以直线段之间的交点为管制点,直线段路径为控制多边形,绘制准均匀三次B样条曲线;
曲线调整模块,用于找出与障碍物相交的曲线段以及相交曲线段的四个管制点,根据顺序连接四个管制点的形状,对曲线进行相应调整;
线路更新模块,用于更新管制点组和曲线,并根据无人机的曲率约束和安全约束微调管制点。
9.根据权利要求8所述基于准均匀样条曲线的无人机路径修正***,其特征在于,所述初级线路规划模块包括如下功能单元:
模型建立单元,用于绘制初始路径周围的障碍,每一个障碍用矩形表示;
图形生成单元,用于用Voronoi图法产生连接图;
路径计算单元,用于结合无人机具体执行任务的需求,通过A*搜索算法得到一条连接起点和终点的直线段路径。
10.根据权利要求8所述基于准均匀样条曲线的无人机路径修正***,其特征在于,所述曲线调整模块包括如下功能单元:
管制点提取单元、用于找出与障碍物相交的曲线段,以及相交曲线段所对应直线段的四个管制点,
控制点确定单元、用于根据顺序连接四个管制点的形状,确定在对应直线段上添加控制点以及添加控制点的数量;
路径调整单元、用于根据控制点对曲线进行调整,使曲线通过添加的控制点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710299939.6A CN107085438B (zh) | 2017-04-28 | 2017-04-28 | 基于准均匀样条曲线的无人机路径修正方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710299939.6A CN107085438B (zh) | 2017-04-28 | 2017-04-28 | 基于准均匀样条曲线的无人机路径修正方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107085438A true CN107085438A (zh) | 2017-08-22 |
CN107085438B CN107085438B (zh) | 2020-02-07 |
Family
ID=59611433
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710299939.6A Active CN107085438B (zh) | 2017-04-28 | 2017-04-28 | 基于准均匀样条曲线的无人机路径修正方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107085438B (zh) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109596138A (zh) * | 2018-12-29 | 2019-04-09 | 北京智行者科技有限公司 | 自动驾驶充电车停车路径规划方法及*** |
CN110427046A (zh) * | 2019-07-26 | 2019-11-08 | 沈阳航空航天大学 | 一种三维平滑随机游走无人机群移动模型 |
CN111158365A (zh) * | 2019-12-31 | 2020-05-15 | 深圳优地科技有限公司 | 一种路径规划方法、装置、机器人及存储介质 |
CN111174790A (zh) * | 2019-12-03 | 2020-05-19 | 河海大学 | 一种地形剖面跟踪路径的形成方法 |
CN111752305A (zh) * | 2020-06-30 | 2020-10-09 | 国电南瑞科技股份有限公司 | 一种山地型分布式光伏电站无人机巡检避障方法及*** |
CN112241178A (zh) * | 2020-09-30 | 2021-01-19 | 成都飞机工业(集团)有限责任公司 | 一种无人机自主安全控制方法 |
CN112344942A (zh) * | 2020-11-11 | 2021-02-09 | 国网上海市电力公司 | 一种基于三次均匀b样条的机器人路径规划方法及装置 |
CN112414428A (zh) * | 2020-10-29 | 2021-02-26 | 汉海信息技术(上海)有限公司 | 导航信息的显示方法、装置、电子设备及存储介质 |
CN114200931A (zh) * | 2021-12-01 | 2022-03-18 | 浙江大学 | 一种基于b样条曲线优化的移动机器人路径平滑方法 |
CN115200584A (zh) * | 2022-05-30 | 2022-10-18 | 西南交通大学 | 一种路径规划方法、装置、设备及可读存储介质 |
CN115200584B (zh) * | 2022-05-30 | 2024-07-26 | 西南交通大学 | 一种路径规划方法、装置、设备及可读存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102160006A (zh) * | 2008-07-15 | 2011-08-17 | 空中侦察辨识和避免技术有限责任公司 | 用于避免碰撞的***和方法 |
CN102402289A (zh) * | 2011-11-22 | 2012-04-04 | 华南理工大学 | 一种基于机器视觉的手势鼠标识别方法 |
CN103679775A (zh) * | 2014-01-03 | 2014-03-26 | 中南大学 | 一种直线和曲线相结合的农田作业区域边界建模方法 |
CN104076742A (zh) * | 2014-06-20 | 2014-10-01 | 北京航空航天大学 | 一种连续多类型曲线段混合插补三次多项式进给速度前瞻规划方法 |
CN105867421A (zh) * | 2016-05-25 | 2016-08-17 | 华中科技大学 | 一种基于ph曲线的无人机路径规划方法 |
CN106289233A (zh) * | 2016-07-25 | 2017-01-04 | 中国船舶重工集团公司第七0九研究所 | 多形态障碍的无人机路径规划方法及*** |
CN106525047A (zh) * | 2016-10-28 | 2017-03-22 | 重庆交通大学 | 一种基于floyd算法的无人机路径规划方法 |
-
2017
- 2017-04-28 CN CN201710299939.6A patent/CN107085438B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102160006A (zh) * | 2008-07-15 | 2011-08-17 | 空中侦察辨识和避免技术有限责任公司 | 用于避免碰撞的***和方法 |
CN102402289A (zh) * | 2011-11-22 | 2012-04-04 | 华南理工大学 | 一种基于机器视觉的手势鼠标识别方法 |
CN103679775A (zh) * | 2014-01-03 | 2014-03-26 | 中南大学 | 一种直线和曲线相结合的农田作业区域边界建模方法 |
CN104076742A (zh) * | 2014-06-20 | 2014-10-01 | 北京航空航天大学 | 一种连续多类型曲线段混合插补三次多项式进给速度前瞻规划方法 |
CN105867421A (zh) * | 2016-05-25 | 2016-08-17 | 华中科技大学 | 一种基于ph曲线的无人机路径规划方法 |
CN106289233A (zh) * | 2016-07-25 | 2017-01-04 | 中国船舶重工集团公司第七0九研究所 | 多形态障碍的无人机路径规划方法及*** |
CN106525047A (zh) * | 2016-10-28 | 2017-03-22 | 重庆交通大学 | 一种基于floyd算法的无人机路径规划方法 |
Non-Patent Citations (2)
Title |
---|
闫俊丰: "无人机航路规划评估及修正方法研究", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 * |
马云红 等: "基于B样条曲线的无人机航路规划算法", 《飞行力学》 * |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109596138A (zh) * | 2018-12-29 | 2019-04-09 | 北京智行者科技有限公司 | 自动驾驶充电车停车路径规划方法及*** |
CN110427046A (zh) * | 2019-07-26 | 2019-11-08 | 沈阳航空航天大学 | 一种三维平滑随机游走无人机群移动模型 |
CN110427046B (zh) * | 2019-07-26 | 2022-09-30 | 沈阳航空航天大学 | 一种三维平滑随机游走无人机群移动模型 |
CN111174790A (zh) * | 2019-12-03 | 2020-05-19 | 河海大学 | 一种地形剖面跟踪路径的形成方法 |
CN111158365A (zh) * | 2019-12-31 | 2020-05-15 | 深圳优地科技有限公司 | 一种路径规划方法、装置、机器人及存储介质 |
CN111158365B (zh) * | 2019-12-31 | 2023-05-16 | 深圳优地科技有限公司 | 一种路径规划方法、装置、机器人及存储介质 |
CN111752305A (zh) * | 2020-06-30 | 2020-10-09 | 国电南瑞科技股份有限公司 | 一种山地型分布式光伏电站无人机巡检避障方法及*** |
CN112241178A (zh) * | 2020-09-30 | 2021-01-19 | 成都飞机工业(集团)有限责任公司 | 一种无人机自主安全控制方法 |
CN112414428A (zh) * | 2020-10-29 | 2021-02-26 | 汉海信息技术(上海)有限公司 | 导航信息的显示方法、装置、电子设备及存储介质 |
CN112414428B (zh) * | 2020-10-29 | 2023-06-27 | 汉海信息技术(上海)有限公司 | 导航信息的显示方法、装置、电子设备及存储介质 |
CN112344942A (zh) * | 2020-11-11 | 2021-02-09 | 国网上海市电力公司 | 一种基于三次均匀b样条的机器人路径规划方法及装置 |
CN114200931A (zh) * | 2021-12-01 | 2022-03-18 | 浙江大学 | 一种基于b样条曲线优化的移动机器人路径平滑方法 |
CN114200931B (zh) * | 2021-12-01 | 2023-06-13 | 浙江大学 | 一种基于b样条曲线优化的移动机器人路径平滑方法 |
CN115200584A (zh) * | 2022-05-30 | 2022-10-18 | 西南交通大学 | 一种路径规划方法、装置、设备及可读存储介质 |
CN115200584B (zh) * | 2022-05-30 | 2024-07-26 | 西南交通大学 | 一种路径规划方法、装置、设备及可读存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN107085438B (zh) | 2020-02-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107085438A (zh) | 基于准均匀样条曲线的无人机路径修正方法及*** | |
US7668700B2 (en) | Adaptive distance field constraint for designing a route for a transport element | |
Patsko et al. | Level sets of the value function in differential games with the homicidal chauffeur dynamics | |
CN106289233B (zh) | 多形态障碍的无人机路径规划方法及*** | |
JP3916537B2 (ja) | 道路線形設計方法、道路線形設計装置およびコンピュータ読取可能な道路線形設計プログラム | |
WO2004088468A2 (en) | System and method for defining t-spline and t-nurcc surfaces using local refinements | |
Shanmugavel et al. | A solution to simultaneous arrival of multiple UAVs using Pythagorean hodograph curves | |
CN109765902A (zh) | 一种驾驶参考线处理方法、装置及车辆 | |
CN104268942A (zh) | 基于德卡斯特里奥算法的贝塞尔曲线曲面拟合方法及*** | |
JP3707770B2 (ja) | 地図情報修正装置および地図情報修正方法 | |
Juárez-Castillo et al. | Empirical study of bound constraint-handling methods in particle swarm optimization for constrained search spaces | |
US8994724B2 (en) | Methods and systems for generating continuous surfaces from polygonal data | |
CN110472263B (zh) | 一种发动机外部管路敷设规划方法 | |
Walton et al. | Curve design with more general planar Pythagorean-hodograph quintic spiral segments | |
US6774906B2 (en) | Method and system of improving silhouette appearance in bump mapping | |
Zhang et al. | Controllable clothoid path generation for autonomous vehicles | |
Li et al. | Navigation Simulation of Autonomous Mobile Robot Based on TEB Path Planner | |
CN109933932A (zh) | 一种基于Bézier曲线的路径优化方法及*** | |
CN111435359B (zh) | 电子地图的路口数据处理方法及装置 | |
Westgaard et al. | A process for surface fairing in irregular meshes | |
US7206727B2 (en) | Method for designing generalized spirals, bends, jogs, and wiggles for railroad tracks and vehicle guideways | |
CN104268909A (zh) | 基于构造含参伯恩斯坦基函数调整贝塞尔曲线的方法 | |
Juhász et al. | On the family of B-spline surfaces obtained by knot modification | |
CN108303105A (zh) | 导航设备中增加路径实现路径规划的方法 | |
Mukherjee | An error reduced and uniform parameter approximation in fitting of B-spline curves to data points |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |