基于全凸包扩张算法的障碍物间最优路径解算方法技术

本发明专利技术的基于全凸包扩张算法的障碍物间最优路径解算方法，步骤如下：首先，判断当前路径是否与障碍物相交，若否，则该路径为两点间最优路径，若是，则统计与该路径相交的障碍物；计算上述障碍物的中心点，并对各中心点与路径进行相对位置判断；对路径及与其相交障碍物进行凸包(壳)运算，同时对数量较多的一侧障碍物进行单侧凸包(壳)运算，将上述两凸包(壳)边界在折点处分割，添加至路径网，并删除原路径；重复上述方法，直至路径网中所有路径均不与障碍物相交；最后，按照一定路径规划规则，解算上述路径网中由起点至终点的最优路径。既克服了二叉树方法的算法复杂度高，运算时间长的缺陷，又解决了凸包(壳)边界算法丢失路径的问题。

Optimal Path Solution between Obstacles Based on Fully Convex Hull Expansion

The method for solving the optimal path between obstacles based on the full convex hull expansion algorithm of the present invention is as follows: first, to determine whether the current path intersects with the obstacle, if not, the path is the optimal path between two points, if not, to count the obstacles intersecting with the path, to calculate the central points of the obstacle, and to judge the relative positions of each central point and path; The convex hull (shell) operations are performed on the intersecting obstacles, and the convex hull (shell) operations are performed on the one side of the obstacles with large number. The boundary of the two convex hulls (hulls) is partitioned at the break point, added to the path network, and the original path is deleted. The above methods are repeated until all paths in the path network do not intersect with the obstacles. Finally, the above paths are solved according to certain path planning rules. The optimal path from the starting point to the end point in the path network. This method not only overcomes the shortcomings of high computational complexity and long operation time of the binary tree method, but also solves the problem of losing the path of convex hull boundary algorithm.

