CN101387888A - Mobile robot path planning method based on binary quanta particle swarm optimization - Google Patents
Mobile robot path planning method based on binary quanta particle swarm optimization Download PDFInfo
- Publication number
- CN101387888A CN101387888A CNA200810156869XA CN200810156869A CN101387888A CN 101387888 A CN101387888 A CN 101387888A CN A200810156869X A CNA200810156869X A CN A200810156869XA CN 200810156869 A CN200810156869 A CN 200810156869A CN 101387888 A CN101387888 A CN 101387888A
- Authority
- CN
- China
- Prior art keywords
- particle
- robot
- path
- binary
- mobile robot
- 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
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
- Manipulator (AREA)
Abstract
The invention discloses a mobile robot path planning method based on the binary quantum particle swarm optimization, which is characterized by comprising steps of 1, simplifying a robot into a point moving in a two-dimensional space, and then sensing the present position of the robot and the present positions of obstacles via the visual system, 2, processing all the obstacles sensed by the visual system of the robot into convex polygons, 3, discretizing the two-dimensional space into series grids, and performing binary encoding for eight probable motion directions of the robot at each grid, 4, defining the distance of the path between the starting point and the destination point as a target function required to be solved by the method, and 5, overall optimizing the target function in the step 4 by utilizing the binary quantum particle swarm optimization aiming to the discrete characteristics of robot path planning problems to obtain the optimum mobile robot path. The invention has the advantages of simple process, easy realizing, good robustness, high solving efficiency and the like.
Description
Technical field
The invention discloses a kind of method for planning path for mobile robot based on binary quanta particle swarm optimization.
Background technology
Path planning is meant between robot is from the starting point to the impact point and finds a safety not have the path of bumping, is robot field's important topic.Understanding by to environment knowledge can be divided into the path planning under known environment and the circumstances not known.No matter which kind of classification the robot path planning belongs to, and adopts which kind of planning algorithm, all will follow following steps basically: 1) set up environmental model, be about to the residing real world of robot and carry out the relevant model of abstract back foundation; 2) search nothing is bumped the path, promptly seeks the searching algorithm in the path of eligible in the space of certain model.For the known global path planning of environmental information, existing at present many solutions, but develop and next numerical value potential field method as Artificial Potential Field method sight method and by Artificial Potential Field.Closely during the decade, along with the artificial intelligence study constantly makes progress, many intelligent algorithms also are used in mobile robot's the path planning, comprise fuzzy logic and strengthen learning algorithm, neural network, genetic algorithm and ant group algorithm etc.
Mobile robot's motion planning algorithm is accompanied by developing into of mobile robot to be satisfied the machine human needs and develops.Now, unmanned ground, under water, the development of aerial robot rapidly, robot soccer competition is like a raging fire, and robot just towards microminaturization and multirobot cooperation part to development.Along with the needs of celestial body detecting and unmanned war, the research of robot is more and more paid attention in accidental relief and existed independent navigation in the dyskinetic complex environment.In order to satisfy the needs of mobile robot development, motion planning and will be to higher-dimension degree of freedom robot, multi-robot coordination, the dynamic planning and development in the circumstances not known.
Summary of the invention
The objective of the invention is to overcome the deficiencies in the prior art, provide a kind of and can solve the mobile robot and generate in real time the path planning keeping away the barrier path problems, can solve mobile robot under the uncertain environment, and can realize mobile robot's navigation and keep away the method for planning path for mobile robot based on binary quanta particle swarm optimization of barrier problem.
According to technical scheme provided by the invention, described method for planning path for mobile robot based on binary quanta particle swarm optimization comprises following steps:
Step 1: robot is simplified to a point, and in two-dimensional space, moves, by can perception oneself the present pose of vision system and the position of barrier;
Step 2: all barriers that robotic vision system is perceived are processed into convex polygon;
Step 3: turn to a series of grid with two-dimensional space is discrete, and may direction of motion carry out binary coding eight of each grid place to the mobile robot;
Step 4: the objective function that the length in the path of definition from the starting point to the impact point need be found the solution for this method, promptly obtain by the accumulation of the grid on the path, computing method are specially:
Wherein d represents two paths between grid;
Step 5: at the discrete features of robot path planning's problem, utilize binary quanta particle swarm optimization that the objective function in the step 4 is carried out global optimization to obtain optimum mobile robot path, specifically comprise:
(5.1) determining of particle distance: in order to represent two distances between the particle, introduced Hamming distance from defining it, define two particle (X, Y), they have respectively two decision variables (Xi1, Xi2), (Yi1, Yi2), each decision variable is by five binary codings, and then the distance of two particles can have Hamming distance from representing:
|X-Y|=d
H(X,Y) (2)
Its value is the number of the different value of the corresponding position of two bit strings;
(5.2) determining of optimum median location (mbest): the value of mbest is by the value decision of the identical bits of each particle bit string in the particle colony, by adding up the size of the probability of binary-coded each appearance 0,1 of statistics particle in each particle colony, occur 0 often, then the mbest correspondence is 0, otherwise, then be 1;
(5.3) the sub-P of local attraction
iDetermine: utilize the multiple spot interlace operation to obtain local attraction's; Promptly calculate the local optimum and the global optimum in each generation earlier, calculate local attraction's by the mode of intersecting;
(5.4) determining of particle position:
b=α*d
H(X
id,mbest
d)*ln(1/u),u=rand() (3)
D wherein
H(X
Id, P
Id) be the X of particle i d dimension
IdP with local attractor d dimension
IdHamming distance from.
The present invention compared with the prior art, process is simple, realizes easily, robustness is good, find the solution the efficient advantages of higher.Therefore, the invention solves mobile robot's generation in real time and keep away the barrier path problems.The invention solves the path planning of mobile robot under the uncertain environment, realized mobile robot's navigation and kept away the barrier problem, realized the real-time route planning and the control of robot preferably, for mobile robot path planning provides an effective method.
Description of drawings
Fig. 1 grid rules are drawn the region of search synoptic diagram.
Fig. 2 direction encoding synoptic diagram.
The binary coding figure of Fig. 3 particle position.
The multiple spot intersection synoptic diagram of Fig. 4 binary coding particle.
The path planning synoptic diagram that Fig. 5 iteration obtained after 15 generations.
The optimizing planning path synoptic diagram that Fig. 6 iteration obtained after 42 generations.
The path planning synoptic diagram that Fig. 7 iteration obtained after 70 generations.
The optimal programming path synoptic diagram that Fig. 8 iteration obtained after 276 generations.
The path planning synoptic diagram that Fig. 9 iteration obtained after 180 generations.
The optimal programming path synoptic diagram that Figure 10 iteration obtained after 227 generations.
In all figure, all asterisk point " * " expression robot ambulation paths, solid dot is represented free space, square is represented barrier.
Embodiment
The invention will be further described below in conjunction with concrete drawings and Examples.
Embodiment 1: the method for planning path for mobile robot that the present invention is based on binary quanta particle swarm optimization comprises following steps:
1, robot is simplified to the point that an energy moves in two-dimensional space, it passes through the present pose of vision system energy perception oneself and the position of barrier; And robot can perception barrier be processed into convex polygon in the two-dimensional space.
2, determine that according to the size of robot self people of grid granularity is little, set up the environmental model of robot, be i.e. discrete state space, the pattern after the foundation such as Fig. 1 with the grid method;
3, determine the coded system of eight directions on the discrete space, promptly adopt binary coding, as Fig. 2;
4, the objective function of problem identificatioin promptly defines the objective function that the length in the path from the starting point to the impact point need be found the solution for this method, computing method such as formula (1); The target function value of particle position is as adaptive value fitness in the binary quanta particle swarm optimization;
5, the step of the following binary quanta particle swarm optimization of enforcement is optimized to obtain optimum mobile robot path objective function;
6, set the detail parameters of binary quanta particle swarm optimization, i.e. the length of population size, binary string, maximum iteration time and search volume; Population size is generally 20~50, and the length of binary string is generally got 4 * 4 * n (n for and the length of side of people workspace), and maximum iteration time and search volume are determined on a case-by-case basis.
The local optimum pbest of 7, the particle position variable of initialization binary quanta particle swarm optimization, and particle, and obtain the global optimum gbest of colony;
8, calculate the intermediate value optimal location mbest of population;
9, illustrate to calculate the sub-P of local attraction by Fig. 4
i
10, calculate particle position X by formula (3), (4)
Id
11, calculate the fitness fitness (x of particle reposition
i(t+1));
12, if the current optimal location of new particle more is i.e.: fitness (x
i(t+1))<fitness (pbest
i(t)), pbest then
i(t+1)=x
i(t+1), otherwise, pbest
i(t+1)=pbest
i(t);
13, upgrade the optimal location of colony, if i.e.: fitness (pbest
i(t+1))<fitness (gbest (t)), then gbest (t+1)=pbest
i(t+1);
14, circulation step 8~13, finish after being to reach maximum iteration time, export the position gbest of global optimum of colony then, are mobile robot's optimal path.
Shown in Fig. 6,7, the perform region of robot is 16 * 16 clear space, and the starting point in path is (1,1), and terminal point is (16,16), and it is 30 that particle colony is set in the algorithm, and the length of binary string is 4 * 4 * 16=256, and α is made as 0.6.
Shown in Fig. 7,8, the perform region of robot be 16 * 16 the barrier space arranged, the starting point in path is (1,1), terminal point is (16,16), it is 30,4 * 4 * 16=256 that particle colony is set in the algorithm, α is made as 0.6.
Embodiment 3
Shown in Fig. 9,10, the perform region of robot be 16 * 16 the barrier space arranged, the starting point in path is (4,12), terminal point is (16,16), it is 30,4 * 4 * 16=256 that particle colony is set in the algorithm, α is made as 0.6.
Claims (2)
1, a kind of method for planning path for mobile robot based on binary quanta particle swarm optimization is characterized in that this method comprises following steps:
Step 1: robot is simplified to a point, and in two-dimensional space, moves, by can perception oneself the present pose of vision system and the position of barrier;
Step 2: all barriers that robotic vision system is perceived are processed into convex polygon;
Step 3: turn to a series of grid with two-dimensional space is discrete, and may direction of motion carry out binary coding eight of each grid place to the mobile robot;
Step 4: the objective function that the length in the path of definition from the starting point to the impact point need be found the solution for this method, promptly obtain by the accumulation of the grid on the path, computing method are specially:
Wherein d represents two paths between grid;
Step 5: at the discrete features of robot path planning's problem, utilize binary quanta particle swarm optimization that the objective function in the step 4 is carried out global optimization to obtain optimum mobile robot path, specifically comprise:
(5.1) determining of particle distance: in order to represent two distances between the particle, introduced Hamming distance from defining it, define two particle (X, Y), they have respectively two decision variables (Xi1, Xi2), (Yi1, Yi2), each decision variable is by five binary codings, and then the distance of two particles can have Hamming distance from representing:
|X-Y|=d
H(X,Y)(2)
Its value is the number of the different value of the corresponding position of two bit strings;
(5.2) determining of optimum median location (mbest): the value of mbest is by the value decision of the identical bits of each particle bit string in the particle colony, by adding up the size of the probability of binary-coded each appearance 0,1 of statistics particle in each particle colony, occur 0 often, then the mbest correspondence is 0, otherwise, then be 1;
(5.3) the sub-P of local attraction
iDetermine: utilize the multiple spot interlace operation to obtain local attraction's; Promptly calculate the local optimum and the global optimum in each generation earlier, calculate local attraction's by the mode of intersecting;
(5.4) determining of particle position:
b=α*d
H(X
id,mbest
d)*ln(1/u),u=rand() (3)
D wherein
H(X
Id, P
Id) be the X of particle i d dimension
IdP with local attractor d dimension
IdHamming distance from.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200810156869XA CN101387888B (en) | 2008-09-27 | 2008-09-27 | Mobile robot path planning method based on binary quanta particle swarm optimization |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200810156869XA CN101387888B (en) | 2008-09-27 | 2008-09-27 | Mobile robot path planning method based on binary quanta particle swarm optimization |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101387888A true CN101387888A (en) | 2009-03-18 |
CN101387888B CN101387888B (en) | 2010-12-15 |
Family
ID=40477341
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN200810156869XA Expired - Fee Related CN101387888B (en) | 2008-09-27 | 2008-09-27 | Mobile robot path planning method based on binary quanta particle swarm optimization |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101387888B (en) |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101739027A (en) * | 2009-12-01 | 2010-06-16 | 蒋平 | Distributed visual sensing network-based movable navigation system |
CN101901012A (en) * | 2010-03-19 | 2010-12-01 | 华东交通大学 | Distributed type multi-robot synchronous swarming control method |
CN102129249A (en) * | 2011-01-10 | 2011-07-20 | 中国矿业大学 | Method for planning global path of robot under risk source environment |
CN103092203A (en) * | 2013-01-15 | 2013-05-08 | 深圳市紫光杰思谷科技有限公司 | Control method of relative motion between primary robot and secondary robot |
CN103197675A (en) * | 2013-03-13 | 2013-07-10 | 北京矿冶研究总院 | Autonomous driving and obstacle avoidance motion control and target path planning method for underground carry scraper |
CN103605368A (en) * | 2013-12-04 | 2014-02-26 | 苏州大学张家港工业技术研究院 | Method and device for route programming in dynamic unknown environment |
CN103650606A (en) * | 2011-05-13 | 2014-03-19 | 谷歌公司 | Indoor localization of mobile devices |
CN104516350A (en) * | 2013-09-26 | 2015-04-15 | 沈阳工业大学 | Mobile robot path planning method in complex environment |
CN105096733A (en) * | 2015-08-07 | 2015-11-25 | 王红军 | Raster map based environment characteristic representation and recognition method |
CN105160122A (en) * | 2015-09-08 | 2015-12-16 | 王红军 | Grid map based environment characteristic similarity measurement method |
CN105387875A (en) * | 2015-12-24 | 2016-03-09 | 安徽工程大学 | Improvement on mobile robot path planning method based on ant colony algorithm |
CN105511457A (en) * | 2014-09-25 | 2016-04-20 | 科沃斯机器人有限公司 | Static path planning method of robot |
CN105606103A (en) * | 2016-02-22 | 2016-05-25 | 江苏信息职业技术学院 | Method for planning operation route of robot in mine |
CN107662211A (en) * | 2017-10-16 | 2018-02-06 | 西北工业大学 | A kind of robot for space forecast Control Algorithm based on quanta particle swarm optimization |
CN108646734A (en) * | 2018-04-27 | 2018-10-12 | 天津大学 | Nonlinear model predictive control method based on quanta particle swarm optimization |
CN108664022A (en) * | 2018-04-27 | 2018-10-16 | 湘潭大学 | A kind of robot path planning method and system based on topological map |
CN108983770A (en) * | 2018-07-02 | 2018-12-11 | 四川大学 | Data processing method, device, electronic equipment and storage medium |
CN111080035A (en) * | 2019-12-31 | 2020-04-28 | 芜湖哈特机器人产业技术研究院有限公司 | Global path planning method based on improved quantum particle swarm optimization algorithm |
CN111474926A (en) * | 2020-03-24 | 2020-07-31 | 浙江中烟工业有限责任公司 | Waste smoke recovery method based on multiple AGV time window path optimization algorithm |
CN113478480A (en) * | 2021-06-22 | 2021-10-08 | 中建三局集团有限公司 | Trajectory planning method for transverse arm material distributing machine |
CN116011361A (en) * | 2023-03-24 | 2023-04-25 | 华东交通大学 | Risk avoidance evaluation simulation method and system for high-density crowd in natural disasters |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3994950B2 (en) * | 2003-09-19 | 2007-10-24 | ソニー株式会社 | Environment recognition apparatus and method, path planning apparatus and method, and robot apparatus |
CN100491084C (en) * | 2007-07-03 | 2009-05-27 | 北京控制工程研究所 | Mobile Robot local paths planning method on the basis of binary environmental information |
-
2008
- 2008-09-27 CN CN200810156869XA patent/CN101387888B/en not_active Expired - Fee Related
Cited By (32)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101739027A (en) * | 2009-12-01 | 2010-06-16 | 蒋平 | Distributed visual sensing network-based movable navigation system |
CN101901012A (en) * | 2010-03-19 | 2010-12-01 | 华东交通大学 | Distributed type multi-robot synchronous swarming control method |
CN101901012B (en) * | 2010-03-19 | 2012-02-22 | 华东交通大学 | Distributed type multi-robot synchronous swarming control method |
CN102129249A (en) * | 2011-01-10 | 2011-07-20 | 中国矿业大学 | Method for planning global path of robot under risk source environment |
CN103650606A (en) * | 2011-05-13 | 2014-03-19 | 谷歌公司 | Indoor localization of mobile devices |
CN103092203A (en) * | 2013-01-15 | 2013-05-08 | 深圳市紫光杰思谷科技有限公司 | Control method of relative motion between primary robot and secondary robot |
CN103197675A (en) * | 2013-03-13 | 2013-07-10 | 北京矿冶研究总院 | Autonomous driving and obstacle avoidance motion control and target path planning method for underground carry scraper |
CN103197675B (en) * | 2013-03-13 | 2016-05-25 | 北京矿冶研究总院 | Autonomous driving and obstacle avoidance motion control and target path planning method for underground carry scraper |
CN104516350A (en) * | 2013-09-26 | 2015-04-15 | 沈阳工业大学 | Mobile robot path planning method in complex environment |
CN104516350B (en) * | 2013-09-26 | 2017-03-22 | 沈阳工业大学 | Mobile robot path planning method in complex environment |
CN103605368A (en) * | 2013-12-04 | 2014-02-26 | 苏州大学张家港工业技术研究院 | Method and device for route programming in dynamic unknown environment |
CN105511457A (en) * | 2014-09-25 | 2016-04-20 | 科沃斯机器人有限公司 | Static path planning method of robot |
CN105096733A (en) * | 2015-08-07 | 2015-11-25 | 王红军 | Raster map based environment characteristic representation and recognition method |
CN105096733B (en) * | 2015-08-07 | 2018-01-19 | 王红军 | A kind of environmental characteristic based on grating map is represented with knowing method for distinguishing |
CN105160122A (en) * | 2015-09-08 | 2015-12-16 | 王红军 | Grid map based environment characteristic similarity measurement method |
CN105160122B (en) * | 2015-09-08 | 2018-02-23 | 王红军 | A kind of method for measuring similarity of the environmental characteristic based on grating map |
CN105387875B (en) * | 2015-12-24 | 2018-01-12 | 安徽工程大学 | A kind of improvement of method for planning path for mobile robot based on ant group algorithm |
CN105387875A (en) * | 2015-12-24 | 2016-03-09 | 安徽工程大学 | Improvement on mobile robot path planning method based on ant colony algorithm |
CN105606103A (en) * | 2016-02-22 | 2016-05-25 | 江苏信息职业技术学院 | Method for planning operation route of robot in mine |
CN107662211A (en) * | 2017-10-16 | 2018-02-06 | 西北工业大学 | A kind of robot for space forecast Control Algorithm based on quanta particle swarm optimization |
CN108646734B (en) * | 2018-04-27 | 2021-04-02 | 天津大学 | Nonlinear model prediction control method based on quantum particle swarm algorithm |
CN108664022A (en) * | 2018-04-27 | 2018-10-16 | 湘潭大学 | A kind of robot path planning method and system based on topological map |
CN108646734A (en) * | 2018-04-27 | 2018-10-12 | 天津大学 | Nonlinear model predictive control method based on quanta particle swarm optimization |
CN108664022B (en) * | 2018-04-27 | 2023-09-05 | 湘潭大学 | Robot path planning method and system based on topological map |
CN108983770A (en) * | 2018-07-02 | 2018-12-11 | 四川大学 | Data processing method, device, electronic equipment and storage medium |
CN108983770B (en) * | 2018-07-02 | 2019-07-05 | 四川大学 | Data processing method, device, electronic equipment and storage medium |
CN111080035A (en) * | 2019-12-31 | 2020-04-28 | 芜湖哈特机器人产业技术研究院有限公司 | Global path planning method based on improved quantum particle swarm optimization algorithm |
CN111474926A (en) * | 2020-03-24 | 2020-07-31 | 浙江中烟工业有限责任公司 | Waste smoke recovery method based on multiple AGV time window path optimization algorithm |
CN111474926B (en) * | 2020-03-24 | 2023-09-01 | 浙江中烟工业有限责任公司 | Waste smoke recycling method based on multi-AGV time window path optimization algorithm |
CN113478480A (en) * | 2021-06-22 | 2021-10-08 | 中建三局集团有限公司 | Trajectory planning method for transverse arm material distributing machine |
CN113478480B (en) * | 2021-06-22 | 2022-03-25 | 中建三局集团有限公司 | Trajectory planning method for transverse arm material distributing machine |
CN116011361A (en) * | 2023-03-24 | 2023-04-25 | 华东交通大学 | Risk avoidance evaluation simulation method and system for high-density crowd in natural disasters |
Also Published As
Publication number | Publication date |
---|---|
CN101387888B (en) | 2010-12-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101387888B (en) | Mobile robot path planning method based on binary quanta particle swarm optimization | |
Shi et al. | Dynamic path planning for mobile robot based on genetic algorithm in unknown environment | |
CN106444755B (en) | Mobile robot path planning method based on improved genetic algorithm | |
Kala et al. | Fusion of probabilistic A* algorithm and fuzzy inference system for robotic path planning | |
CN102819264B (en) | Path planning Q-learning initial method of mobile robot | |
CN103365293B (en) | A kind of robot security's paths planning method based on dynami c block division | |
Guo et al. | Research progress of path planning methods for autonomous underwater vehicle | |
Yan et al. | Path planning for autonomous underwater vehicle based on an enhanced water wave optimization algorithm | |
CN102207736A (en) | Robot path planning method and apparatus thereof based on Bezier curve | |
Yao et al. | Path planning method based on D* lite algorithm for unmanned surface vehicles in complex environments | |
CN107229287A (en) | A kind of unmanned plane global path planning method based on Genetic Ant algorithm | |
CN111337931A (en) | AUV target searching method | |
CN112099501B (en) | Unmanned ship path planning method based on potential field parameter optimization | |
CN108445894A (en) | A kind of secondary paths planning method considering unmanned boat movenent performance | |
CN113110520A (en) | Robot path planning method based on multiple intelligent optimization parallel algorithms | |
CN108227718B (en) | Self-adaptive switching automatic carrying trolley path planning method | |
Yang et al. | Mobile robot path planning based on enhanced dynamic window approach and improved A∗ algorithm | |
Chandrasekhar Rao et al. | Cooperative navigation planning of multiple mobile robots using improved krill herd | |
Ni et al. | An improved shuffled frog leaping algorithm for robot path planning | |
Chen et al. | Path planning of mobile robot based on an improved genetic algorithm | |
Li et al. | An improved differential evolution based artificial fish swarm algorithm and its application to AGV path planning problems | |
CN112214031A (en) | Multi-node collaborative landing position planning method based on genetic particle swarm optimization | |
CN115097814A (en) | Mobile robot path planning method, system and application based on improved PSO algorithm | |
CN103279796A (en) | Method for optimizing genetic algorithm evolution quality | |
Raiesdana | A hybrid method for industrial robot navigation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20101215 Termination date: 20110927 |