Multi-robot cooperative carrying safety formation optimization method based on differential evolution

The formation design of multi-robot collaborative handling is optimized through differential evolution algorithm, and the stability cone is used to represent anti-turning capabilities, solving the problem of risk of large components in multi-robot collaborative handling, improving safety and transportation efficiency.

CN119004981AActive Publication Date: 2024-11-22NANJING UNIV OF AERONAUTICS & ASTRONAUTICS
View PDF 5 Cites 0 Cited by

Patent Information

Application Number
CN202411091816.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-09
Publication Date
2024-11-22
Estimated Expiration
2044-08-09

AI Technical Summary

Technical Problem

When multi-robots cooperate to carry large and heavy loaded components, they are prone to risks of biased load and overturn due to inertia, out-of-synchronization of the lift and inconsistent steering. The prior art is mainly considered from the perspective of formation control but failed to Effectively improve safety.

Method used

The safe formation optimization method of multi-robot collaborative handling based on differential evolution algorithm is adopted, and the stable cone is used to represent anti-turning ability. By optimizing the formation design of multi-robot collaborative handling, the anti-turning ability of large components is improved to ensure safe handling.

Benefits of technology

By optimizing the formation design, the safety of multi-robot collaborative handling and mobile operation scheduling efficiency are improved, the risk of large components turning over during transportation is reduced, and the safe transportation of large sizes and heavy loads is ensured.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119004981A_ABST
    Figure CN119004981A_ABST
Patent Text Reader

Abstract

A multi-robot cooperative carrying safety formation optimization method based on differential evolution is characterized by comprising the following steps that 1, a three-dimensional coordinate system is established through the bottom face of a rectangular bracket bearing large components, and the contact position of a mobile robot and the rectangular bracket serves as a supporting coordinate of the mobile robot; 2, optimizing the number of formation robots according to the weight of the large component and the scheduling condition of each type of mobile robot; 3, the anti-rollover capability of the whole formation is represented in a stable cone mode; 4, establishing a multi-robot cooperative carrying safety formation optimization model by taking the anti-rollover capability as a target function; and 5, realizing safe carrying formation optimization by using a differential evolution algorithm. The invention aims to improve the safety of multi-robot cooperative carrying and optimize the carrying operation scheduling of the robots at the same time.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to a robot technology, in particular to a method for configuring a handling robot, specifically a method for optimizing a safe formation for collaborative handling of multiple robots based on differential evolution, which belongs to a method for designing a safe formation for collaborative handling of multiple robots. The goal is to improve the safety of collaborative handling of multiple robots from the perspective of formation design, while optimizing the scheduling of mobile robot handling operations. Background Art

[0002] For the transportation of large parts such as long cylinders, long columns, and large-sized wing-shaped parts, a single mobile robot is limited by its load-bearing capacity and external dimensions and cannot meet the transportation requirements. Therefore, multiple robots are needed for collaborative transportation. When multiple robots collaborate to transport large, heavy-loaded parts, they are affected by inertia, asynchronous lifting, and uncoordinated steering during the turning process, which can cause overloads and the risk of tipping over. In the face of these tipping problems, the current considerations are more from the perspective of formation control rather than from the perspective of formation design to comprehensively improve the safety of multi-robot collaborative transportation.

[0003] The present invention takes into account the optimization of the scheduling of mobile robot handling operations and schedules different types of mobile robots to collaboratively carry large components. The formation of different types of mobile robots collaboratively carrying heavy objects is optimized to improve the safety of multi-robot collaborative handling and optimize the scheduling of mobile robot handling operations. Summary of the invention

[0004] The purpose of the present invention is to target the scenario of multi-robot collaborative transport of large components. From the perspective of improving the anti-rollover ability of the formation and ensuring that large-sized and heavy-loaded large components are safely transported to the target location, a multi-robot collaborative transport safety formation optimization method based on differential evolution is invented. The method of using a stable cone is used to represent the anti-rollover ability of the stable cone according to the tilting angles of the large components along each side. The differential evolution algorithm is used to optimize the formation of multi-robot collaborative transport in a high-dimensional nonlinear space. This method can more effectively explore continuous space, thereby showing higher solution efficiency when dealing with continuous optimization problems, quickly solving the optimal formation, and improving the safety of the multi-robot collaborative transport process.

[0005] The technical solution of the present invention is:

[0006] A multi-robot collaborative handling safety formation optimization method based on differential evolution is characterized by: firstly, a three-dimensional coordinate system is established according to the bottom surface of the bracket carrying the large component; according to the weight of the large component to be transported and the scheduling of various types of mobile robots, a minimum number of idle mobile robots of the same or different models are selected; the anti-rollover ability of the entire formation is represented by a stability cone, and a multi-robot collaborative handling safety formation optimization model is established with the anti-rollover ability as the objective function; and a differential evolution algorithm is used to achieve the optimization of the safe handling formation.

