CN109445444B - Robot path generation method under barrier concentration environment - Google Patents

Robot path generation method under barrier concentration environment Download PDF

Info

Publication number
CN109445444B
CN109445444B CN201811592363.3A CN201811592363A CN109445444B CN 109445444 B CN109445444 B CN 109445444B CN 201811592363 A CN201811592363 A CN 201811592363A CN 109445444 B CN109445444 B CN 109445444B
Authority
CN
China
Prior art keywords
point
path
random
algorithm
search
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.)
Active
Application number
CN201811592363.3A
Other languages
Chinese (zh)
Other versions
CN109445444A (en
Inventor
刘成菊
姚陈鹏
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tongji University
Original Assignee
Tongji University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Tongji University filed Critical Tongji University
Priority to CN201811592363.3A priority Critical patent/CN109445444B/en
Publication of CN109445444A publication Critical patent/CN109445444A/en
Application granted granted Critical
Publication of CN109445444B publication Critical patent/CN109445444B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control 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

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)
  • Manipulator (AREA)
  • Feedback Control In General (AREA)

Abstract

The invention relates to a robot path generating method under an obstacle concentration environment, which comprises the steps of firstly, carrying out path search by using an RRT algorithm; when the random point is invalid, the point is directly abandoned by the traditional RRT algorithm to be further judged; if the longest effective distance between the random point and the connection line of the target point is smaller than a threshold value, converting the random point and the connection line of the target point into an A-algorithm to search until the end, otherwise, continuing to search the RRT algorithm and repeating the judgment; the final path is composed of the path obtained by RRT search and the path obtained by A-search. Compared with the prior art, the method combines the advantages of A and RRT algorithms in the environment of concentrated obstacles, overcomes respective short boards, and ensures that the whole planning algorithm has the advantages of high efficiency, short search time and the like.

Description