【技术实现步骤摘要】
基于全凸包扩张算法的障碍物间最优路径解算方法
本专利技术涉及航线设计、机器人路径规划、舰载机调运等领域，尤其涉及一种路径规划技术。
技术介绍
障碍物间最优路径规划属于一种特殊的路径规划问题，其在航线设计、机器人路径规划、舰载机调运领域有广泛的应用。当前，对于障碍物间最优路径规划的矢量方法主要有二叉树算法和凸包(壳)边界算法。二叉树算法类似于“拉线法”，是对距离当前点最近的障碍物进行绕过计算，并在航路二叉树中添加节点，重复上述过程，直至搜索至终点结束；然后按照“深度优先”和“试探搜索”相结合的原则，获取二叉树中所有路径，删除冗余节点后可得到最短路径。凸包(壳)边界算法首先统计路径穿过的所有障碍物并获取其顶点，根据各顶点与路径的距离，将顶点集分为上(下)点集，分别对上下点集进行凸包(壳)运算，将凸包(壳)边界作为路径，若新路径仍与障碍物相交，则重复上述步骤，直至所有路径均不予障碍物相交，最后用路径择优方法进行最优路径的规划。上述两种路径规划方法仍存在许多不足：二叉树方法对各路径穿过的最近障碍物进行绕过，算法复杂度较高，尤其是当障碍物数量较多时，运算时间较长。凸包(壳)边界方法可抽象为对路径与其穿过的障碍物进行凸包(壳)运算，将凸包(壳)边界作为绕行方案，但遗漏了障碍物间潜在的路径，路径网不全面。
技术实现思路
为克服上述两种方法存在的不足，本专利技术提供了一种基于全凸包(壳)扩张算法的障碍物间最优路径解算方法。本专利技术为实现上述目的所采用的技术方案是：一种基于全凸包扩张算法的障碍物间最优路径解算方法，包括以下步骤。步骤一：将起点S至终点D连线的路径作为当前路径rcur；步骤二：判断当前路径rcur与障碍物bi是否相交(bi∈B，B为障碍物集合)，若否，则当前路径rcur为两点间最优路径，转步骤六，若是，统计与路径相交的障碍物b′i，将其存入障碍物集Bcur中；步骤三：依次判断障碍物与当前路径rcur的相对位置关系，以左右侧为例，对应地将障碍物b′j添加至左侧障碍物集Bleft或右侧障碍物集Bright，并分别统计两侧障碍物数量Sumleft与Sumright；步骤四：对当前路径rcur与障碍物集Bcur进行凸包(壳)运算，将凸包(壳)边界在折点处打断后添加至路径网R；步骤五：若Sumleft≥(＜)Sumright且Sumright(Sumleft)≠0，对前路径rcur与障碍物集Bleft或Bright进行单侧凸包(壳)运算，将凸包(壳)边界并在折点处打断并添加至路径网R；步骤六：在路径网R中删除当前路径rcur；步骤七：若路径网R不与障碍物集B相交，转步骤八，若仍有路径r′与障碍物集B相交，令rcur＝r′，转步骤二；步骤八：按照一定的最优规则，可解算由起点S至终点D的障碍物间最优路径。可选地，所述步骤二中，若满足：则当前路径rcur与障碍物不相交；若满足：则当前路径rcur与障碍物相交。可选地，所述步骤三中，障碍物与当前路径的相对位置关系以障碍物中心点与当前路径的相对位置关系表示，首先计算障碍物b′i∈Bcur的中心点Ai，而各障碍物中心点Ai与当前路径rcur的相对位置关系包括但不限于中心点位于路径左右侧或上下侧。当中心点Ai位于当前路径rcur上时，统一将该障碍物划为某侧。若进行左右侧判断，以当前路径方向为准，位于以顺时针方向旋转180°范围内的点为路径右侧的点，位于以逆时针方向旋转180°范围内的点为路径左侧的点，反之亦可；若进行上下侧判断，设路径所在直线在平面直角坐标系中的方程为αx+βy+γ＝0，若pi(x0，y0)满足：αx0+βy0+γ＞0(3)则pi(x0，y0)位于路径上侧，若pi(x0，y0)满足：αx0+βy0+γ＜0(4)则pi(x0y0)位于路径下侧。可选地，所述步骤四、步骤五中，凸包(壳)是数据点的自然极限边界，为包含所有数据点的最小凸多边形，连接任意两点的线段必须完全位于该凸多边形中，同时区域的面积也达到最小值。可选地，所述步骤四、步骤五中，若进行障碍物间最短路径规划，由当前路径rcur将凸包(壳)边界分为两段，若距离较短的一段rmin满足：则只保留rmin。可选地，所述步骤四、步骤五中，对rcur与Bcur进行凸包(壳)运算时，包括但不限于以下方法：(1)获取当前路径rcur的起点ps、终点pd及障碍物集Bcur冲各障碍物的边界点pi，计算点集的凸包(壳)；(2)获取障碍物集Bcur中各障碍物的边界L，计算线集{L，rcur}的凸包(壳)。可选地，所述步骤七中，若满足：则路径网R不与障碍物集B相交，若满足：则路径r′与障碍物集B相交。可选地，所述步骤八中，最优规则包括但不限于：距离最短、转向次数最少、转向频率最低。本专利技术的基于全凸包(壳)扩张算法的障碍物间最优路径解算方法，既克服了二叉树方法的算法复杂度高，运算时间长的缺陷，又解决了凸包(壳)边界算法丢失路径的问题。附图说明图1为本专利技术的基于全凸包(壳)扩张算法的障碍物间最优路径解算方法流程图。图2为路径与障碍物示意图。图3为路径与障碍物凸包(壳)边界示意图。图4为路径与障碍物单侧凸包(壳)边界示意图。图5为路径规划结果示意图。图6为最短路径示意图。具体实施方式本专利技术的为使本专利技术的技术方案和优点更加清楚，下面将结合附图及具体实施例进行详细描述。以搜索最短路径为实施例，显然所描述实施例仅是本专利技术的一部分实施例，而不是全部的实施例。图1为本实施例的障碍物与路径示意图，S、T分别为起点、终点，O1、O2、O3为障碍物。步骤一：连接ST，将其作为当前路径rcur；步骤二：判断当前路径rcur与障碍物O1、O2、O3是否相交，显然当前路径rcur与障碍物O1、O2、O3均相交，将其添加至Bcur；步骤三：依次计算Bcur中障碍物的中心点，分别为A1、A2、A3，其中A1、A2在当前路径rcur左侧，A3在右侧；步骤四：将当前路径rcur与障碍物集Bcur进行凸包(壳)运算，由于路径SP8P9T长度小于路径SP1P2P3P4T，只将路径SP8P9T在折点处打断后添加至路径网R，如图3所示；步骤五：当前路径rcur左侧障碍物数量较多，则对rcur与Bleft进行凸包(壳)边界运算，其中较短路径SP5P7T与障碍物相交，将需将整个凸包(壳)边界在折点出打断后添加至路径网R，并在路径网R中删除当前路径rcur，如图4所示，已删除的路径以虚线表示；步骤六：此时，路径网R中只有路径P5P7与障碍物相交，则继续对其进行凸包(壳)边界运算，由于路径P5P6P7长度小于路径P5P8P9P7且不与障碍物相交，则将路径P5P6P7添加至路径网R，并删除路径P5P7，如图5所示；步骤7：至此，路径网R中所有路径均不与障碍物相交，用Dijkstra算法进行最短路径的解算，如图6所示。本专利技术是通过实施例进行描述的，本领域技术人员知悉，在不脱离本专利技术的精神和范围的情况下，可以对这些特征和实施例进行各种改变或等效替换。另外，在本专利技术的教导下，可以对这些特征和实施例进行修改以适应具体的情况及材料而不会脱离本专利技术的精神和范围。因此，本专利技术不受此处所公开的具体实施例的限制，所有落入本申请的权利要求范围内的实施例都属于本专利技术的保护范围。本文档来自技高网...