[0007] The specific steps include:

[0008] Step 1: Establish a three-dimensional coordinate system based on the bottom surface of the bracket that carries the large component, and obtain the three-dimensional coordinates of the center of mass of the large component;

[0009] Step 2: According to the weight of the large component and the scheduling of each mobile robot, optimize the scheduling of the minimum number of n idle mobile robots to ensure that the total safe load-bearing capacity of all mobile robots is greater than the weight of the large component and the bracket. Obtain information such as the size of the n mobile robots and the floating radius of the floating platform, establish a multi-robot collaborative handling model, use the contact center between the mobile robot and the bracket as the support coordinate of the mobile robot, and obtain the three-dimensional coordinates of the support points of each mobile robot;

[0010] Step 3: According to the definition of the stability cone, the coordinates of all mobile robot support points are obtained as the corner points of the stability cone, the coordinates of the center of mass of the large component are obtained as the vertex of the stability cone, and the minimum angle required for the vertex to tip over along the bottom edges of the stability cone is calculated to measure the anti-tipping ability of the entire formation;

[0011] Step 4: Taking the minimum tilting angle of the stability cone along each side of the bottom polygon as the evaluation index for the design of the multi-robot collaborative handling safety formation, a formation optimization design model is established;

[0012] Step 5: Taking the horizontal and vertical coordinates of n mobile robots as unknown quantities, obtain the initial population through the improved initial population generation method, and set the differential evolution algorithm parameters;

[0013] Step 6: Generate offspring population through improved crossover and mutation operations;

[0014] Step 7: Calculate the fitness of the offspring population generated by step 6 according to the multi-robot collaborative handling safety formation optimization design objective function. By comparing the fitness values ​​of the original population and the offspring population, select excellent individuals to join the next generation population. If the maximum number of iterations is reached, execute step 8, otherwise execute step 6.

[0015] Step 8: According to the optimal fitness value, obtain the corresponding population individual value and map it into the coordinates of n mobile robots, that is, the optimal formation representation.

[0016] The beneficial effects of the present invention are:

[0017] The present invention can quickly select the minimum number of mobile robots that can safely lift the large component according to the weight of the large component and the scheduling of each mobile robot, and adjust the coordinates of each mobile robot according to the coordinates of the center of mass of the large component using a differential evolution algorithm, so that the anti-tilting ability of the stable cone composed of the center of mass of the large component and each mobile robot is stronger, thereby improving the safety of multi-robot collaborative handling from the perspective of formation design. At the same time, the scheduling of robot handling operations is optimized. BRIEF DESCRIPTION OF THE DRAWINGS

[0018] Figure 1 It is a flow chart of the present invention. DETAILED DESCRIPTION

[0019] The present invention is further described in detail below with reference to the accompanying drawings and implementation examples.

[0020] like Figure 1 Shown

[0021] A multi-robot collaborative handling safety formation optimization method based on differential evolution. First, a three-dimensional coordinate system is established according to the bottom surface of the bracket carrying large components. According to the weight of the large components to be transported and the scheduling of various types of mobile robots, the minimum number of idle mobile robots is optimally scheduled, and the models of mobile robots may be different. The anti-rollover ability of the entire formation is represented by a stability cone, and a multi-robot collaborative handling safety formation optimization model is established with the anti-rollover ability of the formation as the objective function. The differential evolution algorithm is used to achieve safety formation optimization.

[0022] Figure 1 The flowchart of the present invention specifically includes the following steps:

[0023] Step 1: Establish a three-dimensional coordinate system based on the bottom surface of the bracket that carries the large component, and obtain the three-dimensional coordinates of the center of mass of the large component; that is, establish a three-dimensional coordinate system based on the bottom surface of the bracket that carries the large component in actual application, with the center of the rectangular bottom surface as the coordinate origin, the bottom surface of the bracket as the XY plane, and the coordinates of the center of mass of the large component obtained by the Z axis perpendicular to the XY plane through the origin are (X p ,Y p ,Z p ).