Robot path generation method under barrier concentration environment
Technical Field
The invention relates to the technical field of robot control, in particular to a robot path generation method in an obstacle concentration environment.
Background
In order to make the robot walk in daily life, collision-free fixed-point movement of the robot is the most basic and irrecoverable problem, and the path planning algorithm provides possibility for solving the problem. Completeness and optimality are two important indexes for evaluating a robot path planning algorithm. The completeness refers to that the algorithm can find a feasible path in any scene, and the optimality refers to that the distance of the path found by the algorithm is shortest. In addition, the rapidity of the algorithm, i.e. the time required to obtain the path, is also an important reference index.
Existing path planning algorithms are mainly classified into two categories. The first type is a graph search algorithm represented by Dijkstra algorithm and a-x algorithm. The Dijkstra algorithm is an approximately exhaustive method, radiates around a starting point, and is optimal and complete, but as the scale of an application scene becomes larger, the disadvantage of the Dijkstra algorithm in the time consumption of searching becomes more obvious. The A algorithm is improved aiming at the problems of the Dijkstra algorithm, and the searching direction of the Dijkstra algorithm is guided to a certain extent by introducing a heuristic function mode, so that the aim of shortening the running time is fulfilled, but the corresponding path is changed from optimal to suboptimal, so that the A algorithm is a complete but non-optimal algorithm. The other type of algorithm is an algorithm based on a sampling mode represented by a fast-expansion random tree (RRT) and a variety thereof, the algorithm generates a tree structure in a random point scattering mode, and a feasible path is extracted from the tree structure.
The existing path planning algorithm has respective advantages and applicability in a small-scale simple scene, but is gradually not applicable in a large-scale complex scene. Consider the following practical application scenario, assuming that the robot needs to reach a specific location in a certain house along a long-distance open road to complete a specific task, the schematic diagram is shown in fig. 1, S is the starting location of the robot, G is the target location, and the black part is an area of different rows (i.e. an obstacle). If a graph search algorithm is adopted to search for a path, a large amount of search time is consumed due to the large range of the whole scene, although the random sampling algorithm can be rapidly expanded to the vicinity of a G point, the RRT algorithm is difficult to enter a target area (in a room) due to the existence of a narrow channel, and the existing algorithm is difficult to directly apply to the barrier concentration environment.
Disclosure of Invention
The present invention is directed to a method for generating a robot path in an obstacle concentrated environment, which overcomes the above-mentioned drawbacks of the prior art.
The purpose of the invention can be realized by the following technical scheme:
a robot path generating method under the concentrated environment of barrier, said method uses RRT algorithm to search and construct and expand the random tree at first, while producing the invalid random point, judge whether the longest effective distance on the connecting line of the random point and target point is smaller than the threshold value, if yes, convert into A algorithm and search to finish, if no, continue RRT algorithm search, and repeat the above-mentioned judgement; the final path is composed of the path obtained by RRT search and the path obtained by A-search.
Further, the method specifically comprises the following steps:
1) establishing a random tree;
2) generating a random point, judging whether the random point is in the barrier, if so, discarding the random point, repeating the step 2), and if not, executing the step 3);
3) obtaining a connecting line between a random point and the nearest point in the random tree, judging whether the connecting line passes through an obstacle, if so, executing the step 4), otherwise, reserving the connecting line, adding the random point into the random tree, and executing the step 5);
4) judging whether the longest effective distance between the random point and the target point on the connection line is smaller than a set threshold, if so, using an A-star algorithm to perform local search to the target point to obtain a first path, executing the step 6), and if not, returning to the step 2);
5) judging whether the random point is a target point, if so, executing the step 6), and if not, returning to the step 2);
6) and optimizing the random tree to obtain a second path, if the first path exists, connecting the first path and the second path to form a final path, and if the first path does not exist, directly taking the second path as the final path.
Further, in the step 4), the longest effective distance between the random point and the connection line of the target point is obtained by:
taking a replacing point on the connecting line in the step 3), wherein the replacing point is farthest from the closest point and a new connecting line formed between the replacing point and the closest point does not pass through an obstacle, and taking the connecting line distance between the replacing point and the target point as the longest effective distance.
Further, in the step 4), when the local search is performed by using the a-x algorithm, the substitute point is used as a starting point, and the substitute point is added to the random tree.
Compared with the prior art, the method provided by the invention takes the unconnected random points as a basis for judging whether the unconnected random points reach a small-scale complex area, if the threshold judgment result is that the unconnected random points are close to the target area, the A-star algorithm is used for searching, the target point is quickly reached, and finally two steps of paths are extracted and integrated, so that the method has the following beneficial effects:
1) aiming at the path planning problem under the environment of concentrating the obstacles, the invention firstly carries out rapid search under a large-scale simple environment, judges whether the small-scale complex environment is reached or not according to a threshold condition, and carries out rapid search by an A-x algorithm in the small-scale complex environment to obtain a better track, thereby effectively improving the track planning efficiency.
2) According to the invention, the unconnected random points are used as a basis for judging whether the unconnected random points reach a small-scale complex area, if the threshold judgment result is that the unconnected random points are close to the target area, the algorithm A is used for searching, the target point is quickly reached, and finally two steps of paths are extracted and integrated, so that the efficiency is improved.
3) The method makes full use of the rapidity of the RRT algorithm in a large-scale area and the adaptability of the A-x algorithm to narrow channels, makes up the inadaptation of the RRT algorithm to the environments such as the narrow channels, avoids the search of the A-x algorithm in a large-scale scene, and shortens the time.
Drawings
FIG. 1 is a schematic view of an obstacle focusing environment;
FIG. 2 is a schematic flow chart of the method of the present invention;
FIG. 3 is a schematic diagram of random point selection according to the present invention;
FIG. 4 is a schematic diagram of a random tree generation according to the present invention;
FIG. 5 is a schematic diagram illustrating the determination of the vicinity of a target area according to the present invention;
FIG. 6 is a schematic diagram of a search near a target area according to the present invention;
FIG. 7 is a schematic diagram of the optimization and integration of the path of the present invention.
Detailed Description
The invention is described in detail below with reference to the figures and specific embodiments. The present embodiment is implemented on the premise of the technical solution of the present invention, and a detailed implementation manner and a specific operation process are given, but the scope of the present invention is not limited to the following embodiments.
The invention provides a robot path generation method under a concentrated environment of obstacles, which comprises the steps of firstly, searching by using an RRT algorithm to construct and expand a random tree, judging whether the longest effective distance between a random point and a connecting line of a target point is smaller than a set threshold value when an invalid random point is generated, if so, converting the longest effective distance into an A-x algorithm to search until the end, otherwise, continuing to search by using the RRT algorithm, and repeating the judgment; the final path is composed of the path obtained by RRT search and the path obtained by A-search. As shown in fig. 2, the method specifically includes the following steps:
in step S101, a random point is generated in the selected obstacle concentration environment, whether the random point is in the obstacle or not is determined, if yes, the random point is discarded, step S101 is repeated, and if not, step S102 is executed.
Step S102, obtaining a connecting line between the random point and a nearest point in the random tree, wherein the nearest point is a point in the random tree closest to the random point, judging whether the connecting line passes through an obstacle, if so, executing step S104, and if not, executing step S103.
Step S103, reserving the connection line, adding a random point into a random tree, taking the closest point as a father node, judging whether the random point is a target point, if so, executing step S107, and if not, returning to step S101.
Step S104, a replacing point on the connecting line is taken, the replacing point is farthest from the closest point, and a new connecting line formed between the replacing point and the closest point does not pass through an obstacle, and step S105 is executed.
Step S105, judging whether the distance between the substitute point and the target point is smaller than a set threshold, if so, executing step S106, and if not, returning to step S101.
And step S106, local searching is carried out to a target point by using the alternative point as a starting point and adopting an A-x algorithm, a first path is obtained, and step S107 is executed.
And S107, optimizing the random tree to obtain a second path, if the first path exists, connecting the first path and the second path to form a final path, and if the first path does not exist, directly taking the second path as the final path. The random tree is optimized specifically as follows: and extracting available paths on the random tree, and taking the shortest path as a second path.
Fig. 3-7 show the robot path generation process from the robot start position S to the target position G using the above method.
As shown in fig. 3, a random point is generated, such as R1, R2, etc., and if the random point falls within the obstacle (such as R2), the point is discarded.
As shown in fig. 4, a point (in this case, point S) on the random tree closest to the effective random point (taking R1 as an example) is found, if the connection line between the two points does not pass through the obstacle, the random point (point R1) is added into the random tree, and the closest point (point S) is used as its parent node, and if the connection line passes through the obstacle (such as the random point R3 and the closest point R1) on the tree), the next step is performed.
As shown in fig. 5, the path generation method of the present invention does not directly discard the random point connection when it passes through the obstacle, but performs an additional process. Taking a substitute point T3 which is farthest from the closest point R1 and is not on the obstacle on a connecting line of the random point R3 and the closest point R1, if the distance | GT3| between the substitute point and the target point is larger than a preset threshold value, considering that the random point is not near the target area, directly discarding the substitute point, and repeating the previous steps; if its distance is less than a threshold, e.g., | TmG |, where Rm is a random point, Nm is the corresponding closest point, and Tm is a replacement point, the replacement point Tm is added to the random tree with the closest point Nm as the parent node and it is considered that the vicinity of the target region has been reached.
As shown in fig. 6, if it is considered that the vicinity of the target area has been reached in the previous step, the substitute point Tm is used as a starting point, the target point G is used as an end point, a search is performed on the map using the a-x algorithm to find the first route, and if the vicinity of the target area is no longer reached, the previous steps are repeated.
As shown in fig. 7, an available path is extracted from the random tree and subjected to a certain optimization process, and a final path is obtained by connecting the obtained segment with the first path, as shown in a in the figure, in order to obtain the second path with the shortest path.
The foregoing detailed description of the preferred embodiments of the invention has been presented. It should be understood that numerous modifications and variations could be devised by those skilled in the art in light of the present teachings without departing from the inventive concepts. Therefore, the technical solutions available to those skilled in the art through logic analysis, reasoning and limited experiments based on the prior art according to the concept of the present invention should be within the scope of protection defined by the claims.

