Research on Model and Algorithm of Task Allocation and Path Planning for Multi-Robot

Based on the modeling of robot working environment, the shortest distance matrix between points is solved by Floyd algorithm. With the objective of minimizing the sum of the fixed cost of robot and the cost of robot operation, an integer programming model is established and a genetic algorithm for solving the model is designed. In order to make coordination to accomplish their respective tasks for each robot with high efficiency, this paper uses natural number encoding way. The objective function is based on penalty term constructed with the total number of collisions in the running path of robots. The fitness function is constructed by using the objective function with penalty term. Based on elitist retention strategy, a genetic algorithm with collision detection is designed. Using this algorithm for task allocation and path planning of multi-robot, it can effectively avoid or reduce the number of collisions in the process of multi-robot performing tasks. Finally, an example is used to validate the method.


Introduction
With the development of industrial robot technology [1], a single robot cannot meet the needs of society, and many robots cooperate to accomplish complex and dangerous tasks [2].In the process of multi-robot collaborative performing tasks, if the collision occurs between robots, it will cause losses such as robot damage, prolong the working time, and even make the system paralyzed, so planning the path for robots should reduce the occurrence of collisions as far as possible.
For the problem of robot's path planning, many scholars have studied it.Par-ticle swarm optimization algorithm or navigation algorithm are used to solve the problem [3] [4] [5] [6] [7].In the aspect of robot's task allocation, task allocation strategy [8] and ant colony algorithm are adopted [9] [10].In the part of collision avoidance, improved artificial potential field obstacle avoidance method [11] and robot's collision avoidance algorithm based on RRT are adopted [12].
These scholars have proposed different algorithms to solve the problems of robot's path planning, task allocation and collision avoidance respectively.But few people establish integer programming models and corresponding algorithms to solve them.Considering the maximum running time of a single robot, this paper aims at minimizing the sum of the robot's fixed cost and the robot's running cost.An integer programming model for task allocation and path planning of multi-robot with collision detection is proposed.Introducing collision penalty term, a genetic algorithm with collision detection is designed to calculate the optimal number of robots, the tasks completed by each robot and the collision free path of each robot, making the total cost of the detection tasks lowest.

Problem Description
A factory uses m robots to complete the monitoring of n monitoring points.
Each robot filled with power can travel limited distance continuously and each monitoring point is monitored with equal time.When the task is executed, each robot starts from the platform at the same time, and tries to avoid collisions among them during the process of performing tasks, and finally returns to the departure platform.In the process of completing tasks, the robot performs only one task, each task requires only one robot to complete, each task is only performed once, and all tasks will be executed.The call cost and the operating cost of per unit distance are known for each robot, calculating the optimal number of robots to complete tasks, and planning the path of each robot, making the total cost of monitoring tasks completed lowest.

Mathematical Model
In order to establish the model, the following symbols are defined: 0: Represents departure platform; { } Represents the adjacency distance matrix between feasible grids; when 1 ij a = represents the point i adjacent to the point of j, i and j are feasible grid points, otherwise 0 ij a = .
Define the following decision variables: Robot from the point of arrives at the point of directly at time 1, 0, otherwise; ; ; , 1, Robot and Robot occur collision at the point of at time 0, otherwise; ; , ; ; In order to reduce collisions between robots' paths, a penalty term is constructed based on the number of collisions between paths.By introducing the penalty term into the objective function, an integer programming model for the task allocation and path planning of multi-robot with collision penalty is established. ; ; ; ;

2
; , ; , ; ; (1) Represents the minimum total cost with a penalty item;  13), ( 14), ( 15) Represent a decision variable value constraint; Since it will take too long to solve the integer programming model directly, we will design a genetic algorithm with collision detection to solve the task allocation planning problem for large scale robots.

Genetic Algorithm with Collision Detection
The steps of the genetic algorithm will not be described, and then the collision detection method proposed in this paper will be described in detail [13].
In order to avoid the robot's collision loss, the collision penalty term is added to the calculation of the objective function and the fitness value.The collision penalty term is defined according to the number of collisions between the robot paths.
The following examples are combined with specific examples to describe the collision number detection algorithm.
According to the layout of a warehouse, the working environment after modeling by using the serial number grid method is shown in Figure 1.The gray squares represent the infeasible areas, the red squares represent the departure platforms, and the blue squares represent the points to be monitored.There are 10 monitoring points in the warehouse, which are indicated by serial numbers { } 1) First, Figure 1 is shown with the adjacency distance matrix A, and the adjacency matrix is used to store the graph.Floyd algorithm [14] [15] is used to solve the shortest path between any two points in the network.In this paper, the Floyd algorithm is implemented by MATLAB, and the shortest distance matrix and the routing matrix between any two points in the graph are calculated by the adjacency distance matrix, and can query the shortest distance between any two points and routing.
2) Suppose the robots walk within one grid per unit time, and the distances traveled by robots are quantified by the number of grids.Two units of time are Similarly, the path of 2 R and the path of 3 R can be obtained.
3) The paths for each robot to complete their monitoring tasks can be traced by the routing matrix calculated by the Floyd algorithm.Then the shortest distance matrix is solved according to the Floyd algorithm, and the driving distance of each robot is obtained.Each robot starts at the same time from the starting platform and runs at the same speed, In the process of performing tasks, the robot will collide when and when the two robots arrive at the same grid point at the same time.It can be described as follows: 4) In order to reduce the collision, a penalty term is added to the individual objective function according to the total number of collisions of each robot path in the individual, so that the population is continuously optimized.First, a collision algorithm is used to solve the total number of collisions CN between all paths of two robots corresponding to a chromosome, which is used as a measure of punishment.Take CN λ as the penalty term, among which ( ) CN is the total number of collisions on a single chromosome, ( ) is the Correction parameter of penalty.
( ) x is the sum of corresponding objective function and collision penalties of individual i x .
5) Selection, crossover, mutation and other operations are performed according to genetic algorithms until the iteration goes to the maximum iteration path.The approximate optimal solution or optimal solution obtained is the optimal path.