[0024] Step 2: According to the weight of the large component and the scheduling of each mobile robot, optimize the scheduling of the minimum number of n idle mobile robots to ensure that the total safe load-bearing capacity of all mobile robots is greater than the weight of the large component and the bracket. Obtain information such as the size of the n mobile robots and the floating radius of the floating platform, establish a multi-robot collaborative handling model, and use the contact center between the mobile robot and the bracket as the support coordinate of the mobile robot to obtain the three-dimensional coordinates of the support point of each mobile robot; Assume that there are k types of mobile robots, and the maximum safe load-bearing capacity of each mobile robot is G i , i = 1, 2, 3, 4...k, the size of each mobile robot is different, and the minimum circumscribed circle radius of each mobile robot is r i , i=1,2,3,4...k. The weight of the large component is G, and ni mobile robots of type i are selected so that and The value is the smallest. Assuming that the total number of mobile robots is n, the set of mobile robots that can collaboratively lift large parts is M = {M 1 ,M 2 ,M 3 ,…,M n}, the position and type information of the mobile robots in the multi-robot collaborative transport team is expressed as formula (1). The position and size information of each mobile robot is represented by a four-dimensional vector:

[0025] M i =[X i ,Y i ,R i ,r i ] T (1)

[0026] In formula (1), X i ,Y i is the horizontal and vertical coordinates of the contact point between the i-th mobile robot and the large component, R i is the minimum circumscribed circle radius of the i-th mobile robot, r i is the floating radius of the floating platform of the i-th mobile robot.

[0027] Step 3: According to the definition of the stable cone, the coordinates of all mobile robot support points are obtained as the corner points of the stable cone, the coordinates of the center of mass of the large component are obtained as the vertex of the stable cone, and the minimum angle required for the vertex to tip over along the bottom edges of the stable cone is calculated to measure the anti-tipping ability of the entire formation; According to the definition of the stable cone, the coordinates of all mobile robot support points are taken as the corner points A of the stable cone. i,i=1,2,...,n, the centroid coordinates of the large component are used as the vertex P of the stable cone. The stable cone requires that the bottom polygon is a convex polygon. This patent uses the vector outer product to determine whether the angle between two vectors is a non-obtuse angle. Through formulas (2) and (3), it can be concluded that if any edge of the bottom polygon satisfies formula (4), the bottom polygon can be judged to be a convex polygon.

[0028]

[0029] (x i+1 -x i )(y i+2 -y i+1 )-(y i+1 -y i )(x i+2 -x i+1 )>0 (4)

[0030] Among them, A i is the i-th vertex of the bottom polygon, x i ,y i is the horizontal and vertical coordinates of the ith vertex of the bottom polygon. The bottom polygon is represented by a vector, as shown in formula (5):

[0031]

[0032] Therefore, the vector passing through the vertex P and perpendicular to the tipping edge can be expressed by formula (6):

[0033]

[0034] in The angle at which the stability cone tilts along the edge can be determined by the centroid vector Perpendicular vector to the tipping edge The angle between the two is calculated as shown in formula (7):

[0035]

[0036] Step 4: Take the minimum tilting angle of the stability cone along the sides of the bottom polygon as the evaluation index of the multi-robot collaborative handling safety formation design, and establish the formation optimization design model; find the minimum angle from the tilting angles of the stability cone along the sides obtained in step 3, and make the minimum tilting angle of the stability cone as large as possible, which means that the less likely the stability cone is to tip over, that is, the stronger the anti-tipping ability of the multi-robot collaborative handling safety formation is. Therefore, the objective function is shown in formula (8):

[0037]

[0038] Step 5: Taking the horizontal and vertical coordinates of n mobile robots as unknown quantities, obtain the initial population through the improved initial population generation method, and set the differential evolution algorithm parameters; according to the minimum number of mobile robots n obtained in step 2, the horizontal and vertical coordinates of each mobile robot are variable parameters, and there are 2n variable parameters in total. The initial population is generated through the improved initial population generation method of the present invention, mainly within the contact range of large parts, randomly generate horizontal and vertical coordinates for each mobile robot. If the conditions are met, this position allocation scheme is used as an individual in the initial population. At the same time, two mobile robots are selected to exchange their coordinates. If the conditions are met, they are added to the initial population. The initial population is generated according to this idea, which can greatly reduce the time spent on the initial population generation. Set the algorithm parameters before the algorithm starts: population size NP = 100, mutation operator α = 0.09, crossover operator CR = 0.6, maximum evolution generation GEN = 200.

[0039] Step 6: Generate the offspring population through improved crossover and mutation operations; perform mutation operation on the parent population. For each individual in the population, randomly select three different individuals from the population, calculate their difference vectors, and then linearly combine the difference vector with the current population individual to obtain a new individual. The calculation method of the mutant individual is shown in formula (9):

[0040] Q=P i +α(P j -P k ) (9)

[0041] Where P i ,P j ,P k are three random individuals in the current population, and α is the mutation operator;