【技术保护点】
1.基于全凸包扩张算法的障碍物间最优路径解算方法，其特征在于：包括以下步骤：步骤一：将起点(S)至终点(D)连线的路径作为当前路径(rcur)；步骤二：判断当前路径(rcur)与障碍物(bi)是否相交，若否，则当前路径(rcur)为两点间最优路径，转步骤六，若是，统计与路径相交的障碍物(b′i)，将其存入障碍物集(Bcur)中；步骤三：依次判断障碍物与当前路径(rcur)的相对位置关系，以左右侧为例，对应地将障碍物(b′j)添加至左侧障碍物集(Bleft)或右侧障碍物集(Bright)，并分别统计两侧障碍物数量(Sumleft)与(Sumright)；步骤四：对当前路径(rcur)与障碍物集(Bcur)进行凸包运算，将凸包边界在折点处打断后添加至路径网(R)；步骤五：若Sumleft≥(＜)Sumright且Sumright(Sumleft)≠0，对前路径(rcur)与障碍物集(Bleft)或(Bright)进行单侧凸包运算，将凸包边界并在折点处打断并添加至路径网(R)；步骤六：在路径网(R)中删除当前路径(rcur)；步骤七：若路径网(R)不与障碍物集B相交，转步骤八，若仍有路径(r′)与障碍物集(B)相交，令rcur＝r′，转步骤二；步骤八：按照一定的最优规则，解算由起点S至终点D的障碍物间最优路径。...

【技术特征摘要】
1.基于全凸包扩张算法的障碍物间最优路径解算方法，其特征在于：包括以下步骤：步骤一：将起点(S)至终点(D)连线的路径作为当前路径(rcur)；步骤二：判断当前路径(rcur)与障碍物(bi)是否相交，若否，则当前路径(rcur)为两点间最优路径，转步骤六，若是，统计与路径相交的障碍物(b′i)，将其存入障碍物集(Bcur)中；步骤三：依次判断障碍物与当前路径(rcur)的相对位置关系，以左右侧为例，对应地将障碍物(b′j)添加至左侧障碍物集(Bleft)或右侧障碍物集(Bright)，并分别统计两侧障碍物数量(Sumleft)与(Sumright)；步骤四：对当前路径(rcur)与障碍物集(Bcur)进行凸包运算，将凸包边界在折点处打断后添加至路径网(R)；步骤五：若Sumleft≥(＜)Sumright且Sumright(Sumleft)≠0，对前路径(rcur)与障碍物集(Bleft)或(Bright)进行单侧凸包运算，将凸包边界并在折点处打断并添加至路径网(R)；步骤六：在路径网(R)中删除当前路径(rcur)；步骤七：若路径网(R)不与障碍物集B相交，转步骤八，若仍有路径(r′)与障碍物集(B)相交，令rcur＝r′，转步骤二；步骤八：按照一定的最优规则，解算由起点S至终点D的障碍物间最优路径。2.根据权利要求1所述的基于全凸包扩张算法的障碍物间最优路径解算方法，其特征在于：所述步骤二中，若满足：则当前路径rcur与障碍物不相交；若满足：则当前路径rcur与障碍物相交。3.根据权利要求1所述的基于全凸包扩张算法的障碍物间最优路径解算方法，其特征在于：所述步骤三中，障碍物与当前路径的相对位置关系以障碍物中心点Ai与当前路径的相对位置关系表示，首先计算障碍物b′i∈Bcur的中心点Ai，而各障碍物中心点Ai与当前路径rcur的相对位置关系包括中心点位于路径左右侧或上下侧，当中心点Ai位于...

【专利技术属性】
技术研发人员：董箭，彭认灿，李改肖，吕程，张志衡，董洲洋，黄晓琛，
申请(专利权)人：董箭，彭认灿，李改肖，吕程，张志衡，董洲洋，黄晓琛，
类型：发明
国别省市：辽宁,21