Claims (1)

1. A robot path generation method under an obstacle concentration environment is characterized in that firstly, an RRT algorithm is used for searching and constructing an expanded random tree, when invalid random points are generated, whether the longest effective distance between the random points and a connecting line of a target point is smaller than a set threshold value or not is judged, if yes, the algorithm is converted into an A-x algorithm for searching till the end, if not, RRT algorithm searching is continued, and the judgment is repeated; the final path consists of a path obtained by RRT search and a path obtained by A search;
the method specifically comprises the following steps:
1) establishing a random tree;
2) generating a random point, judging whether the random point is in the barrier, if so, discarding the random point, repeating the step 2), and if not, executing the step 3);
3) obtaining a connecting line between a random point and the nearest point in the random tree, judging whether the connecting line passes through an obstacle, if so, executing the step 4), otherwise, reserving the connecting line, adding the random point into the random tree, and executing the step 5);
4) judging whether the longest effective distance between the random point and the target point on the connection line is smaller than a set threshold, if so, using an A-star algorithm to perform local search to the target point to obtain a first path, executing the step 6), and if not, returning to the step 2);
5) judging whether the random point is a target point, if so, executing the step 6), and if not, returning to the step 2);
6) optimizing the random tree to obtain a second path, if the first path exists, connecting the first path and the second path to form a final path, and if the first path does not exist, directly taking the second path as the final path;
in the step 4), the longest effective distance between the random point and the connection line of the target point is obtained by the following method:
taking a replacing point on the connecting line in the step 3), wherein the replacing point is farthest from the closest point and a new connecting line formed between the replacing point and the closest point does not pass through an obstacle, and the connecting line distance between the replacing point and the target point is taken as the longest effective distance;
in the step 4), when the partial search is performed by using the a-x algorithm, the substitute point is used as a starting point, and the substitute point is added to the random tree.
CN201811592363.3A 2018-12-25 2018-12-25 Robot path generation method under barrier concentration environment Active CN109445444B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811592363.3A CN109445444B (en) 2018-12-25 2018-12-25 Robot path generation method under barrier concentration environment

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811592363.3A CN109445444B (en) 2018-12-25 2018-12-25 Robot path generation method under barrier concentration environment