[0042] Then, a value is randomly generated in the range of (0, 1). When the value is less than the value of the crossover operator CR, the mutant individual and the current individual are selected for crossover to form a new individual, as shown in formula (10):

[0043]

[0044] Step 7: Calculate the fitness of the offspring population generated by step 6 according to the objective function of the multi-robot collaborative handling safety formation optimization design. By comparing the fitness values ​​of the original population and the offspring population, select excellent individuals to join the next generation population. If the maximum number of iterations is reached, execute step 8, otherwise execute step 6; for the offspring population generated in step 6, calculate the fitness value of each individual according to the objective function, and copy S copies of the population individual corresponding to the maximum fitness value and add them to the new population. The remaining NP-S population individuals are generated by roulette, that is, the new population is generated by combining the elite retention strategy and the roulette algorithm; at the same time, record the optimal fitness value and average fitness value of each generation of the population.

[0045] Step 8: According to the optimal fitness value, obtain the corresponding population individual value and map it into the coordinates of n mobile robots, that is, the optimal formation representation. Decode the population individual corresponding to the best fitness value obtained in step 7 and map it into the coordinates of n mobile robots to obtain the optimal formation.

[0046] The present invention does not involve parts that are the same as the prior art or can be implemented by using the prior art.

Claims

1. A multi-robot collaborative handling safety formation optimization method based on differential evolution, characterized by: Firstly, a three-dimensional coordinate system is established according to the bottom surface of the bracket carrying large components. Secondly, a minimum number of idle mobile robots of the same or different models are selected according to the weight of the large components to be transported and the scheduling of various types of mobile robots. Finally, the anti-rollover ability of the entire formation is represented by the stability cone, and a multi-robot collaborative handling safety formation optimization model is established with the anti-rollover ability as the objective function. Finally, the differential evolution algorithm is used to achieve the optimization of the safe handling formation.

2. The method according to claim 1, characterized in that: The steps include: Step 1: Establish a three-dimensional coordinate system based on the bottom surface of the bracket that carries the large component, and obtain the three-dimensional coordinates of the center of mass of the large component; Step 2: According to the weight of the large component and the scheduling of each mobile robot, optimize the scheduling of the minimum number n of idle mobile robots to ensure that the total safe load-bearing capacity of all mobile robots is greater than the weight of the large component and the bracket; obtain the size of the n mobile robots and the floating radius of the floating platform, establish a multi-robot collaborative handling model, take the contact center between the mobile robot and the bracket as the support coordinate of the mobile robot, and obtain the three-dimensional coordinates of the support point of each mobile robot; Step 3: According to the definition of the stability cone, the coordinates of all mobile robot support points are obtained as the corner points of the stability cone, the coordinates of the center of mass of the large component are obtained as the vertex of the stability cone, and the minimum angle required for the vertex to tip over along the bottom edges of the stability cone is calculated to measure the anti-tipping ability of the entire formation; Step 4: Taking the minimum tilting angle of the stability cone along each side of the bottom polygon as the evaluation index for the design of the multi-robot collaborative handling safety formation, a formation optimization design model is established; Step 5: Taking the horizontal and vertical coordinates of n mobile robots as unknown quantities, obtain the initial population through the improved initial population generation method, and set the differential evolution algorithm parameters; Step 6: Generate offspring population through improved crossover and mutation operations; Step 7: Calculate the fitness of the offspring population generated by step 6 according to the multi-robot collaborative handling safety formation optimization design objective function. By comparing the fitness values ​​of the original population and the offspring population, select excellent individuals to join the next generation population. If the maximum number of iterations is reached, execute step 8, otherwise execute step 6. Step 8: According to the optimal fitness value, obtain the corresponding population individual value and map it into the coordinates of n mobile robots, that is, the optimal formation representation.

3. The method according to claim 2, characterized in that In step 1: According to the bottom surface of the bracket that carries the large component in actual application, the three-dimensional coordinate system is established with the center of the rectangular bottom surface as the coordinate origin, the bottom surface of the bracket is the XY plane, and the coordinates of the center of mass of the large component are obtained by passing through the origin perpendicular to the XY plane as the Z axis (X p ,Y p ,Z p ).

