CN110442128A - AGV paths planning method based on feature point extraction ant group algorithm - Google Patents
AGV paths planning method based on feature point extraction ant group algorithm Download PDFInfo
- Publication number
- CN110442128A CN110442128A CN201910657050.XA CN201910657050A CN110442128A CN 110442128 A CN110442128 A CN 110442128A CN 201910657050 A CN201910657050 A CN 201910657050A CN 110442128 A CN110442128 A CN 110442128A
- Authority
- CN
- China
- Prior art keywords
- grid
- barrier
- ant
- vertex
- grids
- 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
- 238000000034 method Methods 0.000 title claims abstract description 64
- 238000004422 calculation algorithm Methods 0.000 title claims abstract description 59
- 238000000605 extraction Methods 0.000 title claims abstract description 36
- 239000011159 matrix material Substances 0.000 claims abstract description 28
- 230000004888 barrier function Effects 0.000 claims abstract 21
- 239000003016 pheromone Substances 0.000 claims description 31
- 241000257303 Hymenoptera Species 0.000 claims description 29
- 230000007704 transition Effects 0.000 claims description 10
- 239000000284 extract Substances 0.000 claims description 4
- 230000011218 segmentation Effects 0.000 claims description 3
- 238000010276 construction Methods 0.000 claims 2
- 238000004387 environmental modeling Methods 0.000 abstract description 3
- 230000007613 environmental effect Effects 0.000 abstract 1
- 238000004364 calculation method Methods 0.000 description 8
- 238000010586 diagram Methods 0.000 description 8
- 230000008569 process Effects 0.000 description 5
- 238000004590 computer program Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 201000004569 Blindness Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000009529 body temperature measurement Methods 0.000 description 1
- 230000010339 dilation Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000004088 simulation 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/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- 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/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- 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/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- 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/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
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)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
Abstract
Description
技术领域technical field
本公开涉及计算机算法中的AGV路径规划技术领域,尤其是一种基于特征点提取蚁群算法的AGV路径规划方法。The present disclosure relates to the technical field of AGV path planning in computer algorithms, in particular to an AGV path planning method based on feature point extraction ant colony algorithm.
背景技术Background technique
现有的AGV路径规划方法是先通过环境建模,建立一个与AGV运行环境一致的栅格环境模型,再在该环境模型上确定起点和终点,利用蚁群算法寻找出一条从起点到终点的无障碍物路径。但是该方法虽然能够成功求得一条从起点到终点的无障碍物路径,但是其搜索过程属于逐格搜索具有一定的盲目性,搜索过程中会搜索大量的非最优解使得收敛速度慢,严重影响了算法计算的效率,同时,仅根据栅格是否为障碍物栅格来判断其可行性会使规划出的路径频繁经过障碍物的顶点,影响AGV的安全运行。The existing AGV path planning method is to first establish a grid environment model consistent with the AGV operating environment through environmental modeling, and then determine the starting point and end point on the environment model, and use the ant colony algorithm to find a path from the starting point to the end point. Obstacle-free path. However, although this method can successfully obtain an obstacle-free path from the start point to the end point, its search process belongs to a grid-by-frame search, which has a certain blindness. During the search process, a large number of non-optimal solutions will be searched, making the convergence speed slow and serious. It affects the efficiency of algorithm calculation. At the same time, only judging its feasibility based on whether the grid is an obstacle grid will cause the planned path to frequently pass through the vertices of obstacles, affecting the safe operation of the AGV.
发明内容SUMMARY OF THE INVENTION
为了解决现有技术中的问题,本公开提出了一种基于特征点提取蚁群算法的AGV路径规划方法。该方法经过栅格法构建出AGV的运行环境模型后,将黑色障碍物栅格的顶点栅格作为特征点提取出来,利用蚁群算法在这些顶点栅格之间进行路径搜索,可以有效地引导搜索过程,减少规划时算法的计算量,并且,由于在特征点提取之后,原有的栅格之间的连接关系被打破,利用新的栅格可行性判断的方法来判断栅格之间的连接关系,得出的路径更加安全平滑,更加有利于AGV的运行。In order to solve the problems in the prior art, the present disclosure proposes an AGV path planning method based on feature point extraction ant colony algorithm. After constructing the operating environment model of the AGV through the grid method, the method extracts the vertex grid of the black obstacle grid as the feature point, and uses the ant colony algorithm to search the path between these vertex grids, which can effectively guide the The search process reduces the calculation amount of the algorithm during planning, and since the connection between the original grids is broken after the feature point extraction, the new method of judging the feasibility of the grid is used to judge the relationship between the grids. The connection relationship, the resulting path is safer and smoother, which is more conducive to the operation of the AGV.
第一方面,本公开实施例提供了一种基于特征点提取蚁群算法的AGV路径规划方法,包括以下步骤:确定AGV运行地图中障碍物的位置,并将所述障碍物的三维位置投射到二维平面上;对投射至二维平面上的障碍物投影图进行分割;对分割后的所述障碍物投影图中的障碍物阴影进行膨胀化处理,并将设置为黑色障碍物栅格的顶点栅格作为特征点进行提取;对提取出的栅格进行可行性判断并构造邻接矩阵;对蚁群算法的多个初始参数值进行设置并将当前代所有蚂蚁置于起点进行路径搜索;根据转移概率以及构造的所述邻接矩阵中的非0栅格选择下一个栅格直至到达终点。In a first aspect, the embodiments of the present disclosure provide an AGV path planning method based on feature point extraction ant colony algorithm, including the following steps: determining the position of obstacles in the AGV operating map, and projecting the three-dimensional positions of the obstacles to On the two-dimensional plane; segment the obstacle projection map projected on the two-dimensional plane; perform expansion processing on the obstacle shadow in the segmented obstacle projection map, and set it as the black obstacle grid. The vertex grid is extracted as a feature point; the feasibility of the extracted grid is judged and an adjacency matrix is constructed; a number of initial parameter values of the ant colony algorithm are set and all the ants of the current generation are placed at the starting point for path search; The transition probabilities and the non-zero grids in the constructed adjacency matrix select the next grid until the end point is reached.
在其中一个实施例中,所述对投射至二维平面上的障碍物投影图进行分割包括:将所述障碍物投影图分割为大小相同的栅格,栅格的数量为a*a。In one of the embodiments, the dividing the obstacle projection map projected onto the two-dimensional plane includes: dividing the obstacle projection map into grids of the same size, and the number of grids is a*a.
在其中一个实施例中,对分割后的所述障碍物投影图中的障碍物阴影进行膨胀化处理包括:在对所述障碍物投影图分割后的栅格中存在障碍物的阴影,则将其设置为黑色障碍物栅格,否则设置为白色无障碍物栅格。In one of the embodiments, performing expansion processing on the obstacle shadow in the segmented obstacle projection image includes: if there is an obstacle shadow in the grid after segmenting the obstacle projection image, then It is set to a black obstacle grid, otherwise it is set to a white no obstacle grid.
在其中一个实施例中,所述对提取出的栅格进行可行性判断并构造邻接矩阵包括:构造邻接矩阵D,其大小为a2*a2。In one embodiment, performing feasibility judgment on the extracted grid and constructing an adjacency matrix includes: constructing an adjacency matrix D, the size of which is a 2 *a 2 .
在其中一个实施例中,所述对蚁群算法的多个初始参数值进行设置包括:m为每代种群蚂蚁的数量,n为蚂蚁总共的代数,τ(0)为初始信息素浓度;In one embodiment, the setting of multiple initial parameter values of the ant colony algorithm includes: m is the number of ants in each generation, n is the total number of generations of ants, and τ(0) is the initial pheromone concentration;
禁忌表Tabu为细胞结构大小为m*n,用以记录每一只蚂蚁行走的路线,路径长度矩阵PL的大小为m*n,用以记录每一代每一只蚂蚁爬行的路线长度;Tabu table Tabu is the cell structure size of m*n, which is used to record the route that each ant walks, and the size of the path length matrix PL is m*n, which is used to record the length of the route that each ant crawls in each generation;
初始化信息素衰减系数ρ,信息素启发因子α,距离启发因子β,迭代次数t;以及Initialize the pheromone decay coefficient ρ, the pheromone heuristic factor α, the distance heuristic factor β, the number of iterations t; and
对起点和终点的初始参数值进行设置。Set the initial parameter values for the start and end points.
在其中一个实施例中,还包括:判断当前代所有蚂蚁是否全部完成路径搜索,若全部完成搜索,则记录一次迭代次数,其中,迭代次数t=t+1;判断迭代次数t是否满足迭代次数的要求,若满足则输出最短路径;若不满足迭代次数的要求,则更新信息素并执行派出下一代蚂蚁操作;将派出的所述下一代蚂蚁操作视为当前代,将当前代所有蚂蚁置于起点执行路径搜索。In one embodiment, the method further includes: judging whether all the ants of the current generation have completed the path search, and if all the searches are completed, recording the number of iterations, where the number of iterations t=t+1; and judging whether the number of iterations t satisfies the number of iterations If the requirements are met, the shortest path is output; if the requirements of the number of iterations are not met, the pheromone is updated and the operation of dispatching the next generation of ants is performed; the dispatched operation of the next generation of ants is regarded as the current generation, and all ants of the current generation are Route search is performed at the starting point.
在其中一个实施例中,还包括:判断当前代所有蚂蚁是否全部完成路径搜索,若未全部完成搜索,则根据转移概率以及所述邻接矩阵中的非0栅格选择下一个栅格直至到达终点。In one embodiment, the method further includes: judging whether all the ants of the current generation have completed the path search, and if the search has not been completed, selecting the next grid according to the transition probability and the non-zero grid in the adjacency matrix until reaching the end point .
在其中一个实施例中,所述将设置为黑色障碍物栅格的顶点栅格作为特征点进行提取包括:将所有单独黑色障碍物栅格的四个顶角栅格,所有组合黑色障碍物栅格的所有顶角和凹角栅格作为特征点进行提取。In one embodiment, the extracting the vertex grid set as the black obstacle grid as the feature point includes: taking all the four vertex corner grids of the individual black obstacle grids, all the combined black obstacle grids All vertex and concave corners of the grid are extracted as feature points.
在其中一个实施例中,所述对提取出的栅格进行可行性判断包括:若两个顶点栅格之间存在黑色障碍物栅格,则判定两个顶点栅格不可见,互为不可行栅格;若两个顶点栅格之间不存在黑色障碍物栅格,则判断两个顶点栅格的连线是否经过黑色障碍物栅格的顶点,若经过黑色障碍物栅格的顶点,则判定两个顶点栅格不可见,互为不可行栅格,若不经过黑色障碍物栅格的顶点,则判定两个顶点栅格可见,互为可行栅格。In one embodiment, the feasibility judgment on the extracted grid includes: if there is a black obstacle grid between the two vertex grids, determining that the two vertex grids are invisible and mutually infeasible Grid; if there is no black obstacle grid between the two vertex grids, judge whether the connection line between the two vertex grids passes through the vertex of the black obstacle grid, if it passes through the vertex of the black obstacle grid, then It is determined that the two vertex grids are invisible and mutually infeasible grids. If the vertex of the black obstacle grid is not passed, the two vertex grids are determined to be visible and mutually feasible grids.
在其中一个实施例中,还包括:所述转移概率公式为:In one embodiment, it also includes: the transition probability formula is:
其中,τij(t)为在迭代次数为t时栅格i与j之间的信息素浓度,为迭代次数为t时栅格i与j之间的距离启发函数,alloweds为邻接矩阵D中,D(i,s)≠0时s代表的栅格。where τ ij (t) is the pheromone concentration between grids i and j when the iteration number is t, is the distance heuristic function between grids i and j when the number of iterations is t, and allowed s is the grid represented by s when D(i, s)≠0 in the adjacency matrix D.
在其中一个实施例中,所述信息素公式为:In one embodiment, the pheromone formula is:
τij(t+1)=(1-ρ)τij(t)+Δτij(t)τ ij (t+1)=(1-ρ)τ ij (t)+Δτ ij (t)
其中,τij(k+1)为在迭代次数为t时,栅格i和j之间的信息素浓度,Δτij(t)为当前代蚂蚁在栅格i和j之间留下的信息素增量之和,为在迭代次数为t时,第k只蚂蚁在栅格i和j之间留下的信息素增量。Among them, τ ij (k+1) is the pheromone concentration between grids i and j when the number of iterations is t, and Δτ ij (t) is the information left by the current generation of ants between grids i and j sum of prime increments, is the pheromone increment left by the kth ant between grids i and j when the number of iterations is t.
本发明提供的一种基于特征点提取蚁群算法的AGV路径规划方法,该方法包括环境建模和路径规划,环境建模包括栅格图的建立和特征点的提取,根据预先知道的AGV环境地图信息,将三维障碍物投影到二维平面栅格图后,将障碍物投影图分割为大小相同的栅格,再将障碍物阴影进行膨胀化,得到初始栅格图,将其中黑色障碍物栅格的顶点提取出来,并通过栅格可行性判断重新构造邻接矩阵,利用蚁群算法在特征点之间进行路径规划,最终得到一条从起点到终点的无障碍物路径。该方法本发明的AGV路径规划方法,克服了传统蚁群算法逐点搜索效率低下的问题,有效地节约了计算的时间,提高搜索效率,使规划出的路径更加平滑;同时,新的栅格可行性判断方法,可以有效解决规划出的路径距离障碍物过近的缺点,更有利于AGV的安全可靠运行。The invention provides an AGV path planning method based on feature point extraction ant colony algorithm. The method includes environment modeling and path planning. The environment modeling includes the establishment of a grid map and the extraction of feature points. According to the pre-known AGV environment Map information, after projecting the three-dimensional obstacles to the two-dimensional plane grid map, divide the obstacle projection map into grids of the same size, and then inflate the shadow of the obstacles to obtain the initial grid map, in which the black obstacles are divided The vertices of the grid are extracted, and the adjacency matrix is reconstructed by judging the feasibility of the grid. The ant colony algorithm is used to plan the path between the feature points, and finally an obstacle-free path from the starting point to the end point is obtained. This method The AGV path planning method of the present invention overcomes the problem of low point-by-point search efficiency of the traditional ant colony algorithm, effectively saves calculation time, improves search efficiency, and makes the planned path smoother; at the same time, the new grid The feasibility judgment method can effectively solve the disadvantage that the planned path is too close to the obstacle, and is more conducive to the safe and reliable operation of the AGV.
附图说明Description of drawings
为了更清楚地说明本公开实施例的技术方案,下面对实施例描述中所需要使用的附图作简单地介绍:In order to illustrate the technical solutions of the embodiments of the present disclosure more clearly, the following briefly introduces the accompanying drawings that need to be used in the description of the embodiments:
图1为本发明一个实施例中的一种基于特征点提取蚁群算法的AGV路径规划方法的步骤流程图;1 is a flowchart of steps of an AGV path planning method based on feature point extraction ant colony algorithm in an embodiment of the present invention;
图2为本发明另一实施例中的一种基于特征点提取蚁群算法的AGV路径规划方法的步骤流程图;2 is a flowchart of steps of an AGV path planning method based on feature point extraction ant colony algorithm in another embodiment of the present invention;
图3为本发明一个实施例中的一种基于特征点提取蚁群算法的AGV路径规划方法中的实际环境的障碍物投影图;3 is an obstacle projection diagram of the actual environment in an AGV path planning method based on feature point extraction ant colony algorithm in an embodiment of the present invention;
图4为本发明一个实施例中的一种基于特征点提取蚁群算法的AGV路径规划方法中的实际环境的栅格图;4 is a grid diagram of an actual environment in an AGV path planning method based on feature point extraction ant colony algorithm in an embodiment of the present invention;
图5为本发明一个实施例中的一种基于特征点提取蚁群算法的AGV路径规划方法中经过编号的顶点栅格分布图;5 is a distribution diagram of numbered vertex grids in an AGV path planning method based on feature point extraction ant colony algorithm in an embodiment of the present invention;
图6为本发明一个实施例中的一种基于特征点提取蚁群算法的AGV路径规划方法中栅格可行性判断分析图;以及Fig. 6 is a grid feasibility judgment analysis diagram in an AGV path planning method based on feature point extraction ant colony algorithm in an embodiment of the present invention; and
图7为本发明一个实施例中的一种基于特征点提取蚁群算法的AGV路径规划方法中该环境下路径规划仿真结果图。FIG. 7 is a simulation result diagram of path planning in this environment in an AGV path planning method based on feature point extraction ant colony algorithm in an embodiment of the present invention.
具体实施方式Detailed ways
下面结合附图和实施例对本申请进行进一步的详细介绍。The present application will be further described in detail below with reference to the accompanying drawings and embodiments.
在下述介绍中,术语“第一”、“第二”仅为用于描述的目的,而不能理解为指示或暗示相对重要性。下述介绍提供了本公开的多个实施例,不同实施例之间可以替换或者合并组合,因此本申请也可认为包含所记载的相同和/或不同实施例的所有可能组合。因而,如果一个实施例包含特征A、B、C,另一个实施例包含特征B、D,那么本申请也应视为包括含有A、B、C、D的一个或多个所有其他可能的组合的实施例,尽管该实施例可能并未在以下内容中有明确的文字记载。In the following introduction, the terms "first" and "second" are used for descriptive purposes only, and should not be construed as indicating or implying relative importance. The following introduction provides multiple embodiments of the present disclosure, and the different embodiments may be substituted or combined in combination, so this application should also be considered to include all possible combinations of the same and/or different embodiments described. Thus, if one embodiment includes features A, B, C and another embodiment includes features B, D, the application should also be considered to include all other possible combinations of one or more of A, B, C, D example, although this example may not be explicitly described in the following content.
为了使本发明的目的、技术方案及优点更加清楚明白,以下通过实施例,并结合附图,对本发明一种基于特征点提取蚁群算法的AGV路径规划方法的具体实施方式进行进一步详细说明。需要说明的是,本公开涉及涡轮机械旋转通道近壁面边界层内速度和温度测量技术领域,应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。In order to make the purpose, technical solutions and advantages of the present invention clearer, the following examples and in conjunction with the accompanying drawings, the specific implementation of an AGV path planning method based on feature point extraction ant colony algorithm of the present invention will be further described in detail. It should be noted that the present disclosure relates to the technical field of velocity and temperature measurement in the near-wall boundary layer of a turbomachine rotating channel. It should be understood that the specific embodiments described herein are only used to explain the present invention, but not to limit the present invention.
如图1所示,为一个实施例中的一种基于特征点提取蚁群算法的AGV路径规划方法的流程示意图,具体包括以下步骤:As shown in Figure 1, it is a schematic flowchart of an AGV path planning method based on feature point extraction ant colony algorithm in one embodiment, which specifically includes the following steps:
步骤101,确定AGV运行地图中障碍物的位置,并将所述障碍物的三维位置投射到二维平面上。Step 101: Determine the position of the obstacle in the AGV operation map, and project the three-dimensional position of the obstacle on a two-dimensional plane.
步骤102,对投射至二维平面上的障碍物投影图进行分割。Step 102, segment the obstacle projection image projected onto the two-dimensional plane.
具体的,对投射至二维平面上的障碍物投影图进行分割包括:将障碍物投影图分割为大小相同的栅格,栅格的数量为a*a。Specifically, the segmentation of the obstacle projection image projected onto the two-dimensional plane includes: dividing the obstacle projection image into grids of the same size, and the number of grids is a*a.
步骤103,对分割后的障碍物投影图中的障碍物阴影进行膨胀化处理,并将设置为黑色障碍物栅格的顶点栅格作为特征点进行提取。Step 103: Dilation is performed on the shadow of the obstacle in the segmented obstacle projection map, and the vertex grid set as the black obstacle grid is extracted as a feature point.
具体的,将设置为黑色障碍物栅格的顶点栅格作为特征点进行提取包括:将所有单独黑色障碍物栅格的四个顶角栅格,所有组合黑色障碍物栅格的所有顶角和凹角栅格作为特征点进行提取。Specifically, extracting the vertex grid set as the black obstacle grid as the feature point includes: taking all the four top corner grids of all the individual black obstacle grids, all the top corners of all the combined black obstacle grids and A grid of concave corners is extracted as feature points.
具体的,对分割后的障碍物投影图中的障碍物阴影进行膨胀化处理包括:在对障碍物投影图分割后的栅格中存在障碍物的阴影,则将其设置为黑色障碍物栅格,否则设置为白色无障碍物栅格。Specifically, inflating the obstacle shadow in the segmented obstacle projection image includes: if there is an obstacle shadow in the grid after segmenting the obstacle projection image, setting it as a black obstacle grid , otherwise set to a white unobstructed grid.
步骤104,对提取出的栅格进行可行性判断并构造邻接矩阵。Step 104: Judging the feasibility of the extracted grid and constructing an adjacency matrix.
具体的,对提取出的栅格进行可行性判断并构造邻接矩阵包括:构造邻接矩阵D,其大小为a2*a2。Specifically, judging the feasibility of the extracted grid and constructing an adjacency matrix includes: constructing an adjacency matrix D, the size of which is a 2 *a 2 .
进一步地,对提取出的栅格进行可行性判断包括:若两个顶点栅格之间存在黑色障碍物栅格,则判定两个顶点栅格不可见,互为不可行栅格;若两个顶点栅格之间不存在黑色障碍物栅格,则判断两个顶点栅格的连线是否经过黑色障碍物栅格的顶点,若经过黑色障碍物栅格的顶点,则判定两个顶点栅格不可见,互为不可行栅格,若不经过黑色障碍物栅格的顶点,则判定两个顶点栅格可见,互为可行栅格。Further, judging the feasibility of the extracted grid includes: if there is a black obstacle grid between the two vertex grids, then determining that the two vertex grids are invisible and are mutually infeasible grids; If there is no black obstacle grid between the vertex grids, it is judged whether the connection line between the two vertex grids passes through the vertex of the black obstacle grid. If it passes through the vertex of the black obstacle grid, the two vertex grids are judged. Invisible, they are mutually infeasible grids. If the vertex of the black obstacle grid is not passed, it is determined that the two vertex grids are visible and mutually feasible grids.
步骤105,对蚁群算法的多个初始参数值进行设置并将当前代所有蚂蚁置于起点进行路径搜索。Step 105: Set multiple initial parameter values of the ant colony algorithm and place all ants of the current generation at the starting point to perform a path search.
具体的,对蚁群算法的多个初始参数值进行设置包括:m为每代种群蚂蚁的数量,n为蚂蚁总共的代数,τ(0)为初始信息素浓度;Specifically, the setting of multiple initial parameter values of the ant colony algorithm includes: m is the number of ants in each generation, n is the total number of generations of ants, and τ(0) is the initial pheromone concentration;
禁忌表Tabu为细胞结构大小为m*n,用以记录每一只蚂蚁行走的路线,路径长度矩阵PL的大小为m*n,用以记录每一代每一只蚂蚁爬行的路线长度;Tabu table Tabu is the cell structure size of m*n, which is used to record the route that each ant walks, and the size of the path length matrix PL is m*n, which is used to record the length of the route that each ant crawls in each generation;
初始化信息素衰减系数ρ,信息素启发因子α,距离启发因子β,迭代次数t;以及对起点和终点的初始参数值进行设置。Initialize the pheromone decay coefficient ρ, the pheromone heuristic factor α, the distance heuristic factor β, the number of iterations t; and set the initial parameter values of the starting point and the ending point.
步骤106,根据转移概率以及构造的所述邻接矩阵中的非0栅格选择下一个栅格直至到达终点。Step 106: Select the next grid according to the transition probability and the non-zero grid in the constructed adjacency matrix until the end point is reached.
具体的,转移概率公式为:Specifically, the transition probability formula is:
其中,τij(t)为在迭代次数为t时栅格i与j之间的信息素浓度,为迭代次数为t时栅格i与j之间的距离启发函数,alloweds为邻接矩阵D中,D(i,s)≠0时s代表的栅格。where τ ij (t) is the pheromone concentration between grids i and j when the iteration number is t, is the distance heuristic function between grids i and j when the number of iterations is t, and allowed s is the grid represented by s when D(i, s)≠0 in the adjacency matrix D.
此外,在一个实施例中,本公开提出的基于特征点提取蚁群算法AGV路径规划方法还包括:判断当前代所有蚂蚁是否全部完成路径搜索,若全部完成搜索,则记录一次迭代次数,其中,迭代次数t=t+1;判断迭代次数t是否满足迭代次数的要求,若满足则输出最短路径;若不满足迭代次数的要求,则更新信息素并执行派出下一代蚂蚁操作;将派出的下一代蚂蚁操作视为当前代,将当前代所有蚂蚁置于起点执行路径搜索。In addition, in one embodiment, the AGV path planning method based on the feature point extraction ant colony algorithm proposed by the present disclosure further includes: judging whether all the ants of the current generation have completed the path search, and if the search has been completed, recording the number of iterations once, wherein, The number of iterations t=t+1; judge whether the number of iterations t meets the requirements of the number of iterations, and if so, output the shortest path; if it does not meet the requirements of the number of iterations, update the pheromone and perform the operation of dispatching the next generation of ants; The operation of a generation of ants is regarded as the current generation, and all ants of the current generation are placed at the starting point to perform a path search.
其中,需要说明的是,信息素公式为Among them, it should be noted that the pheromone formula is
τij(t+1)=(1-ρ)τij(t)+Δτij(t)τ ij (t+1)=(1-ρ)τ ij (t)+Δτ ij (t)
其中,τij(k+1)为在迭代次数为t时,栅格i和j之间的信息素浓度,Δτij(t)为当前代蚂蚁在栅格i和j之间留下的信息素增量之和,为在迭代次数为t时,第k只蚂蚁在栅格i和j之间留下的信息素增量。Among them, τ ij (k+1) is the pheromone concentration between grids i and j when the number of iterations is t, and Δτ ij (t) is the information left by the current generation of ants between grids i and j sum of prime increments, is the pheromone increment left by the kth ant between grids i and j when the number of iterations is t.
进一步地,在一个实施例中,本公开提出的基于特征点提取蚁群算法AGV路径规划方法还包括:判断当前代所有蚂蚁是否全部完成路径搜索,若未全部完成搜索,则根据转移概率以及所述邻接矩阵中的非0栅格选择下一个栅格直至到达终点。Further, in one embodiment, the AGV path planning method based on the feature point extraction ant colony algorithm proposed by the present disclosure further includes: judging whether all ants of the current generation have completed the path search; The non-zero grid in the adjacency matrix selects the next grid until the end point is reached.
综上所述可知,现有的路径规划方法中,算法往往是从全部栅格中层层扩展,逐格规划来得到从起点到终点的无障碍物路径的,这会使算法的计算量过大,搜索的非最优解过多,造成算法效率低,迭代次数过多的问题,本发明对栅格图进行特征点提取的处理,将算法的搜索范围从所有栅格缩小到所有黑色障碍物栅格的顶点栅格,可减少算法的计算量,加快收敛速度。To sum up, in the existing path planning methods, the algorithm is often extended from all grids layer by layer, and the obstacle-free path from the starting point to the end point is obtained by grid-by-grid planning, which will make the calculation of the algorithm too large. , there are too many non-optimal solutions to search, resulting in the problem of low algorithm efficiency and too many iterations. The present invention extracts feature points from the grid image, and reduces the search range of the algorithm from all grids to all black obstacles. The vertex grid of the grid can reduce the calculation amount of the algorithm and speed up the convergence speed.
进一步地,现有的栅格间可行性判断,是通过判断当前栅格周围的八个栅格是否为障碍物栅格来判断的,若为黑色障碍物栅格,则两个栅格之间不可行,若为白色非障碍物栅格,则两个栅格之间是可行的,这会造成规划出的路径无法避开黑色障碍物栅格的顶角,从而影响AGV运行的安全性,本发明采用的新的栅格可行性判断将经过黑色障碍物栅格顶点的路径设为不可行路径,使规划出的路径更加安全平滑,有利于AGV的运行。Further, the existing feasibility judgment between grids is judged by judging whether the eight grids around the current grid are obstacle grids. Not feasible. If it is a white non-obstacle grid, it is feasible between the two grids, which will cause the planned path to be unable to avoid the top corner of the black obstacle grid, thus affecting the safety of AGV operation. The new grid feasibility judgment adopted by the present invention sets the path passing through the vertex of the black obstacle grid as an infeasible path, so that the planned path is safer and smoother, which is beneficial to the operation of the AGV.
本公开提出的基于特征点提取蚁群算法的AGV路径规划方法克服了传统蚁群算法逐点搜索效率低下的问题,有效地节约了计算的时间,提高搜索效率,使规划出的路径更加平滑;同时,新的栅格可行性判断方法,可以有效解决规划出的路径距离障碍物过近的缺点,更有利于AGV的安全可靠运行。The AGV path planning method based on the feature point extraction ant colony algorithm proposed in the present disclosure overcomes the problem of low point-by-point search efficiency of the traditional ant colony algorithm, effectively saves calculation time, improves search efficiency, and makes the planned path smoother; At the same time, the new grid feasibility judgment method can effectively solve the disadvantage that the planned path is too close to the obstacle, which is more conducive to the safe and reliable operation of the AGV.
为了更清楚地理解与应用本公开提出的基于特征点提取蚁群算法的AGV路径规划方法,进行以下示例。需要说明的是,本公开所保护的范围不限于以下示例。In order to more clearly understand and apply the AGV path planning method based on the feature point extraction ant colony algorithm proposed in the present disclosure, the following example is performed. It should be noted that the scope of protection of the present disclosure is not limited to the following examples.
具体的,如图2-图7所示,图2为本发明另一实施例中的一种基于特征点提取蚁群算法的AGV路径规划方法的步骤流程图。具体步骤如下Specifically, as shown in FIGS. 2-7 , FIG. 2 is a flowchart of steps of an AGV path planning method based on feature point extraction ant colony algorithm in another embodiment of the present invention. Specific steps are as follows
S1:确定AGV运行地图中障碍物的位置,并将三维障碍物投影到二维平面上,障碍物投影图如图3所示。S1: Determine the position of the obstacles in the AGV operation map, and project the three-dimensional obstacles onto the two-dimensional plane. The obstacle projection map is shown in Figure 3.
S2:对障碍物投影图进行分割,将其分割为大小相同的栅格,栅格的数量为a*a。S2: Divide the obstacle projection map into grids of the same size, and the number of grids is a*a.
S3:将障碍物阴影膨胀化,只要该栅格中存在障碍物的阴影,则将其设置为黑色障碍物栅格,否则为白色无障碍物栅格,栅格图如图4所示。S3: Inflate the shadow of the obstacle. As long as the shadow of the obstacle exists in the grid, it is set to a black obstacle grid, otherwise it is a white obstacle-free grid, as shown in Figure 4.
S4:将黑色障碍物栅格的顶点栅格作为特征点提取出来,经过编号的顶点栅格分布图如图5所示。S4: Extract the vertex grid of the black obstacle grid as a feature point, and the numbered vertex grid distribution diagram is shown in Figure 5.
S5:对提取出的顶点栅格进行可行性判断,重新构造邻接矩阵D,其大小为a2*a2。S5: Judging the feasibility of the extracted vertex grid, and reconstructing the adjacency matrix D, the size of which is a 2 *a 2 .
S6:设定蚁群算法的初始参数值:m为每代种群蚂蚁的数量,n为蚂蚁总共的代数,τ(0)为初始信息素浓度,禁忌表Tabu为细胞结构大小为m*n,用以记录每一只蚂蚁行走的路线,路径长度矩阵PL的大小为m*n,用以记录每一代每一只蚂蚁爬行的路线长度;同时初始化信息素衰减系数ρ,信息素启发因子α,距离启发因子β,迭代次数t,以及起点和终点。S6: Set the initial parameter value of the ant colony algorithm: m is the number of ants in each generation, n is the total number of generations of ants, τ(0) is the initial pheromone concentration, Tabu is the cell structure size of m*n, It is used to record the route that each ant walks. The size of the path length matrix PL is m*n, which is used to record the length of the route that each ant crawls in each generation; at the same time, the pheromone attenuation coefficient ρ and the pheromone heuristic factor α are initialized. The distance heuristic factor β, the number of iterations t, and the start and end points.
S7:将当前代所有蚂蚁置于起点,开始进行路径搜索。S7: Put all the ants of the current generation at the starting point, and start the path search.
S8:根据转移概率以及邻接矩阵中的非0栅格选择下一个栅格,直到到达终点,完成一次路径搜索。S8: Select the next grid according to the transition probability and the non-zero grid in the adjacency matrix, until the end point is reached, and a path search is completed.
S9:判断当前代所有蚂蚁是否全部完成路径搜索,若全部完成搜索,进入S10,否则返回S8。S9: Determine whether all the ants of the current generation have completed the path search, if all the search is completed, go to S10, otherwise return to S8.
S10:记录一次迭代次数,t=t+1。S10: record the number of iterations, t=t+1.
S11:判断迭代次数t是否满足迭代次数的要求,若满足则输出最短路径,否则,进入S12,最终得到的最优路线如图7所示。S11: Determine whether the number of iterations t meets the requirements of the number of iterations, and if so, output the shortest path, otherwise, enter S12, and the final optimal route is shown in Figure 7.
S12:更新信息素,并派出下一代蚂蚁,返回S7。S12: Update the pheromone, and send the next generation of ants, and return to S7.
进一步,所述步骤S4中,提取的特征点包括:所有单独黑色障碍物栅格的四个顶角,所有组合黑色障碍物栅格的所有顶角和凹角。Further, in the step S4, the extracted feature points include: four vertex angles of all individual black obstacle grids, and all vertex angles and concave corners of all combined black obstacle grids.
进一步,所述步骤S5中,栅格可行性判断的方法为,如图6所示,若两个顶点栅格之间存在黑色障碍物栅格,则判定两个顶点栅格不可见,互为不可行栅格;若两个顶点栅格之间不存在黑色障碍物栅格,则判断两个顶点栅格的连线是否经过黑色障碍物栅格的顶点,若经过黑色障碍物栅格的顶点,则判定两个顶点栅格不可见,互为不可行栅格,若不经过黑色障碍物栅格的顶点,则判定两个顶点栅格可见,互为可行栅格。Further, in the step S5, the method for judging the feasibility of the grid is, as shown in FIG. 6 , if there is a black obstacle grid between the two vertex grids, it is determined that the two vertex grids are not visible, and they are each other. Infeasible grid; if there is no black obstacle grid between the two vertex grids, judge whether the line connecting the two vertex grids passes through the vertices of the black obstacle grid. , then it is determined that the two vertex grids are invisible and mutually infeasible grids. If the vertex of the black obstacle grid is not passed, the two vertex grids are determined to be visible and mutually feasible grids.
进一步,所述步骤S8中,蚂蚁选择下一个栅格的转移概率公式为:Further, in the step S8, the transition probability formula for the ants to select the next grid is:
其中,τij(t)为在迭代次数为t时栅格i与j之间的信息素浓度,为迭代次数为t时栅格i与j之间的距离启发函数,alloweds为邻接矩阵D中,D(i,s)≠0时s代表的栅格。where τ ij (t) is the pheromone concentration between grids i and j when the iteration number is t, is the distance heuristic function between grids i and j when the number of iterations is t, and allowed s is the grid represented by s when D(i, s)≠0 in the adjacency matrix D.
进一步,所述步骤S12中,信息素的更新公式为:Further, in the step S12, the update formula of the pheromone is:
τij(t+1)=(1-ρ)τij(t)+Δτij(t) (2)τ ij (t+1)=(1-ρ)τ ij (t)+Δτ ij (t) (2)
其中,τij(k+1)为在迭代次数为t时,栅格i和j之间的信息素浓度,Δτij(t)为当前代蚂蚁在栅格i和j之间留下的信息素增量之和,为在迭代次数为t时,第k只蚂蚁在栅格i和j之间留下的信息素增量。Among them, τ ij (k+1) is the pheromone concentration between grids i and j when the number of iterations is t, and Δτ ij (t) is the information left by the current generation of ants between grids i and j sum of prime increments, is the pheromone increment left by the kth ant between grids i and j when the number of iterations is t.
综上所述,本公开提出的一种基于特征点提取蚁群算法的AGV路径规划方法克服了传统蚁群算法路径规划存在的弊端,通过提取特征点和新的栅格可行性判断方法,提高了算法的效率,规划出的路径更加安全平滑,得到了更优的结果。与此同时,该方法可以减少路径规划时算法的计算量,同时使规划出的路径更加安全平滑,有利于AGV安全可靠地运行。To sum up, the AGV path planning method based on the feature point extraction ant colony algorithm proposed in the present disclosure overcomes the drawbacks of the traditional ant colony algorithm path planning, and improves the performance by extracting feature points and a new grid feasibility judgment method. The efficiency of the algorithm is improved, the planned path is safer and smoother, and better results are obtained. At the same time, this method can reduce the calculation amount of the algorithm during path planning, and at the same time make the planned path safer and smoother, which is conducive to the safe and reliable operation of the AGV.
本发明提供的一种基于特征点提取蚁群算法的AGV路径规划方法,该方法包括环境建模和路径规划,环境建模包括栅格图的建立和特征点的提取,根据预先知道的AGV环境地图信息,将三维障碍物投影到二维平面栅格图后,将障碍物投影图分割为大小相同的栅格,再将障碍物阴影进行膨胀化,得到初始栅格图,将其中黑色障碍物栅格的顶点提取出来,并通过栅格可行性判断重新构造邻接矩阵,利用蚁群算法在特征点之间进行路径规划,最终得到一条从起点到终点的无障碍物路径。该方法本发明的AGV路径规划方法,克服了传统蚁群算法逐点搜索效率低下的问题,有效地节约了计算的时间,提高搜索效率,使规划出的路径更加平滑;同时,新的栅格可行性判断方法,可以有效解决规划出的路径距离障碍物过近的缺点,更有利于AGV的安全可靠运行。The invention provides an AGV path planning method based on feature point extraction ant colony algorithm. The method includes environment modeling and path planning. The environment modeling includes the establishment of a grid map and the extraction of feature points. According to the pre-known AGV environment Map information, after projecting the three-dimensional obstacles to the two-dimensional plane grid map, divide the obstacle projection map into grids of the same size, and then inflate the shadow of the obstacles to obtain the initial grid map, in which the black obstacles are divided The vertices of the grid are extracted, and the adjacency matrix is reconstructed by judging the feasibility of the grid. The ant colony algorithm is used to plan the path between the feature points, and finally an obstacle-free path from the starting point to the end point is obtained. This method The AGV path planning method of the present invention overcomes the problem of low point-by-point search efficiency of the traditional ant colony algorithm, effectively saves calculation time, improves search efficiency, and makes the planned path smoother; at the same time, the new grid The feasibility judgment method can effectively solve the disadvantage that the planned path is too close to the obstacle, and is more conducive to the safe and reliable operation of the AGV.
本发明实施例还提供了一种计算机可读存储介质,该计算机可读存储介质上存储有计算机程序,该程序被图1中处理器执行。An embodiment of the present invention further provides a computer-readable storage medium, where a computer program is stored on the computer-readable storage medium, and the program is executed by the processor in FIG. 1 .
本发明实施例还提供了一种包含指令的计算机程序产品。当该计算机程序产品在计算机上运行时,使得计算机执行上述图1的方法。Embodiments of the present invention also provide a computer program product including instructions. When the computer program product is run on a computer, the computer is caused to perform the method of FIG. 1 described above.
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)或随机存储记忆体(Random AccessMemory,RAM)等。Those of ordinary skill in the art can understand that all or part of the processes in the methods of the above embodiments can be implemented by instructing relevant hardware through a computer program, and the program can be stored in a computer-readable storage medium. During execution, the processes of the embodiments of the above-mentioned methods may be included. The storage medium may be a magnetic disk, an optical disk, a read-only memory (Read-Only Memory, ROM), or a random access memory (Random Access Memory, RAM) or the like.
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对本发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。The above-mentioned embodiments only represent several embodiments of the present invention, and the descriptions thereof are specific and detailed, but should not be construed as a limitation on the scope of the patent of the present invention. It should be pointed out that for those of ordinary skill in the art, without departing from the concept of the present invention, several modifications and improvements can also be made, which all belong to the protection scope of the present invention. Therefore, the protection scope of the patent of the present invention should be subject to the appended claims.
以上结合具体实施例描述了本公开的基本原理,但是,需要指出的是,在本公开中提及的优点、优势、效果等仅是示例而非限制,不能认为这些优点、优势、效果等是本公开的各个实施例必须具备的。另外,上述公开的具体细节仅是为了示例的作用和便于理解的作用,而非限制,上述细节并不限制本公开为必须采用上述具体的细节来实现。The basic principles of the present disclosure have been described above with reference to specific embodiments. However, it should be pointed out that the advantages, advantages, effects, etc. mentioned in the present disclosure are only examples rather than limitations, and these advantages, advantages, effects, etc. should not be considered to be A must-have for each embodiment of the present disclosure. In addition, the specific details disclosed above are only for the purpose of example and easy understanding, but not for limitation, and the above details do not limit the present disclosure to be implemented by using the above specific details.
本公开中涉及的器件、装置、设备、系统的方框图仅作为示例性的例子并且不意图要求或暗示必须按照方框图示出的方式进行连接、布置、配置。如本领域技术人员将认识到的,可以按任意方式连接、布置、配置这些器件、装置、设备、系统。诸如“包括”、“包含”、“具有”等等的词语是开放性词汇,指“包括但不限于”,且可与其互换使用。这里所使用的词汇“或”和“和”指词汇“和/或”,且可与其互换使用,除非上下文明确指示不是如此。这里所使用的词汇“诸如”指词组“诸如但不限于”,且可与其互换使用。The block diagrams of devices, apparatuses, apparatuses, and systems referred to in this disclosure are merely illustrative examples and are not intended to require or imply that they must be connected, arranged, or configured in the manner shown in the block diagrams. As those skilled in the art will appreciate, these means, apparatuses, apparatuses, systems may be connected, arranged, configured in any manner. Words such as "including", "including", "having" and the like are open-ended words meaning "including but not limited to" and are used interchangeably therewith. As used herein, the words "or" and "and" refer to and are used interchangeably with the word "and/or" unless the context clearly dictates otherwise. As used herein, the word "such as" refers to and is used interchangeably with the phrase "such as but not limited to".
另外,如在此使用的,在以“至少一个”开始的项的列举中使用的“或”指示分离的列举,例如“A、B或C的至少一个”的列举意味着A或B或C,或AB或AC或BC,或ABC(即A和B和C)。此外,措辞“示例的”不意味着描述的例子是优选的或者比其他例子更好。Also, as used herein, the use of "or" in a listing of items beginning with "at least one" indicates a separate listing, eg, a listing of "at least one of A, B, or C" means A or B or C , or AB or AC or BC, or ABC (ie A and B and C). Furthermore, the word "exemplary" does not imply that the described example is preferred or better than other examples.
为了示例和描述的目的已经给出了以上描述。但此描述不意味着将本公开的实施例限制到在此公开的形式。The foregoing description has been presented for the purposes of illustration and description. This description, however, is not meant to limit embodiments of the present disclosure to the forms disclosed herein.
Claims (10)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910657050.XA CN110442128B (en) | 2019-07-20 | 2019-07-20 | AGV path planning method based on characteristic point extraction ant colony algorithm |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910657050.XA CN110442128B (en) | 2019-07-20 | 2019-07-20 | AGV path planning method based on characteristic point extraction ant colony algorithm |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110442128A true CN110442128A (en) | 2019-11-12 |
| CN110442128B CN110442128B (en) | 2022-08-16 |
Family
ID=68430977
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201910657050.XA Active CN110442128B (en) | 2019-07-20 | 2019-07-20 | AGV path planning method based on characteristic point extraction ant colony algorithm |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110442128B (en) |
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111413965A (en) * | 2020-03-11 | 2020-07-14 | 西安工程大学 | A UGV driving path planning method based on UAV collaborative perception |
| CN112099493A (en) * | 2020-08-31 | 2020-12-18 | 西安交通大学 | An autonomous mobile robot trajectory planning method, system and device |
| CN112528444A (en) * | 2020-12-04 | 2021-03-19 | 国网浙江省电力有限公司嘉兴供电公司 | Three-dimensional design method and system for power transmission line |
| CN112669466A (en) * | 2020-12-23 | 2021-04-16 | 北京像素软件科技股份有限公司 | Virtual space path planning method and device, electronic equipment and storage medium |
| CN114254564A (en) * | 2021-12-21 | 2022-03-29 | 东软集团股份有限公司 | Method, device, storage medium and electronic equipment for determining drilling path |
| CN115268423A (en) * | 2022-05-05 | 2022-11-01 | 安徽理工大学 | Improved ant colony algorithm-based train food delivery robot path planning method |
| CN117670162A (en) * | 2023-12-06 | 2024-03-08 | 珠海市格努信息技术有限公司 | Intelligent logistics solving method in field |
Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103439972A (en) * | 2013-08-06 | 2013-12-11 | 重庆邮电大学 | Path planning method of moving robot under dynamic and complicated environment |
| CN103472828A (en) * | 2013-09-13 | 2013-12-25 | 桂林电子科技大学 | Mobile robot path planning method based on improvement of ant colony algorithm and particle swarm optimization |
| CN104535061A (en) * | 2015-01-06 | 2015-04-22 | 常州先进制造技术研究所 | Navigation system based on multi-sensor data fusion |
| US20160171316A1 (en) * | 2014-12-10 | 2016-06-16 | Honda Research Institute Europe Gmbh | Method and system for adaptive ray based scene analysis of semantic traffic spaces and vehicle equipped with such system |
| CN106200650A (en) * | 2016-09-22 | 2016-12-07 | 江苏理工学院 | Mobile robot path planning method and system based on improved ant colony algorithm |
| CN106599936A (en) * | 2016-12-29 | 2017-04-26 | 湖北工业大学 | Characteristic selection method based on binary ant colony algorithm and system thereof |
| CN107092252A (en) * | 2017-04-11 | 2017-08-25 | 杭州光珀智能科技有限公司 | A kind of robot automatic obstacle avoidance method and its device based on machine vision |
| CN108413963A (en) * | 2018-02-12 | 2018-08-17 | 淮安信息职业技术学院 | Bar-type machine people's paths planning method based on self study ant group algorithm |
| CN108827309A (en) * | 2018-06-29 | 2018-11-16 | 炬大科技有限公司 | A kind of robot path planning method and the dust catcher with it |
-
2019
- 2019-07-20 CN CN201910657050.XA patent/CN110442128B/en active Active
Patent Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103439972A (en) * | 2013-08-06 | 2013-12-11 | 重庆邮电大学 | Path planning method of moving robot under dynamic and complicated environment |
| CN103472828A (en) * | 2013-09-13 | 2013-12-25 | 桂林电子科技大学 | Mobile robot path planning method based on improvement of ant colony algorithm and particle swarm optimization |
| US20160171316A1 (en) * | 2014-12-10 | 2016-06-16 | Honda Research Institute Europe Gmbh | Method and system for adaptive ray based scene analysis of semantic traffic spaces and vehicle equipped with such system |
| CN104535061A (en) * | 2015-01-06 | 2015-04-22 | 常州先进制造技术研究所 | Navigation system based on multi-sensor data fusion |
| CN106200650A (en) * | 2016-09-22 | 2016-12-07 | 江苏理工学院 | Mobile robot path planning method and system based on improved ant colony algorithm |
| CN106599936A (en) * | 2016-12-29 | 2017-04-26 | 湖北工业大学 | Characteristic selection method based on binary ant colony algorithm and system thereof |
| CN107092252A (en) * | 2017-04-11 | 2017-08-25 | 杭州光珀智能科技有限公司 | A kind of robot automatic obstacle avoidance method and its device based on machine vision |
| CN108413963A (en) * | 2018-02-12 | 2018-08-17 | 淮安信息职业技术学院 | Bar-type machine people's paths planning method based on self study ant group algorithm |
| CN108827309A (en) * | 2018-06-29 | 2018-11-16 | 炬大科技有限公司 | A kind of robot path planning method and the dust catcher with it |
Non-Patent Citations (6)
| Title |
|---|
| JIANG ZHAO;WENYAN XUE;CHONGQING HAO: "Heterogeneous Feature Ant Colony Optimization Algorithm Based on Effective Vertexes of Obstacles", 《2018 CHINESE AUTOMATION CONGRESS (CAC)》 * |
| JIANG ZHAO;YAZHE DING;CHANG TIAN;CHONGQIGN HAO;LINGGANG MENG: "Path planning of the Omni-directional Mobile Vehicle in Warehouse environment", 《2017 CHINESE AUTOMATION CONGRESS (CAC)》 * |
| 刘琳琳: "基于栅格地图环境的机器人路径规划算法", 《机电信息》 * |
| 张晓玲等: "基于蚁群算法的移动机器人路径规划", 《激光杂志》 * |
| 成伟明: "移动机器人自主导航中的路径规划与跟踪控制技术研究", 《中国优秀博硕士学位论文全文数据库(博士)信息科技辑》 * |
| 薛文艳: "地面机器人路径规划及其控制研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111413965A (en) * | 2020-03-11 | 2020-07-14 | 西安工程大学 | A UGV driving path planning method based on UAV collaborative perception |
| CN112099493A (en) * | 2020-08-31 | 2020-12-18 | 西安交通大学 | An autonomous mobile robot trajectory planning method, system and device |
| CN112099493B (en) * | 2020-08-31 | 2021-11-19 | 西安交通大学 | Autonomous mobile robot trajectory planning method, system and equipment |
| CN112528444A (en) * | 2020-12-04 | 2021-03-19 | 国网浙江省电力有限公司嘉兴供电公司 | Three-dimensional design method and system for power transmission line |
| CN112669466A (en) * | 2020-12-23 | 2021-04-16 | 北京像素软件科技股份有限公司 | Virtual space path planning method and device, electronic equipment and storage medium |
| CN114254564A (en) * | 2021-12-21 | 2022-03-29 | 东软集团股份有限公司 | Method, device, storage medium and electronic equipment for determining drilling path |
| CN115268423A (en) * | 2022-05-05 | 2022-11-01 | 安徽理工大学 | Improved ant colony algorithm-based train food delivery robot path planning method |
| CN117670162A (en) * | 2023-12-06 | 2024-03-08 | 珠海市格努信息技术有限公司 | Intelligent logistics solving method in field |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110442128B (en) | 2022-08-16 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110442128B (en) | AGV path planning method based on characteristic point extraction ant colony algorithm | |
| CN112417539B (en) | House type design method, device and system based on language description | |
| CN112036512B (en) | Image classification neural network architecture searching method and device based on network clipping | |
| CN109101694B (en) | A kind of the crowd behaviour emulation mode and system of the guidance of safe escape mark | |
| CN110220525A (en) | A kind of paths planning method based on potential field ant group algorithm | |
| CN111678524A (en) | A flight safety-based rescue aircraft path planning method and system | |
| CN106225788A (en) | The robot path planning method of ant group algorithm is expanded based on path | |
| CN111080786B (en) | Indoor map model construction method and device based on BIM | |
| KR102434949B1 (en) | Artificial intelligence-based route re-planning method and apparatus for autonomous vehicles | |
| CN104392283A (en) | Artificial fish swarm algorithm based traffic route searching method | |
| CN112947591A (en) | Path planning method, device, medium and unmanned aerial vehicle based on improved ant colony algorithm | |
| CN106710316B (en) | A kind of airspace capacity based on bad weather condition determines method and device | |
| CN109357678A (en) | A Multi-UAV Path Planning Method Based on Heterogeneous Pigeon Swarm Optimization Algorithm | |
| CN113189988A (en) | Autonomous path planning method based on Harris algorithm and RRT algorithm composition | |
| CN111179374A (en) | A method, system and electronic device for constructing an indoor navigation network structure diagram | |
| CN115017566A (en) | Secondary beam structure generation method based on BIM platform and related equipment | |
| WO2024164952A1 (en) | Map generation method and apparatus, and computer device and storage medium | |
| CN112270758A (en) | A method of building room contour extraction based on ceiling point cloud segmentation | |
| CN117784803A (en) | Unmanned aerial vehicle path planning method and system based on global improvement ant colony algorithm | |
| CN111744199A (en) | Image processing method and device, computer readable storage medium and electronic device | |
| CN116661502A (en) | A path planning method for intelligent agricultural UAV | |
| CN106485211B (en) | An accurate positioning method of text line based on binary tree | |
| CN111986223A (en) | A method for tree extraction in outdoor point cloud scene based on energy function | |
| CN118640894B (en) | Method and system for automatically generating lightweight environmental maps for robot inspection of buildings | |
| CN120385348A (en) | Key point path planning method and device based on distance transformation |
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 | ||
| EE01 | Entry into force of recordation of patent licensing contract |
Application publication date: 20191112 Assignee: SHIJIAZHUANG JIAKE ELECTROMECHANICAL TECHNOLOGY Co.,Ltd. Assignor: HEBEI University OF SCIENCE AND TECHNOLOGY Contract record no.: X2023980043391 Denomination of invention: AGV Path Planning Method Based on Ant Colony Algorithm for Feature Point Extraction Granted publication date: 20220816 License type: Common License Record date: 20231013 |
|
| EE01 | Entry into force of recordation of patent licensing contract |