Terminal time cooperative control method for adaptive grouping of multiple unmanned vehicles
By building a relative kinematic model and communication network, combined with non-smooth control, the adaptive packetization and terminal time collaborative control of multiple unmanned vehicles is realized, and the efficiency and risk problems of reaching the target position in the coordinated operation of multiple unmanned vehicles are solved. , realizes efficient collaborative operation and robustness of unmanned vehicle groups.
Patent Information
- Application Number
- CN202410376368.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-03-29
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2044-03-29
AI Technical Summary
The problem that prior art is difficult to achieve the arrival of multiple independent groups to the target locations in the time domain through group division, especially in the coordinated operation of multiple unmanned vehicles, resulting in low task efficiency and increased risk.
The terminal time collaborative control method of multi-unit vehicle group scale adaptive packet is adopted. By constructing a relative kinematic model between the unmanned vehicle and the target position, the terminal time range is calculated, the communication network structure is established, information interaction is carried out, and the group division is determined. , and use non-smooth control to build an acceleration control scheme to ensure that the unmanned vehicle reaches its target position at the same time within the expected time.
Automatic grouping and coordinated operation of unmanned vehicles is realized, ensuring that unmanned vehicles in each group arrive at the target position at the same time, with good robustness and task efficiency, and reducing the risk of task failure.
Smart Images