4. The method according to claim 2, characterized in that: In step 2: Assume that there are k types of mobile robots, and the maximum safe load of each mobile robot is G i , i = 1, 2, 3, 4...k, the size of each mobile robot is different, and the minimum circumscribed circle radius of each mobile robot is r i , i = 1, 2, 3, 4...k; the weight of the large component is G, select n i The i-th type of mobile robot makes and The value is the smallest. Assuming that the total number of mobile robots is n, the set of mobile robots that can collaboratively lift large parts is M = {M1, M2, M3, …, M n }, the position and type information of the mobile robots in the multi-robot collaborative transport team is expressed as formula (1); the position and size information of each mobile robot is represented by a four-dimensional vector: M i =[X i ,Y i ,R i ,r i ] T (1) In formula (1), X i ,Y i is the horizontal and vertical coordinates of the contact point between the i-th mobile robot and the large component, R i is the minimum circumscribed circle radius of the i-th mobile robot, r i is the floating radius of the floating platform of the i-th mobile robot.

5. The method according to claim 2, characterized in that: In step 3: According to the definition of the stability cone, the coordinates of all mobile robot support points are taken as the corner points A of the stability cone. i , i=1,2,...,n, the centroid coordinates of the large component are used as the vertex P of the stable cone; the stable cone requires that the bottom polygon is a convex polygon, and the vector outer product is used to determine whether the angle between the two vectors is a non-obtuse angle. By using formulas (2) and (3), it can be concluded that if any edge of the bottom polygon satisfies formula (4), the bottom polygon can be judged to be a convex polygon; (x i+1 -x i )(and i+2 -and i+1 )-(and i+1 -and i )(x i+2 -x i+1 )>0 (4) Among them, A i is the i-th vertex of the bottom polygon, x i ,y i is the horizontal and vertical coordinates of the i-th vertex of the bottom polygon; the bottom polygon is represented by a vector, as shown in formula (5): Therefore, the vector passing through the vertex P and perpendicular to the tipping edge can be expressed by formula (6): in The angle at which the stability cone tilts along the edge can be determined by the centroid vector Perpendicular vector to the tipping edge The angle between the two is calculated as shown in formula (7): 。 6. The method according to claim 2, characterized in that In step 4: The minimum angle is found from the tipping angles of the stability cone along each edge obtained in step 3. The minimum tipping angle of the stability cone is maximized. The less likely the stability cone is to tip over, the stronger the anti-tip ability of the multi-robot collaborative handling safety formation is. Therefore, the objective function is shown in formula (8): 。 7. The method according to claim 2, characterized in that In step 5: According to the minimum number of mobile robots n obtained in step 2, the horizontal and vertical coordinates of each mobile robot are variable parameters, and there are 2n variable parameters in total. The initial population is generated through the improved initial population generation method. The horizontal and vertical coordinates are randomly generated for each mobile robot within the contact range of the large parts. If the conditions are met, this position allocation scheme is used as an individual in the initial population. At the same time, two mobile robots are selected to exchange their coordinates. If the conditions are met, they are added to the initial population. The initial population is generated according to this idea, which can greatly reduce the time spent on the initial population generation. Before the algorithm starts, set the algorithm parameters: population size NP = 100, mutation operator α = 0.09, crossover operator CR = 0.6, maximum evolution generation GEN = 200.

8. The method according to claim 2, characterized in that: In step 6: The parent population is mutated. For each individual in the population, three different individuals are randomly selected from the population, their differential vectors are calculated, and then the differential vector is linearly combined with the current population individual to obtain a new individual. The calculation method of the mutant individual is shown in formula (9): Q=P i +α(P j -P k ) (9) Where P i ,P j ,P k are three random individuals in the current population, and α is the mutation operator; Then, a value is randomly generated in the range of (0, 1). When the value is less than the value of the crossover operator CR, the mutant individual and the current individual are selected for crossover to form a new individual, as shown in formula (10): 。 9. The method according to claim 2, characterized in that: In step 7: For the offspring population generated in step 6, the fitness value of each individual is calculated according to the objective function. For the population individual corresponding to the maximum fitness value, S copies are added to the new population. The remaining NP-S population individuals are generated by roulette, that is, the new population is generated by combining the elite retention strategy and the roulette algorithm. At the same time, the optimal fitness value and average fitness value of each generation of the population are recorded.

10. The method according to claim 2, characterized in that In step 8: The population individuals corresponding to the best fitness values ​​obtained in step 7 are decoded and mapped into the coordinates of n mobile robots to obtain the optimal formation.

Citation Information

Patent Citations

  • Robot calibration method based on improved differential evolution algorithm

    CN108908335A

  • Cooperative working method and system for multiple mobile robots

    CN109986563A

  • Multi-unmanned aerial vehicle ground search task formation optimization method under implicit communication condition

    CN113741513A

  • Fuzzy adaptive balance control algorithm for wheel-track leg robot

    CN114721415A

  • Discrete differential evolution-based multi-strategy optimization x-architecture minimum tree construction method

    WO2021218157A1