Publications (2)

Publication Number Publication Date
CN109445444A CN109445444A (en) 2019-03-08
CN109445444B true CN109445444B (en) 2021-05-11

Family

ID=65535563

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811592363.3A Active CN109445444B (en) 2018-12-25 2018-12-25 Robot path generation method under barrier concentration environment

Country Status (1)

Country Link
CN (1) CN109445444B (en)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110275528B (en) * 2019-06-04 2022-08-16 合肥工业大学 Improved path optimization method for RRT algorithm
CN110345959B (en) * 2019-06-10 2023-11-03 同济人工智能研究院(苏州)有限公司 Path planning method based on gate point
CN110426053B (en) * 2019-07-12 2020-11-17 深圳市银星智能科技股份有限公司 Path planning method and mobile robot
CN110794832B (en) * 2019-10-21 2021-11-09 同济大学 Mobile robot path planning method based on reinforcement learning
CN111722924B (en) * 2020-05-30 2022-09-16 同济大学 Parallel path searching method, system and device under narrow channel environment
CN111707264A (en) * 2020-05-30 2020-09-25 同济大学 Improved and extended RRT path planning method, system and device
CN112711256B (en) * 2020-12-23 2022-05-20 杭州电子科技大学 Automatic generation method for target search observation points of mobile robot
CN113031599B (en) * 2021-03-02 2024-05-07 珠海一微半导体股份有限公司 Method for quickly locating robot with dynamically changed reference point, chip and robot
CN113219975B (en) * 2021-05-08 2024-04-05 珠海一微半导体股份有限公司 Route optimization method, route planning method, chip and robot

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104155974A (en) * 2013-07-29 2014-11-19 深圳信息职业技术学院 Path planning method and apparatus for robot fast collision avoidance
CN104345735A (en) * 2014-09-30 2015-02-11 同济大学 Robot walking control method based on foothold compensator
WO2015167220A1 (en) * 2014-05-02 2015-11-05 한화테크윈 주식회사 Device for planning path of mobile robot and method for planning path of mobile robot
WO2016050274A1 (en) * 2014-09-30 2016-04-07 Nec Europe Ltd. Method and system for determining a path of an object for moving from a starting state to an end state set avoiding one or more obstacles
CN106931970A (en) * 2015-12-30 2017-07-07 北京雷动云合智能技术有限公司 Robot security's contexture by self air navigation aid in a kind of dynamic environment
CN108195383A (en) * 2018-03-13 2018-06-22 济南大学 A kind of unmanned scraper paths planning method in underground based on improvement RRT algorithms
CN108444489A (en) * 2018-03-07 2018-08-24 北京工业大学 A kind of paths planning method improving RRT algorithms
CN108563243A (en) * 2018-06-28 2018-09-21 西北工业大学 A kind of unmanned aerial vehicle flight path planing method based on improvement RRT algorithms
CN108803627A (en) * 2018-08-20 2018-11-13 国网福建省电力有限公司 A kind of crusing robot paths planning method suitable for substation's cubicle switch room
CN108896052A (en) * 2018-09-20 2018-11-27 鲁东大学 A kind of mobile robot smooth paths planing method under the environment based on DYNAMIC COMPLEX
CN108919794A (en) * 2018-06-01 2018-11-30 广州视源电子科技股份有限公司 Global path planning method and device for double-wheel differential mobile robot

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8244469B2 (en) * 2008-03-16 2012-08-14 Irobot Corporation Collaborative engagement for target identification and tracking

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104155974A (en) * 2013-07-29 2014-11-19 深圳信息职业技术学院 Path planning method and apparatus for robot fast collision avoidance
WO2015167220A1 (en) * 2014-05-02 2015-11-05 한화테크윈 주식회사 Device for planning path of mobile robot and method for planning path of mobile robot
CN104345735A (en) * 2014-09-30 2015-02-11 同济大学 Robot walking control method based on foothold compensator
WO2016050274A1 (en) * 2014-09-30 2016-04-07 Nec Europe Ltd. Method and system for determining a path of an object for moving from a starting state to an end state set avoiding one or more obstacles
CN106931970A (en) * 2015-12-30 2017-07-07 北京雷动云合智能技术有限公司 Robot security's contexture by self air navigation aid in a kind of dynamic environment
CN108444489A (en) * 2018-03-07 2018-08-24 北京工业大学 A kind of paths planning method improving RRT algorithms
CN108195383A (en) * 2018-03-13 2018-06-22 济南大学 A kind of unmanned scraper paths planning method in underground based on improvement RRT algorithms
CN108919794A (en) * 2018-06-01 2018-11-30 广州视源电子科技股份有限公司 Global path planning method and device for double-wheel differential mobile robot
CN108563243A (en) * 2018-06-28 2018-09-21 西北工业大学 A kind of unmanned aerial vehicle flight path planing method based on improvement RRT algorithms
CN108803627A (en) * 2018-08-20 2018-11-13 国网福建省电力有限公司 A kind of crusing robot paths planning method suitable for substation's cubicle switch room
CN108896052A (en) * 2018-09-20 2018-11-27 鲁东大学 A kind of mobile robot smooth paths planing method under the environment based on DYNAMIC COMPLEX

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
Dynamic Multi-Heuristic A*;Fahad Islam等;《2015 IEEE International Conference on Robotics and Automation (ICRA)》;20150530;第2376-2382页 *
Extended RRT-based Path Planning for Flying Robots in Complex 3D Environments with Narrow Passages;Dachuan Li,等;《8th IEEE International Conference on Automation Science and Engineering》;20120824;第1173-1178页 *
基于RRT算法的非完整移动机器人运动规划;李加东;《中国优秀硕士论文全文数据库 信息科技辑》;20140915(第09(2014)期);第I140-258页 *
基于改进 RRT 算法的 RoboCup 机器人动态路径规划;刘成菊;《机器人》;20170131;第39卷(第1期);第8-15页 *
复杂未知环境下机器人路径规划算法研究;隋玲玲;《中国优秀硕士论文全文数据库 信息科技辑》;20110315(第03(2011)期);第I140-183页 *