Case Solving
In the warehouse layout shown in Figure 1, the gray grid represents the infeasible area, the red grid represents the departure platform and the blue grid represents the monitoring point.At the same time, each robot starts from the departure platform and completes the monitoring task of ten points to be monitored, which is { } 18,30,112,135,157,196, 223, 235, 245, 267 .The warehouse has a total of 10 robots available, each robot filled with electricity can work continuously for 60 units of time and the speed of each robot is equal.The fixed cost of call a robot is 60 yuan and the cost of each robot driving unit distance is 2 yuan.
The program code is written by MATLAB, and the total number of collisions of each chromosome is calculated by the collision detection method, and the fitness of the penalty term is further calculated.Set the population size is 50 and the maximum evolution algebra is 100.In windows 7 (g4, 2G, 32 operating system) environment run the algorithm program 30 times [13].
According to the working environment of the robot in Figure 1, the adjacency matrix is used to store Figure 1.Based on the advantages of the Floyd algorithm, the distance matrix and the routing matrix between any two points in the adjacency distance matrix can be calculated.The optimum number of robots is 3 based on a genetic algorithm with collision detection.The program with collision detection algorithm runs 30 times, and in the 30 run, the corresponding statistical results of the running distance of 3 robots are: the average value is 86.13, the maximum value is 90, the minimum value is 80, and the standard deviation is 2.36.The total cost of 3 robots completed tasks are: the average total cost is 357.62, the maximum is 364, the minimum is 340, and the standard deviation is 5.51.The statistical results of running the program for 30 times are: the average time is 33.65, the maximum is 37.86, the minimum is 29.96, and the standard deviation is 2.39.
Figure 2 is an iterative graph of an optimal solution.It can be seen that when the genetic algorithm program with collision detection runs, it converges to the  It can be seen from Figure 3 that the optimal running path of 3 robots can be solved by using genetic algorithm with collision detection.Although the paths of V1, V2 and V3 shown in Figure 3 having overlapping parts, 3 robots leave the platform at the same time and the robots run at the same speed, so the time to run to the same path point is different and there will be no collisions actually.

Concluding Remarks
This paper studies the problem of multi-robot path planning based on genetic algorithm.Firstly, the adjacency matrix is used to store the example data.The shortest distance matrix and the routing matrix between the detected points are solved by using the Floyd algorithm according to the adjacency distance matrix [16].The shortest time matrix is obtained from the shortest distance matrix, and the initial population is generated randomly according to the genetic algorithm.
The task is assigned to robots with the longest running time of each robot as the constraint.Using the backtracking routing function of Floyd algorithm, the path of each robot is obtained according to the tasks assigned to each robot.The genetic algorithm of collision detection is used to solve the task allocation and path planning model of multi-robot, getting the optimum number of robots.The tasks each robot needs to accomplish, and the least cost collision free path is planned at the same time.
On the one hand, a collision detection algorithm is designed to avoid collisions in the running process of multi-robots; on the other hand, with the longest running time of each robot as the constraint, using the least robot completes the monitoring tasks making the total cost lowest.The genetic algorithm with collision detection designed in this paper can solve the problem of task allocation and path planning of multi-robot simultaneously.
In this paper, assuming that all robots start from the same platform, the collision between multi-robot can be further reduced by adjusting the starting platform of each robot actually; this paper does not consider the priority of robots to avoid collisions, so the robot can be based on a certain priority rules for collision avoidance.In the following research, we will consider these factors and further study the problem.
(2) Represents each robot must leave from platform 0; (3) Represents each robot must return to the platform point after completing the inspection task; (4) Represents each robot cannot return to the departure platform 0; (5) Represents each robot cannot leave the platform 1 n + ; (6) Represents each monitoring point is also being ser- viced by one robot; (7) Represents each robot arrived at the monitoring point of j must leave from the monitoring point of j; (8) Represents each robot arriving at the general grid point J must leave from the first J point; (9) Represented a robot serviced for a monitoring point must have reached the monitoring point; (10), (11) Represent robot k and robot p occur collision at time t; (12) Represents robots can only walk into an adjacent grid within a unit time; (

Figure 2 .
Figure 2. Convergence process of genetic algorithm.

Figure 3 .
Figure 3.The running path of robots this paper.