Figure CN118226857B_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the field of multi-agent control, and in particular relates to a terminal time collaborative control method for adaptively grouping a group of multiple unmanned vehicles. Background Art
[0002] With the development of swarm intelligence technology, the collaborative operation of multiple unmanned vehicles has become a hot research direction. In order to give full play to the collaborative advantages and maximize the benefits of task execution, the collaborative control of unmanned vehicle groups often needs to consider time constraints and efficiency. Taking forest fire emergency engineering as an example, when a single unmanned vehicle cannot release enough fire-fighting materials to suppress the fire due to limited load, a certain number of unmanned vehicles are required to go to the fire area to work together and release fire-fighting materials at the same time. In this context, applying collaborative motion control to the unmanned vehicle group and coordinating the terminal time of each unmanned vehicle to reach the target location so that they arrive at the fire area at the same time can effectively reduce the residence time of each unmanned vehicle in the fire area and reduce the risk of damage faced by the unmanned vehicle that arrives at the fire area first during the waiting process. However, due to the initial position deployment and motion performance of each unmanned vehicle, its terminal time consistency may not be achieved. Therefore, it is necessary to carry out research on the terminal time collaborative control of multiple unmanned vehicles based on group size adaptive grouping, so that each group of unmanned vehicles can arrive at the target location at the same time and meet the group size quantity requirements driven by the task.
[0003] At present, there are relatively few literatures on the time cooperative control method of group terminals, which mainly focus on the research of saturation attack problem of missile group. For example, the proportional guidance method is used to estimate the remaining time for the missile to hit the target, and the estimated time is used as the output to achieve consistency. The existing technology is as follows [1] (see Jialing Zhou and Jianying Yang. Distributed Guidance Law Design for Cooperative Simultaneous Attacks with Multiple Missiles [J]. Journal of Guidance, Control, and Dynamics, 2016, 39 (10): 2439-2447.); or, the missile-target distance converges to achieve simultaneous target hitting. The existing technology is as follows [2] (see Jun Zhou, Yang Wang, and Bin Zhao. Impact-Time-Control Guidance Law for Missile with Time-Varying Velocity [J]. Mathematical Problems in Engineering, 2016, 4: 1-14). Existing technologies mainly focus on the problem of multiple agents reaching the target location at the same time, but the problem of enabling multiple independent groups to reach the target location separately by group division in the time domain remains to be solved.
[0004] This patent proposes a terminal time coordination control method for adaptive grouping of multiple unmanned vehicle groups, which can self-organize and coordinate the movement of unmanned vehicles in real time and has strong robustness, effectively avoiding the problem of mission failure caused by harsh environment. The terminal time coordination control method for adaptive grouping of multiple unmanned vehicle groups can be applied to tasks such as unmanned system group coordinated firefighting, and has a wide range of practical application value. Summary of the invention
[0005] The purpose of the present invention is to provide a terminal time collaborative control method for adaptively grouping multiple unmanned vehicle groups, so as to solve the problem of achieving multiple independent groups arriving at the target location by group division in the time domain.
[0006] To achieve the above object, the present invention provides a terminal time coordination control method for adaptively grouping multiple unmanned vehicle groups, comprising the following steps:
[0007] Step 1: Construct a relative kinematic model between the unmanned vehicle and the target position;
[0008] Step 2: Calculate the terminal time estimate of each unmanned vehicle based on the relative kinematic model constructed in step 1, and determine the terminal time range estimate of each unmanned vehicle through speed limit;
[0009] Step 3: Build a communication network structure between the unmanned vehicles, so that the unmanned vehicles can exchange information multiple times and obtain the terminal time range estimation of all unmanned vehicles;
[0010] Step 4: According to the estimated time range of each unmanned vehicle terminal and the minimum number of unmanned vehicles required in each group, determine the reachable domain of the time range of the unmanned vehicles in each group, and complete the self-adaptive group division of the unmanned vehicles;
[0011] Step 5: Based on the relative kinematics model constructed in step 1, non-smooth control is used to construct the acceleration component control perpendicular to the line of sight, so that the velocity component of each unmanned vehicle perpendicular to the line of sight converges to zero within the expected time;
[0012] Step 6: Based on the relative kinematics model constructed in step 1 and the information interaction between the unmanned vehicles, establish the acceleration component control along the line of sight direction;
[0013] Step 7: construct the acceleration and angular acceleration control scheme of the unmanned vehicle according to the communication network structure in step 3, the grouping of the unmanned vehicles in step 4, and the acceleration control schemes perpendicular to the line of sight and along the line of sight established in steps 5 and 6;
[0014] Step 8: Update the position and speed of the unmanned vehicle according to the relative kinematic model constructed in step 1 and the communication network structure in step 3, and determine whether the unmanned vehicles in each group arrive at the target position at the same time. If the unmanned vehicles in each group arrive at the target position at the same time, stop sending information to the outside; if the unmanned vehicles in each group do not arrive at the target position at the same time, re-group the lagging unmanned vehicles in each group, and return to step 5 to continue execution.
[0015] Preferably, the specific process of step 1 is as follows:
[0016] In the inertial coordinate system, for the unmanned vehicle group For driverless cars The following kinematic model is established:
[0017]
[0018] in, is the position coordinate of the center of mass of the unmanned vehicle, θ i is the heading angle of the unmanned vehicle i, specifically the angle between the velocity and the positive direction of the x-axis, ω i is the rate of change of the heading angle of the unmanned vehicle, v i is the speed of the unmanned vehicle, a q,i with af,i They represent the tangential acceleration and normal acceleration of the unmanned vehicle i respectively;
[0019] Assume the target position is (x # ,y # ), the relative position relationship between the unmanned vehicle i and the target is described by the following motion model:
[0020]
[0021] in, is the distance between the unmanned vehicle i and the target position, λ i = atan2(x # -x * i ,y # -y * i ) is the sight angle of unmanned vehicle i, φ i is the leading angle of the unmanned vehicle i. According to the kinematic model of relative position, the relationship model between relative position and control input is further established as follows:
[0022]
[0023] Among them, u y,i =a q,i cosφ i -a f,i sinφ i ,u c,i =a q,i sinφ i -a f,i cosφ i They represent the acceleration control input of the unmanned vehicle along the line of sight and perpendicular to the line of sight respectively.
[0024] Preferably, the specific expression for determining the estimated terminal time range of each unmanned vehicle by speed limit in step 2 is as follows:
[0025]
[0026] in, and They are the shortest and longest estimated time for the unmanned vehicle to reach the target position from the initial position, The speed range that can be achieved by unmanned vehicles.
[0027] Preferably, the specific process of estimating the terminal time range of all unmanned vehicles in step 3 is as follows:
[0028] S31. Build a communication network structure This includes a collection with each driverless car as the vertex And the edge set representing the communication interaction relationship between unmanned vehicles
[0029] S32. In the communication network structure, unmanned vehicle i sends a signal to neighbor j∈N i Send its own terminal time range estimate and receive the terminal time range estimate of neighbor j. After n-1 information exchanges, each unmanned vehicle obtains the terminal time range estimate of all unmanned vehicles, where N i is the set of neighbors of unmanned vehicle i.
[0030] Preferably, in step 4, the reachable domain of the unmanned vehicle time range of each group is obtained by estimating the terminal time range of each unmanned vehicle and the minimum number of unmanned vehicles required in each group. Perform self-adaptive group division of unmanned vehicles. The specific operations are as follows:
[0031] S41. Set the upper limit of the time range of each unmanned vehicle terminal Sort in ascending order, m = 1, 2, ... n, and renumber the unmanned vehicles from 1 to n, satisfying
[0032] S42, let s = 1, move unmanned vehicle n to unmanned vehicle k s =n-P+1 is included in the first group, P is the minimum number of unmanned vehicles in each group, assuming that the first group can reach the domain within the time range is not an empty set;
[0033] S43, determining whether the number of ungrouped unmanned vehicles is greater than P;
[0034] S431. If the number of ungrouped vehicles is still greater than P, update s=s+1, k s =k s-1 -P, judgement Is it an empty set?
[0035] S4311, if If it is not an empty set, then the number k s-1 -1 to k s The unmanned vehicles are divided into the sth group, and the process jumps to S43;
[0036] S4312, if is an empty set, then let k s-1 =k s-1 -1,k s =k s -1, the unmanned vehicle k s-1 Included in the s-1 group, driverless car k s Included in group s, judge If it is an empty set, jump to S4311;
[0037] S432, if the number of remaining unmanned vehicles is less than P, then enter the group number reverse adjustment part and jump to S44;
[0038] S44, let k s =1,h=s,h is the number of groups after division, judge Is it an empty set?
[0039] S441, if If it is not an empty set, then the unmanned vehicle k s-1 -1 to unmanned vehicle k s Officially divided into group s, jump to S45;
[0040] S442, if is an empty set, then let k s-1 =k s-1 -1, the unmanned vehicle k s-1 Divide into group s-1 and judge If it is an empty set, jump to S441;
[0041] S45, determine whether all unmanned vehicles have been traversed and whether s is greater than 1;
[0042] S451, if s is greater than 1, let s = s-1, judge If it is an empty set, jump to S441;
[0043] S452, if s is not greater than 1, jump to S46;
[0044] S46: Complete the division of unmanned vehicle groups
[0045] Preferably, in step 5, a non-smooth control method is used to construct a specific expression for acceleration control perpendicular to the line of sight as follows:
[0046]
[0047] Among them, g i ,a c,i ,b c,i >0 is a constant parameter and satisfies 0<a c,i <1<b c,i , sgn β (·) Specifically:
[0048] sgn β (x)=|x| β sign(x)
[0049] Where sign(·) is the sign function.
[0050] Preferably, the specific expression for establishing the acceleration component control along the line of sight direction in step 6 is as follows:
[0051]
[0052] Among them, l i >0 is the convergence coefficient, a ij represents the element of the communication topology adjacency matrix, where a ii = 0, if unmanned vehicle i receives the information sent by unmanned vehicle j, then a ij >0, otherwise a ij =0.
[0053] Preferably, the specific process of constructing the acceleration and angular acceleration control scheme of the unmanned vehicle in step 7 is as follows:
[0054] S71, the communication network structure is constructed to ensure that there is a connection path from unmanned vehicle i to neighboring unmanned vehicle j;
[0055] S72: If the unmanned vehicle j has reached the target or the two are not in the same group, stop sending information. ij =0,
[0056] S73, the acceleration and angular acceleration control of the unmanned vehicle i are expressed as follows:
[0057]
[0058] in
[0059]
[0060] Preferably, in step 8, whether all unmanned vehicles in the same group have reached the target position is determined according to the value of the variable x, and the specific expression is as follows:
[0061]
[0062] Among them, r s,i Represents the distance between the current position of the unmanned vehicle numbered i in the sth group and the target position; when χ=1, it means that all the unmanned vehicles in the sth group have arrived at the target position; when χ=0, it means that not all the unmanned vehicles in the sth group have arrived at the target position.
[0063] Therefore, the present invention adopts the above-mentioned terminal time cooperative control method for adaptive grouping of multiple unmanned vehicle groups, which has the following beneficial effects:
[0064] (1) The present invention realizes the task of automatically grouping unmanned vehicle groups into groups of no less than a specified size and the coordinated operation of unmanned vehicles in each group by giving a target location and a minimum number of unmanned vehicles in each group;
[0065] (2) The method adopted by the present invention can meet the requirements of unmanned vehicle collaboration and has good robustness. Through the communication network, it can self-organize and coordinate the movement of unmanned vehicles in real time to ensure that the unmanned vehicles are autonomously grouped and the unmanned vehicles in each group arrive at the target location at the same time.
[0066] The technical solution of the present invention is further described in detail below through the accompanying drawings and embodiments. BRIEF DESCRIPTION OF THE DRAWINGS
[0067] Figure 1 It is an overall flow chart of the terminal time cooperative control method for adaptively grouping multiple unmanned vehicle groups of the present invention;
[0068] Figure 2 is a schematic diagram of the angle relationship between the unmanned vehicle of the present invention and the target position;
[0069] Figure 3 It is a structural diagram of the unmanned vehicle group communication network of the present invention;
[0070] Figure 4 It is a structural diagram of the communication network after the unmanned vehicle scale adaptive grouping of the present invention;
[0071] Figure 5 It is a motion trajectory result diagram of each unmanned vehicle group in the simulation experiment of the present invention;
[0072] Figure 6 It is a grouping result diagram of each unmanned vehicle changing over time in the simulation experiment of the present invention;
[0073] Figure 7 It is a schematic diagram of the change of the leading angle of each unmanned vehicle over time in the simulation experiment of the present invention;
[0074] Figure 8 It is a schematic diagram of the change of the speed of each unmanned vehicle over time in the simulation experiment of the present invention;
[0075] Fig. 9 It is a schematic diagram of the change of the tangential speed of each unmanned vehicle over time in the simulation experiment of the present invention;
[0076] Fig.10 It is a schematic diagram of the change of the normal speed of each unmanned vehicle over time in the simulation experiment of the present invention;
[0077] Fig.11 It is a schematic diagram of the change of the magnitude of the tangential acceleration of each unmanned vehicle over time in the simulation experiment of the present invention;
[0078] Fig.12 It is a schematic diagram of the change of the normal acceleration of each unmanned vehicle over time in the simulation experiment of the present invention. DETAILED DESCRIPTION
[0079] The following detailed description of the embodiments of the present invention provided in the accompanying drawings is not intended to limit the scope of the invention claimed for protection, but merely represents selected embodiments of the present invention. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0080] See also Figure 1-12 The terminal time cooperative control method of adaptively grouping multiple unmanned vehicle groups includes the following steps:
[0081] Step 1: Construct a relative kinematic model between the unmanned vehicle and the target position. The specific process is as follows:
[0082] In the inertial coordinate system, for the unmanned vehicle group For driverless cars The following kinematic model is established:
[0083]
[0084] Among them, (x * i ,y * i ) is the position coordinate of the center of mass of the unmanned vehicle, θ i is the heading angle of the unmanned vehicle i, specifically the angle between the velocity and the positive direction of the x-axis, ω i is the rate of change of the heading angle of the unmanned vehicle, v i is the speed of the unmanned vehicle, a q,i with a f,i They represent the tangential acceleration and normal acceleration of the unmanned vehicle i respectively;
[0085] Assume the target position is (x # ,y # ), the relative position relationship between the unmanned vehicle i and the target is described by the following motion model:
[0086]
[0087] in, is the distance between the unmanned vehicle i and the target position, λ i = atan2(x # -x * i ,y # -y * i ) is the sight angle of unmanned vehicle i, φ i is the leading angle of the unmanned vehicle i. According to the kinematic model of relative position, the relationship model between relative position and control input is further established as follows:
[0088]
[0089] Among them, u y,i =a q,i cosφ i -a f,i sinφ i ,u c,i =a q,i sinφ i -a f,i cosφ i They represent the acceleration control input of the unmanned vehicle along the line of sight and perpendicular to the line of sight respectively;
[0090] Step 2: According to the relative kinematic model constructed in step 1, the terminal time estimate of each unmanned vehicle is calculated, and the terminal time range estimate of each unmanned vehicle is determined by speed limit. The specific expression is as follows:
[0091]
[0092] in, and They are the shortest and longest estimated time for the unmanned vehicle to reach the target position from the initial position, The speed range that can be achieved by unmanned vehicles;
[0093] Step 3: Build a communication network structure between the unmanned vehicles, so that each unmanned vehicle can exchange information multiple times and obtain the terminal time range estimation of all unmanned vehicles. The specific process is as follows:
[0094] S31. Build a communication network structure This includes a collection with each driverless car as the vertex And the edge set representing the communication interaction relationship between unmanned vehicles
[0095] S32. In the communication network structure, unmanned vehicle i sends a signal to neighbor j∈N i Send its own terminal time range estimate and receive the terminal time range estimate of neighbor j. After n-1 information exchanges, each unmanned vehicle obtains the terminal time range estimate of all unmanned vehicles, where N i is the set of neighbors of unmanned vehicle i.
[0096] Step 4: Based on the estimated terminal time range of each unmanned vehicle and the minimum number of unmanned vehicles required in each group, the reachable domain of the unmanned vehicle time range of each group is obtained. Perform self-adaptive group division of unmanned vehicles. The specific operations are as follows:
[0097] S41. Set the upper limit of the time range of each unmanned vehicle terminal Sort in ascending order, m = 1, 2, ... n, and renumber the unmanned vehicles from 1 to n, satisfying
[0098] S42, let s = 1, move unmanned vehicle n to unmanned vehicle k s =n-P+1 is included in the first group, P is the minimum number of unmanned vehicles in each group, assuming that the first group can reach the domain within the time range is not an empty set;
[0099] S43, determining whether the number of ungrouped unmanned vehicles is greater than P;
[0100] S431. If the number of ungrouped autonomous vehicles is still greater than P, update s=s+1, k s =k s-1 -P, judgement Is it an empty set?
[0101] S4311, if If it is not an empty set, then the number k s-1 -1 to k s The unmanned vehicles are divided into the sth group, and the process jumps to S43;
[0102] S4312, if is an empty set, then let k s-1 =k s-1 -1,k s =k s -1, the unmanned vehicle k s-1 Included in the s-1 group, driverless car k s Included in the sth group, judge If it is an empty set, jump to S4311;
[0103] S432, if the number of remaining unmanned vehicles is less than P, then enter the group number reverse adjustment part and jump to S44;
[0104] S44, let k s =1,h=s,h is the number of groups after division, judge Is it an empty set?
[0105] S441, if If it is not an empty set, then the unmanned vehicle k s-1 -1 to unmanned vehicle k s Officially divided into group s, jump to S45;
[0106] S442, if is an empty set, then let k s-1 =k s-1 -1, the unmanned vehicle k s-1 Divide into group s-1 and judge If it is an empty set, jump to S441;
[0107] S45, determine whether all unmanned vehicles have been traversed and whether s is greater than 1;
[0108] S451, if s is greater than 1, let s = s-1, judge If it is an empty set, jump to S441;
[0109] S452, if s is not greater than 1, jump to S46;
[0110] S46: Complete the division of unmanned vehicle groups
[0111] Step 5. Based on the relative kinematic model constructed in step 1, non-smooth control is used to construct the acceleration component control perpendicular to the line of sight, so that the velocity component of each unmanned vehicle perpendicular to the line of sight converges to zero within the expected time. The specific expression of the acceleration control perpendicular to the line of sight constructed by the non-smooth control method is as follows:
[0112]
[0113] Among them, g i ,a c,i ,b c,i >0 is a constant parameter and satisfies 0<a c,i <1<b c,i , sgn β (·) Specifically:
[0114] sgn β (x)=|x| β sign(x)
[0115] Among them, sign(·) is the sign function;
[0116] Step 6: Based on the relative kinematics model constructed in step 1 and the information interaction between the unmanned vehicles, establish the acceleration component control along the line of sight. The specific expression is as follows:
[0117]
[0118] Among them, l i >0 is the convergence coefficient, a ij represents the element of the communication topology adjacency matrix, where a ii = 0, if unmanned vehicle i receives the information sent by unmanned vehicle j, then a ij >0, otherwise a ij =0;
[0119] Step 7: According to the communication network structure in step 3, the grouping of the unmanned vehicles in step 4, and the acceleration control schemes perpendicular to the line of sight and along the line of sight established in steps 5 and 6, the acceleration and angular acceleration control schemes of the unmanned vehicle are constructed. The specific process is as follows:
[0120] S71, through the constructed communication network structure, it is ensured that there is a connection path from the unmanned vehicle i to the neighboring unmanned vehicle j;
[0121] S72: If the unmanned vehicle j has reached the target or the two are not in the same group, stop sending information. ij =0,
[0122] S73, the acceleration and angular acceleration control of the unmanned vehicle i are expressed as follows:
[0123]
[0124] in
[0125]
[0126] Step 8: According to the relative kinematics model constructed in step 1 and the communication network structure in step 3, the position and speed of the unmanned vehicle are updated to determine whether the unmanned vehicles in each group arrive at the target position at the same time. If the unmanned vehicles in each group arrive at the target position at the same time, stop sending information to the outside; if the unmanned vehicles in each group do not arrive at the target position at the same time, the lagging unmanned vehicles in each group are re-grouped, and the execution is continued in step 5, wherein the value of the variable χ is used to determine whether all the unmanned vehicles in the same group have arrived at the target position. The specific expression is as follows:
[0127]
[0128] Among them, r s,i Represents the distance between the current position of the unmanned vehicle numbered i in the sth group and the target position; when χ=1, it means that all the unmanned vehicles in the sth group arrive at the target position at the same time; when χ=0, it means that not all the unmanned vehicles in the sth group arrive at the target position at the same time.
[0129] Example:
[0130] The present invention first constructs a kinematic model of the relative position relationship between the unmanned vehicle and the target position, then derives the terminal time estimation formula of the unmanned vehicle, obtains the terminal time range estimation of each unmanned vehicle, and then realizes information interaction by constructing a communication network structure between unmanned vehicles, ensuring that each unmanned vehicle can obtain the terminal time range estimation of all unmanned vehicles, and performs unmanned vehicle scale adaptive group division according to the terminal time range estimation of each unmanned vehicle and the minimum number of unmanned vehicles required in the group. Then, the acceleration component control of the unmanned vehicle i perpendicular to the line of sight is constructed by non-smooth control to ensure that the velocity component perpendicular to the line of sight is reduced to zero within a limited time. Subsequently, each unmanned vehicle determines the acceleration component control along the line of sight. Next, the acceleration control perpendicular to the line of sight and along the line of sight is converted into the acceleration and angular acceleration control of the unmanned vehicle. Finally, it is determined whether the unmanned vehicle in the same group has reached the target position, and if the unmanned vehicle has reached the target position, it stops sending information to the outside. It should be noted that before the entire step is executed, the problem scenario needs to be initialized. Assume that the problem is to realize that n unmanned vehicles are divided into groups according to a certain number of scales and arrive at the target position in groups. In the unmanned vehicle group, a communication network is constructed, and the required arrival time of the sth group of unmanned vehicles is set to T s .
[0131] The following is a simulation verification of the terminal time cooperative control method for adaptive grouping of multiple unmanned vehicle groups designed by the present invention; the simulation simulates the cooperative task of adaptive grouping of 10 unmanned vehicles. Assume that the destination coordinates are (150, 0) meters, and the minimum number of unmanned vehicles in the group is P = 3. The initial parameters of the unmanned vehicle group are shown in Table 1:
[0132] Table 1
[0133] Study subjects Initial position (m) speed Lead angle (rad / s) <![CDATA[Driverless vehicle z1]]> (40,30) (6,8) 0.4757 <![CDATA[Driverless vehicle z2]]> (0,20) (6,8) 1.1978 <![CDATA[Driverless vehicle z3]]> (-20,100) (10,1) 1.2083 <![CDATA[Driverless vehicle z4]]> (30,40) (6,8) 1.0598 <![CDATA[Driverless vehicle z5]]> (90,20) (5,6) 1.0420 <![CDATA[Driverless vehicle z6]]> (85,20) (7,9) 1.1935 <![CDATA[Driverless vehicle z7]]> (100,10) (7,2) 0.9273 <![CDATA[Driverless vehicle z8]]> (40,20) (6,7) 0.6314 <![CDATA[Driverless vehicle z9]]> (10,80) (8,3) 0.8779 <![CDATA[Driverless vehicle z 10 > (20,50) (11,2) 0.5470
[0134] After scale adaptive grouping, the grouping of unmanned vehicles is shown in Table 2:
[0135] Table 2
[0136]
[0137]
[0138] In the simulation experiment, the following parameters were selected: g i =0.5,a c,i =0.6,b c,i =1.2,l i =0.5.
[0139] The communication network structures of the unmanned vehicle group before and after grouping are as follows: Figure 3 and Figure 4As shown in , it is assumed that there is a communication path, the elements of the corresponding adjacency matrix are all 1, and there is a path from unmanned vehicle i to other unmanned vehicles j. The simulation results of the terminal time cooperative control method for adaptive grouping of multiple unmanned vehicles are shown in Figures 5 to 12 As shown. Figure 5 It can be seen that each unmanned vehicle can successfully reach the target location. Figure 6 As far as we know, the unmanned vehicles are divided into three groups, and there are at least three unmanned vehicles in each group, which shows that the multi-unmanned vehicle terminal time cooperative control method with group size adaptive grouping performs very well. Figure 7 It can be observed that the lead angle of each unmanned vehicle drops rapidly to zero. Figure 8 It shows that the unmanned vehicle always maintains a positive speed during the driving process, which meets the requirements. Fig. 9 and Fig.10 It can be seen that the speed direction of each unmanned vehicle quickly stabilizes at a constant value, thus ensuring that no singular situations occur in the acceleration control. Fig.11 and Fig.12 It shows that the angular acceleration and acceleration of the unmanned vehicle are both within a reasonable range and eventually approach zero. By analyzing the simulation experiment results, it can be concluded that the terminal time cooperative control method for adaptive grouping of multiple unmanned vehicle groups proposed in the present invention has a good control effect.
[0140] Therefore, the present invention adopts the above-mentioned terminal time collaborative control method for adaptive grouping of multiple unmanned vehicle groups. By giving the target position and the minimum number of unmanned vehicles expected in each group, it realizes the automatic grouping of unmanned vehicle groups in a size not less than the specified size and the collaborative operation of unmanned vehicles in each group. It has good robustness. At the same time, this method can be applied to tasks such as efficient firefighting by collaborative unmanned system groups, and has broad practical application value.
[0141] Finally, it should be noted that the above embodiments are only used to illustrate the technical solution of the present invention rather than to limit it. Although the present invention has been described in detail with reference to the preferred embodiments, those skilled in the art should understand that they can still modify or replace the technical solution of the present invention with equivalents, and these modifications or equivalent replacements cannot cause the modified technical solution to deviate from the spirit and scope of the technical solution of the present invention.
Claims
1. Terminal time coordination control method for adaptive grouping of multiple unmanned vehicle groups, It is characterized in that The following steps are involved: Step 1: Construct a relative kinematic model between the unmanned vehicle and the target position; Step 2: Calculate the terminal time estimate of each unmanned vehicle based on the relative kinematic model constructed in step 1, and determine the terminal time range estimate of each unmanned vehicle through speed limit; Step 3: Build a communication network structure between the unmanned vehicles, so that the unmanned vehicles can exchange information multiple times and obtain the terminal time range estimation of all unmanned vehicles; Step 4: According to the estimated time range of each unmanned vehicle terminal and the minimum number of unmanned vehicles required in each group, determine the reachable domain of the time range of the unmanned vehicles in each group, and complete the self-adaptive group division of the unmanned vehicles; Step 5: Based on the relative kinematics model constructed in step 1, non-smooth control is used to construct the acceleration component control perpendicular to the line of sight, so that the velocity component of each unmanned vehicle perpendicular to the line of sight converges to zero within the expected time; Step 6: Based on the relative kinematics model constructed in step 1 and the information interaction between the unmanned vehicles, establish the acceleration component control along the line of sight direction; Step 7: construct the acceleration and angular acceleration control scheme of the unmanned vehicle according to the communication network structure in step 3, the grouping of the unmanned vehicles in step 4, and the acceleration control schemes perpendicular to the line of sight and along the line of sight established in steps 5 and 6; Step 8: Update the position and speed of the unmanned vehicle according to the relative kinematic model constructed in step 1 and the communication network structure in step 3, and determine whether the unmanned vehicles in each group arrive at the target position at the same time. If the unmanned vehicles in each group arrive at the target position at the same time, stop sending information to the outside; if the unmanned vehicles in each group do not arrive at the target position at the same time, re-group the lagging unmanned vehicles in each group, and return to step 5 to continue execution; The specific process of step 1 is as follows: In the inertial coordinate system, for the unmanned vehicle group For driverless cars The following kinematic model is established: Among them, (x * i ,y * i ) is the position coordinate of the center of mass of the unmanned vehicle, θ i is the heading angle of the unmanned vehicle i, specifically the angle between the velocity and the positive direction of the x-axis, ω i is the rate of change of the heading angle of the unmanned vehicle, v i is the speed of the unmanned vehicle, a q,i with a f,i They represent the tangential acceleration and normal acceleration of the unmanned vehicle i respectively; Assume the target position is (x # ,y # ), the relative position relationship between the unmanned vehicle i and the target is described by the following motion model: in, is the distance between the unmanned vehicle i and the target position, λ i = atan2(x # -x * i ,y # -y * i ) is the sight angle of unmanned vehicle i, φ i is the leading angle of the unmanned vehicle i. According to the kinematic model of relative position, the relationship model between relative position and control input is further established as follows: Among them, u y,i =a q,i cosφ i -a f,i sinφ i ,u c,i =a q,i sinφ i -a f,i cosφ i They represent the acceleration control input of the unmanned vehicle along the line of sight and perpendicular to the line of sight respectively; The specific expression for determining the terminal time range estimate of each unmanned vehicle through speed limit in step 2 is as follows: in, and They are the shortest and longest estimated time for the unmanned vehicle to reach the target position from the initial position, The speed range that can be achieved by unmanned vehicles; The specific process of estimating the terminal time range of all unmanned vehicles in step 3 is as follows: S31. Build a communication network structure This includes a collection with each driverless car as the vertex And the edge set representing the communication interaction relationship between unmanned vehicles S32. In the communication network structure, unmanned vehicle i sends a signal to neighbor j∈N i Send its own terminal time range estimate and receive the terminal time range estimate of neighbor j. After n-1 information exchanges, each unmanned vehicle obtains the terminal time range estimate of all unmanned vehicles, where N i is the neighbor set of unmanned vehicle i; In step 4, the reachable domain of the unmanned vehicle time range of each group is obtained by estimating the terminal time range of each unmanned vehicle and the minimum number of unmanned vehicles required in each group. The specific operations for self-adaptive group division of unmanned vehicles are as follows: S41. Set the upper limit of the time range of each unmanned vehicle terminal Sort in ascending order, m = 1, 2, ..., n, and renumber the unmanned vehicles from 1 to n, satisfying S42, let s = 1, move unmanned vehicle n to unmanned vehicle k s =n-P+1 is included in the first group, P is the minimum number of unmanned vehicles in each group, assuming that the first group can reach the domain within the time range is not an empty set; S43, determining whether the number of ungrouped unmanned vehicles is greater than P; S431. If the number of ungrouped vehicles is still greater than P, update s=s+1, k s =k s-1 -P, judgement Is it an empty set? S4311, if If it is not an empty set, then the number k s-1 -1 to k s The unmanned vehicles are divided into the sth group, and the process jumps to S43; S4312, if is an empty set, then let k s-1 =k s-1 -1,k s =k s -1, the unmanned vehicle k s-1 Included in the s-1 group, driverless car k s Included in group s, judge If it is an empty set, jump to S4311; S432, if the number of remaining unmanned vehicles is less than P, then enter the group number reverse adjustment part and jump to S44; S44, let k s =1,h=s,h is the number of groups after division, judge Is it an empty set? S441, if If it is not an empty set, then the unmanned vehicle k s-1 -1 to unmanned vehicle k s Officially divided into group s, jump to S45; S442, if is an empty set, then let k s-1 =k s-1 -1, the unmanned vehicle k s-1 Divide into group s-1 and judge If it is an empty set, jump to S441; S45, determine whether all unmanned vehicles have been traversed and whether s is greater than 1; S451, if s is greater than 1, let s = s-1, judge If it is an empty set, jump to S441; S452, if s is not greater than 1, jump to S46; S46: Complete the division of unmanned vehicle groups In step 5, the non-smooth control method is used to construct the specific expression of acceleration control perpendicular to the line of sight as follows: Among them, g i ,a c,i ,b c,i >0 is a constant parameter and satisfies 0<a c,i <1<b c,i ,sgn β (·) Specifically: sgn β (x)=|x β sign(x) Among them, sign(·) is the sign function; The specific expression for the acceleration component control along the line of sight established in step 6 is as follows: Among them, l i >0 is the convergence coefficient, a ij represents the element of the communication topology adjacency matrix, where a ii = 0, if unmanned vehicle i receives the information sent by unmanned vehicle j, then a ij >0, otherwise a ij =0; The specific process of building the acceleration and angular acceleration control scheme of the unmanned vehicle in step 7 is as follows: S71, through the constructed communication network structure, it is ensured that there is a connection path from the unmanned vehicle i to the neighboring unmanned vehicle j; S72: If the unmanned vehicle j has reached the target or the two are not in the same group, stop sending information. S73, the acceleration and angular acceleration control of the unmanned vehicle i are expressed as follows: in In step 8, the value of variable χ is used to determine whether all unmanned vehicles in the same group have reached the target location. The specific expression is as follows: Among them, r s,i Represents the distance between the current position of the unmanned vehicle numbered i in the sth group and the target position; when χ=1, it means that all the unmanned vehicles in the sth group arrive at the target position at the same time; when χ=0, it means that not all the unmanned vehicles in the sth group arrive at the target position at the same time.