Also Published As

Publication number Publication date
CN109445444A (en) 2019-03-08

Similar Documents

Publication Publication Date Title
CN109445444B (en) Robot path generation method under barrier concentration environment
CN109443364A (en) Paths planning method based on A* algorithm
CN106873366B (en) The method for generating ATO speed control commands for municipal rail train
CN103077425A (en) Immune genetic algorithm for AUV (Autonomous Underwater Vehicle) real-time path planning
CN106595663A (en) Aircraft auto-route planning method with combination of searching and optimization
CN108413963A (en) Bar-type machine people's paths planning method based on self study ant group algorithm
CN107544502A (en) A kind of Planning of Mobile Robot under known environment
Lee et al. Monte-carlo tree search in continuous action spaces with value gradients
Nie et al. Research on robot path planning based on Dijkstra and Ant colony optimization
CN110275528A (en) For the method for optimizing route of RRT algorithm improvement
JP7059781B2 (en) Optimization equipment, optimization methods, and programs
US20230231796A1 (en) Method for energy efficient routing in wireless sensor network based on multi-agent deep reinforcement learning
García et al. An efficient multi-robot path planning solution using A* and coevolutionary algorithms
CN109211242A (en) A kind of three-dimensional space multi-goal path planing method merging RRT and ant group algorithm
CN106658570B (en) Moving sink information collection path construction method based on secondary grid division
Efentakis et al. GRASP. Extending graph separators for the single-source shortest-path problem
CN114527761A (en) Intelligent automobile local path planning method based on fusion algorithm
CN113721622B (en) Robot path planning method
CN116558527B (en) Route planning method for underground substation inspection cleaning robot
CN103426127A (en) Urban power network planning method based on pseudo-crossover taboo hybrid genetic algorithm
Huang et al. Optimal nonblocking directed control of discrete event systems
CN115494840B (en) Monte Carlo factor-based MC-IACO welding robot path planning method
CN114564023B (en) Jumping point search path planning method under dynamic scene
Zhao et al. Research of path planning for mobile robot based on improved ant colony optimization algorithm
Zhao et al. A compound path planning algorithm for mobile robots

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