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 PDF

Info

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
Application number
CNA200810156869XA
Other languages
Chinese (zh)
Other versions
CN101387888B (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.)
Jiangnan University
Original Assignee
Jiangnan 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 Jiangnan University filed Critical Jiangnan University
Priority to CN200810156869XA priority Critical patent/CN101387888B/en
Publication of CN101387888A publication Critical patent/CN101387888A/en
Application granted granted Critical
Publication of CN101387888B publication Critical patent/CN101387888B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

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

Method for planning path for mobile robot based on binary quanta particle swarm optimization
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:
Figure A200810156869D00051
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)
Figure A200810156869D00052
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.
Embodiment 2
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)
Figure A200810156869C00031
D wherein H(X Id, P Id) be the X of particle i d dimension IdP with local attractor d dimension IdHamming distance from.
CN200810156869XA 2008-09-27 2008-09-27 Mobile robot path planning method based on binary quanta particle swarm optimization Expired - Fee Related CN101387888B (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

Cited By (32)

* Cited by examiner, † Cited by third party
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
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
CN102207736A (en) Robot path planning method and apparatus thereof based on Bezier curve
Yan et al. Path planning for autonomous underwater vehicle based on an enhanced water wave optimization algorithm
CN107229287A (en) A kind of unmanned plane global path planning method based on Genetic Ant algorithm
CN113485371B (en) Underwater multi-AUV path planning method based on improved sparrow search algorithm
Yao et al. Path planning method based on D* lite algorithm for unmanned surface vehicles in complex environments
CN113110520A (en) Robot path planning method based on multiple intelligent optimization parallel algorithms
CN112099501B (en) Unmanned ship path planning method based on potential field parameter optimization
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
Li et al. Path planning of mobile robot based on genetic algorithm and gene rearrangement
Zou et al. Multi-modal pedestrian trajectory prediction for edge agents based on spatial-temporal graph
Bonny et al. Highly optimized Q‐learning‐based bees approach for mobile robot path planning in static and dynamic environments
CN112214031B (en) Multi-node collaborative landing position planning method based on genetic particle swarm optimization
Chandrasekhar Rao et al. Cooperative navigation planning of multiple mobile robots using improved krill herd
Chen et al. Path planning of mobile robot based on an improved genetic algorithm
CN108445894A (en) A kind of secondary paths planning method considering unmanned boat movenent performance
Li et al. An improved differential evolution based artificial fish swarm algorithm and its application to AGV path planning problems
Dong et al. Disordered and multiple destinations path planning methods for mobile robot in dynamic environment
Yang et al. Complete coverage path planning based on bioinspired neural network and pedestrian location prediction
Wang et al. An improved NSGA-II algorithm for UAV path planning problems

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