Top Banner
Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357- 361, Dec. 2008.
28

Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

Dec 28, 2015

Download

Documents

Randall Terry
Welcome message from author
This document is posted to help you gain knowledge. Please leave a comment to let me know what you think about it! Share it to your friends and learn new things together.
Transcript
Page 1: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

Complete Coverage Path Planning Based on Ant Colony Algorithm

International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec. 2008.

Page 2: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

Outline

Abstract INTRODUCTION COMPLETE COVERAGE PATH PLANNING BASED ON

ANT COLONY ALGORITHM EXAMPLES AND SIMULATION CONCLUSIONS

Page 3: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

Abstract

The complete coverage path planning algorithm after the order of all cells is gotten. This is similar to the integrating local sub-area coverage with global planning was traveling salesman problem (TSP). It is a population-based proposed.

According to the characteristic of Boustrophedon heuristic simulation evolution algorithm in swarm intelligent cellular decomposition, the robot covers local sub-area through research area. Based on ant colony algorithm, the robot back and forth motion.

Page 4: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

The distance between every sub-areas uses the distance matrix to get the optimization sequence of was redefined, which including connectivity, least distance and the sub-areas after decomposed the coverage environment number of obstacles between sub-areas.

The new distance matrix of sub-areas in environment is built for global planning. Based on ant colony algorithm, the robot uses the distance matrix to get The basic mathematical model of Ant Colony Algorithm the optimization sequence of the sub-areas after decomposed the as follows: coverage environment.

Experiments on a simulation of environment verify the validity of the proposed algorithm.

Page 5: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

INTRODUCTION

Based on boustrophedon cellular decomposition algorithm, a new CCPP algorithm, which included globe path planning and local path planning, was introduced. After the new distance matrix of each cell in environment is built for global planning, the robot can complete coverage the environment after the order of all cells is gotten.

This is similar to the traveling salesman problem (TSP). It is a population-based heuristic simulation evolution algorithm in swarm intelligent research area. Based on ant colony algorithm, the robot uses the distance matrix to get the optimization sequence of the sub-areas after decomposed the coverage environment.

Page 6: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

COMPLETE COVERAGE PATH PLANNING BASED ON ANT COLONY ALGORITHM Boustrophedon cellular decomposition algorithm scan from

the left of the map to the right of the map by a virtual scan lines paralleled to the absolute coordinates of Y-axis, through the judgments of the change of connectivity to generate converge sub-area,

As shown in Figure 1,the line scans from the left of Figure 1. The result is to generate sub-area I. When scan line go though obstacle 1, it will generate converge 2 and 3 because of the change of connectivity. After Boustrophedon cellular decomposition, the map is decomposed to a number of the reachable s and the obstacles.

Page 7: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

The coverage of every sub-area can be achieved by robot moving back and forth. On the basis of coverage a single sub-area, determine the order of converge can achieve the objective of completely converge the environment.

Page 8: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.
Page 9: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

Figure 2 is the structure map of figure 1 cellular decomposition, under the regular condition. It is unrealistic to implement the converge algorithm according to the connection of figure 2, especially Ant Colony Algorithm require put the visited sub-areas into the visited sites of inhibition table.

This paper aims this situation, use the connectivity and distance of each sub-area and obstacle between each sub-area in the figure 1 to redefine the distance of each sub-area. Further add the existing connection of sub-areas; the result is to format a fully connected map. From the definition of Hamilton pathway, the figure 2 meets the sufficient condition of the Hamilton pathway.

Page 10: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

We know there exists a path that cover all the areas once and

only once in the complete coverage structure diagram.

Page 11: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.
Page 12: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

From figure 2, we can get the matrix A as follows, if converge sub-area i and j are adjacent, the value of aij is 1, instead the value of aij is zero for the non-adjacent sub-areas.

Page 13: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.
Page 14: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.
Page 15: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.
Page 16: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

For example, number of obstacles matrix N in the coverage sub-areas of the electronic map as follows:

Page 17: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

Obstacles matrix N is gotten when 1 is added to the elements of non-diagonal in matrix N in order to reserve the elements in the diaggonal as zero

Page 18: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

Distance matrix D show the real distance between coverage sub-areas, the variable dij is the distance value of the nearest vertices of two sub-areas i and j. The distance of adjacent sub-areas is a , the distance of non-adjacent sub-areas is determined by absolute coordinate. The matrix D below is the distance of figure 1.

Page 19: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.
Page 20: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

A integrated distance matrix D' is concluded when multiplying the variable with the same position in obstacles matrix, distance matrix, connectivity matrix together and then multiply the variable that is non-simple connected by coefficient.

Page 21: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

A integrated distance matrix D' of figure 1 is calculated as follows.

Page 22: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

EXAMPLES AND SIMULATION

Using ant colony algorithm to simulate the environment map of figure 3, there are some dimensionless factors, such as pheromone heuristic factor , expectation heuristic factor , pheromone volatilization factor , pheromone intensity factor Q, distance factor a, b and so on, which will affect route optimization.

Page 23: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.
Page 24: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

An optimal solution is concluded by refining step length of every factor and exhausting combination of those factors. It is:

Optimized coverage order is

, Percentage of coverage area is more than 95%, coverage overlap rate is less than 10% after neglecting the influence of body size of robots.

1, 2, 400, 0.4, 0.4, 2.Q a b

28 30 29 24 27 6 25 21 19 22 23 20 8 17

14 11 15 9 8 7 6 3 4 21 5 10 2 16 1

Page 25: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.
Page 26: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.
Page 27: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

CONCLUSIONS

A distance matrix is defined according to the information between two sub-area connectivity. Ant colony algorithm is used to optimize the coverage order according to the distance matrix.

Simulation result shows that this algorithm not only ensures to coverage all work space but also gets a shorter planning path ,a smaller overlap rate of path and a higher efficiency of planning. The complete coverage process had been carried out by the robot we developed.

Page 28: Complete Coverage Path Planning Based on Ant Colony Algorithm International conference on Mechatronics and Machine Vision in Practice, p.p. 357-361, Dec.

The algorithm we proposed is highly real time and has less information to be deal with. But sometimes, it is hard to avoid recovered area nearby the obstacle. However, it is a great improvement to the precious algorithms.

Optimization of the modeling for complex environment is the

next subject to be studied.