A method, device and system for multi-unmanned vehicle confrontation based on zero-space obstacle avoidance
By adopting a zero-space obstacle avoidance method in many-to-manned vehicle confrontation scenarios, unconstrained unmanned vehicle speed instructions are generated, which solves the problem that the inability to generate confrontation instructions in the existing technology in real time, and realizes the obstacle scenarios The effective countermeasure command generation and motion control have improved the task completion efficiency of multi-unmanned vehicle systems.
Patent Information
- Application Number
- CN202211120383.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-09-15
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2042-09-15
AI Technical Summary
The prior art is difficult to generate confrontation instructions in real-time in many-to-manned vehicle confrontation scenarios, especially in the presence of obstacles, and cannot effectively solve the problem of confrontation instructions generation in the multi-unit vehicle system.
Using a multi-unit vehicle confrontation method based on zero-space obstacle avoidance, the location information of each unmanned vehicle and the distance information of the obstacles is obtained, the projection components of the obstacle avoidance speed command and the adversarial speed command are calculated to generate unconstrained unmanned vehicles. Speed command, and generates an adversarial command signal according to the maximum allowable speed constraint to control the unmanned vehicle to move.
Effectively solve the problem of generating confrontation commands in obstacle scenarios, provide real-time confrontation commands for multi-unmanned vehicle systems, improve the efficiency of game confrontation mechanism research and task completion, and is suitable for tasks such as firepower strikes, cluster coordination defense.
Smart Images

Figure CN115617038B_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of unmanned vehicle technology, and in particular to a method, device and system for multi-unmanned vehicle confrontation based on zero-space obstacle avoidance. Background Art
[0002] As an important part of the ground combat system, unmanned vehicles have played an active role in various tasks such as fire strikes, cluster defense, regional expulsion, and logistics supply. They have many performance advantages such as environmental detection and perception, unmanned autonomous control, and confrontation command generation. They can improve the task completion rate, shorten the task completion time, and improve the safety level of combatants. They can provide technical solutions for future intelligent combat. In actual multi-unmanned vehicle confrontation scenarios, there are usually obstacles, which pose a threat to the safety of unmanned vehicles. While considering confrontation indicators, safety must also be guaranteed. This brings challenges to the research on confrontation methods, command generation, and many other aspects of multi-unmanned vehicle systems.
[0003] Regarding the confrontation method of multiple unmanned vehicle systems, most of the existing technologies are developed based on many-to-one systems, or the many-to-many systems are split into multiple many-to-one subsystems using task allocation methods, or there are no obstacles in the confrontation scenario, or the confrontation index is non-differentiable and cannot be directly solved using the Bellman equation. This results in the inability of existing technologies to directly provide real-time confrontation instructions for many-to-many systems with obstacles. For combat confrontation scenarios with obstacles, there are usually multiple actual participants on both sides of the confrontation, such as red-blue drills, regional defense, air-ground collaboration, etc., so it is very necessary to conduct in-depth research on the confrontation problem of multiple unmanned vehicles under the condition of ensuring obstacle avoidance safety. Summary of the invention
[0004] In view of this, an embodiment of the present application provides a method, device and system for multi-unmanned vehicle confrontation based on zero-space obstacle avoidance.
[0005] In a first aspect, an embodiment of the present application provides a multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance, which is applied to a centralized control device of a pursuer or a fleeer in a multi-unmanned vehicle confrontation system, wherein the pursuer and the fleeer respectively include a plurality of pursuer unmanned vehicles and a fleeing unmanned vehicle; the method includes:
[0006] Obtain the location information of each unmanned vehicle and calculate the distance information of each unmanned vehicle from the obstacle if there is an obstacle;
[0007] Determining whether obstacle avoidance is required based on the distance information, and when obstacle avoidance is required, obtaining obstacle avoidance speed instructions for each unmanned vehicle, and respectively calculating the zero space of the obstacle avoidance speed instructions;
[0008] Obtaining the confrontation speed command of each unmanned vehicle, and respectively calculating the projection components of the confrontation speed command on the null space of the obstacle avoidance speed command;
[0009] Based on the projection components of the countermeasure speed instructions of each unmanned vehicle on the null space and the obstacle avoidance speed instructions, respectively calculating the unconstrained unmanned vehicle speed instructions based on null space obstacle avoidance;
[0010] Using each of the unconstrained unmanned vehicle speed instructions, generating each unmanned vehicle countermeasure instruction signal that satisfies the maximum allowable speed constraint;
[0011] According to the confrontation command signals of each unmanned vehicle, each unmanned vehicle is controlled to perform corresponding movements.
[0012] In some embodiments, obtaining the obstacle avoidance speed instruction of each unmanned vehicle includes:
[0013] According to the positions of each of the pursuing unmanned vehicle and the escaping unmanned vehicle, the Jacobian matrix of each distance function is calculated based on the distance function to the obstacle posing a safety threat;
[0014] According to each of the Jacobian matrices, an obstacle avoidance speed instruction of each of the pursuing unmanned vehicle or the escaping unmanned vehicle is calculated.
[0015] In some embodiments, the calculating of the unconstrained unmanned vehicle speed instruction based on zero-space obstacle avoidance includes:
[0016] According to the projection components of the countermeasure speed instructions of each unmanned vehicle on the null space and the corresponding weighting coefficients, as well as the obstacle avoidance speed instructions and the corresponding weighting coefficients, weighted calculations are performed to obtain the unconstrained unmanned vehicle speed instructions of each unmanned vehicle.
[0017] In some embodiments, the number of the pursuing unmanned vehicles is greater than or equal to the number of the escaping unmanned vehicles, and the maximum allowable speeds of the pursuing unmanned vehicles are all greater than the maximum allowable speeds of the escaping unmanned vehicles; the confrontation speed instructions of each unmanned vehicle are generated using a minimum approximation function and a maximum approximation function, including:
[0018] Using the minimum approximation function, calculating the differentiable minimum distance from each of the escaping unmanned vehicles to all the pursuing unmanned vehicles;
[0019] Using a maximum approximation function, calculating the differentiable maximum value of the differentiable minimum distances of all escaping unmanned vehicles as a confrontation index of the multi-unmanned vehicle confrontation system;
[0020] When applied to the pursuit party, the confrontation speed instruction of the pursuit unmanned vehicle that satisfies the maximum allowable speed constraint is obtained by minimizing the confrontation index;
[0021] Alternatively, when applied to the escaping party, the confrontation index is maximized to obtain a confrontation speed instruction for the escaping unmanned vehicle that meets the maximum allowable speed constraint.
[0022] In some embodiments, the generating of a multi-unmanned vehicle confrontation command signal that satisfies a corresponding maximum allowable speed constraint by using each of the unconstrained unmanned vehicle speed commands includes:
[0023] Determining whether the speed instructions of each of the unconstrained unmanned vehicles are zero;
[0024] If it is zero, then the countermeasure speed command of the corresponding unmanned vehicle is improved to obtain an improved unmanned vehicle speed command that is not zero;
[0025] Determining whether the non-zero unconstrained unmanned vehicle speed command or the improved unmanned vehicle speed command exceeds the maximum allowable speed of the corresponding unmanned vehicle;
[0026] If the maximum permissible speed is not exceeded, generating a multi-unmanned vehicle confrontation command signal according to the unconstrained unmanned vehicle speed command or the improved unmanned vehicle speed command;
[0027] If the maximum allowable speed is exceeded, the unconstrained unmanned vehicle speed command or the improved unmanned vehicle speed command is saturated corrected according to the speed command direction of the corresponding unmanned vehicle, and then a multi-unmanned vehicle confrontation command signal is generated.
[0028] In some embodiments, the improving the counter-speed instruction of the corresponding unmanned vehicle also includes:
[0029] Determining whether the null space of the confrontation speed command of the unmanned vehicle and the obstacle avoidance speed command of the unmanned vehicle is orthogonal;
[0030] If they are orthogonal, the improvement operation is performed, otherwise the improvement operation is not performed;
[0031] The improving the counter-speed instruction of the corresponding unmanned vehicle includes:
[0032] The countermeasure speed of the unmanned vehicle is adjusted using a small-angle rotation matrix to obtain an improved unmanned vehicle speed instruction that is not zero.
[0033] In some embodiments, the multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance further includes:
[0034] When obstacle avoidance is not required or when no obstacle exists, the counter-speed instructions of each unmanned vehicle that meets the maximum allowable speed constraint are obtained as the counter-speed instruction signals of each unmanned vehicle.
[0035] In a second aspect, an embodiment of the present application provides a multi-unmanned vehicle confrontation device based on zero-space obstacle avoidance, which is applied to a centralized control device of a pursuit party or an escape party in a multi-unmanned vehicle confrontation system, wherein the pursuit party and the escape party respectively include a plurality of pursuit unmanned vehicles and an escape unmanned vehicle; the device includes:
[0036] An information acquisition module is used to obtain the position information of each unmanned vehicle and calculate the distance information of each unmanned vehicle from the obstacle when there is an obstacle;
[0037] A first calculation module is used to determine whether obstacle avoidance is required based on the distance information, and when obstacle avoidance is required, obtain obstacle avoidance speed instructions of each unmanned vehicle, and calculate the zero space of the obstacle avoidance speed instructions respectively;
[0038] A second calculation module is used to obtain the confrontation speed command of each unmanned vehicle, and respectively calculate the projection component of the confrontation speed command on the null space of the obstacle avoidance speed command;
[0039] A third calculation module is used to calculate the unconstrained unmanned vehicle speed instructions based on null space obstacle avoidance based on the projection components of the confrontation speed instructions of each unmanned vehicle on the null space and the obstacle avoidance speed instructions;
[0040] An instruction generation module, used to generate each unmanned vehicle counter-instruction signal that meets the maximum allowable speed constraint by using each of the unconstrained unmanned vehicle speed instructions;
[0041] The control module is used to control each unmanned vehicle to perform corresponding movement according to the confrontation command signal of each unmanned vehicle.
[0042] In a third aspect, an embodiment of the present application provides a multi-unmanned vehicle confrontation system, the multi-unmanned vehicle confrontation system comprising a plurality of pursuit unmanned vehicles, a plurality of escape unmanned vehicles, and respective centralized control devices of the pursuit party and the escape party, wherein the number of the pursuit unmanned vehicles is greater than or equal to the number of the escape unmanned vehicles, and the maximum allowable speeds of the pursuit unmanned vehicles are all greater than the maximum allowable speeds of the escape unmanned vehicles;
[0043] The respective centralized control devices of the pursuing party and the escaping party respectively adopt the above-mentioned multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance to correspondingly control each of the pursuing unmanned vehicles and each of the escaping unmanned vehicles to perform confrontation movements.
[0044] In a fourth aspect, an embodiment of the present application provides a readable storage medium storing a computer program, which, when executed on a processor, implements the above-mentioned multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance.
[0045] The embodiments of the present application have the following beneficial effects:
[0046] The confrontation method of the embodiment of the present application is mainly aimed at the multi-unmanned vehicle system in the obstacle scene, by clarifying the basic information of the multi-unmanned vehicle confrontation scene, including the location information of each unmanned vehicle and the distance information, number, maximum allowable speed, etc. from the obstacle; judging whether obstacle avoidance is needed, when obstacle avoidance is needed, designing the unmanned vehicle obstacle avoidance speed instruction, and calculating the zero space of the obstacle avoidance speed instruction; designing the unmanned vehicle confrontation speed instruction, and calculating the projection component of the confrontation speed instruction on the zero space of the obstacle avoidance speed instruction; using the obstacle avoidance speed instruction and the projection component of the confrontation speed instruction on the zero space, calculate the unconstrained unmanned vehicle speed instruction, so as to generate the multi-unmanned vehicle confrontation instruction signal based on zero space obstacle avoidance. This confrontation method can solve the problem of generating confrontation instructions in the obstacle scene according to the current situation of the multi-unmanned vehicle system, and can provide new ideas for the game confrontation mechanism research of the multi-unmanned vehicle system, and can also provide real-time confrontation instructions for various tasks such as firepower strike, cluster defense, regional expulsion, and logistics supply. In addition, this method can also be migrated to other multi-robot systems that meet the requirements of the confrontation scene, and the confrontation instruction signal of the multi-robot system under the obstacle avoidance constraint is obtained in real time, so as to facilitate motion control. BRIEF DESCRIPTION OF THE DRAWINGS
[0047] In order to more clearly illustrate the technical solutions of the embodiments of the present application, the drawings required for use in the embodiments will be briefly introduced below. It should be understood that the following drawings only show certain embodiments of the present application and therefore should not be regarded as limiting the scope. For ordinary technicians in this field, other related drawings can be obtained based on these drawings without paying creative work.
[0048] Figure 1 A generation flow chart of a multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance according to an embodiment of the present application is shown;
[0049] Figure 2 A flowchart showing the generation of the countermeasure speed instruction of each unmanned vehicle in an embodiment of the present application is shown;
[0050] Figure 3 A flowchart of generating a multi-unmanned vehicle confrontation command signal according to an embodiment of the present application is shown;
[0051] Figure 4 Another flow chart of the multi-unmanned vehicle confrontation method according to an embodiment of the present application is shown;
[0052] Figure 5 A schematic diagram of motion trajectories of multiple unmanned vehicles in confrontation obtained based on the method of an embodiment of the present application is shown;
[0053] Figure 6A schematic structural diagram of a multi-unmanned vehicle confrontation device based on zero-space obstacle avoidance in an embodiment of the present application is shown. DETAILED DESCRIPTION
[0054] The technical solutions in the embodiments of the present application will be described clearly and completely below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, rather than all of the embodiments.
[0055] The components of the embodiments of the present application generally described and shown in the drawings herein may be arranged and designed in various configurations. Therefore, the following detailed description of the embodiments of the present application provided in the drawings is not intended to limit the scope of the application claimed for protection, but merely represents the selected embodiments of the present application. Based on the embodiments of the present application, all other embodiments obtained by those skilled in the art without making creative work belong to the scope of protection of the present application.
[0056] Hereinafter, the terms "including", "having" and their cognates that can be used in various embodiments of the present application are intended only to indicate specific features, numbers, steps, operations, elements, components or a combination of the foregoing items, and should not be understood as first excluding the existence of one or more other features, numbers, steps, operations, elements, components or a combination of the foregoing items or increasing the possibility of one or more features, numbers, steps, operations, elements, components or a combination of the foregoing items. In addition, the terms "first", "second", "third" and the like are only used to distinguish descriptions and cannot be understood as indicating or implying relative importance.
[0057] Unless otherwise defined, all terms (including technical terms and scientific terms) used herein have the same meanings as those generally understood by those skilled in the art to which the various embodiments of the present application belong. The terms (such as those defined in generally used dictionaries) will be interpreted as having the same meanings as the contextual meanings in the relevant technical field and will not be interpreted as having idealized meanings or overly formal meanings unless clearly defined in the various embodiments of the present application.
[0058] In conjunction with the accompanying drawings, some embodiments of the present application are described in detail below. In the absence of conflict, the following embodiments and features in the embodiments can be combined with each other.
[0059] The present application proposes a multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance, which is mainly aimed at confrontation scenarios with obstacles. The confrontation speed instructions of the multi-unmanned vehicles are designed, and when obstacle avoidance is required, the obstacle avoidance speed instructions are designed. At the same time, the projection component of the confrontation speed instruction in the zero space of the obstacle avoidance speed instruction is combined to design an unconstrained unmanned vehicle speed instruction based on zero-space obstacle avoidance. Then, combined with improved processing and / or maximum allowable speed constraints, a multi-unmanned vehicle confrontation instruction signal based on zero-space obstacle avoidance is designed, thereby providing new ideas for the generation of confrontation strategies for multi-unmanned vehicle systems in obstacle scenarios. Of course, this method is also applicable to the case where there are no obstacles in the confrontation scenario. Since the situation with obstacles will be more complicated, the situation with obstacles is mainly described here as an example, and the situation without obstacles is not discussed too much.
[0060] In order to facilitate the understanding of the multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance of this embodiment, the confrontation speed command, obstacle avoidance speed command, unconstrained unmanned vehicle speed command based on zero-space obstacle avoidance, and multi-unmanned vehicle confrontation command signal based on zero-space obstacle avoidance mentioned in the method are described below. It can be understood that due to the different positions of each unmanned vehicle, the specific commands obtained by each will also be different, but the command calculation logic of all unmanned vehicles on the same side is the same.
[0061] Considering that there may be obstacles in the multi-unmanned vehicle system confrontation scenario, in this embodiment, it is necessary to first clarify the basic information of the multi-unmanned vehicle confrontation scenario, for example, it may include but is not limited to the number of both the pursuit unmanned vehicle and the escape unmanned vehicle, the number and position of each obstacle in the presence of obstacles, the maximum allowable speed of each unmanned vehicle (including the pursuit unmanned vehicle and the escape unmanned vehicle), and the maximum safety distance threshold. Among them, it is mainly considered here that the number of pursuit unmanned vehicles is greater than or equal to the number of escape unmanned vehicles; the maximum allowable speed of the pursuit unmanned vehicles is all greater than the maximum allowable speed of the escape unmanned vehicles. When a certain escaped unmanned vehicle is caught by any of the pursuit unmanned vehicles, the escaped unmanned vehicle and the pursuit unmanned vehicle exit the subsequent multi-unmanned vehicle confrontation process; and each time the obstacle avoidance function is activated, only one or zero obstacles will pose a safety threat to the pursuit unmanned vehicle and the escaped unmanned vehicle.
[0062] Based on the above confrontation scenario, in order to realize the confrontation control of each unmanned vehicle in pursuit and escape, it is necessary to generate confrontation instructions for each unmanned vehicle. In this embodiment, considering that the multi-unmanned vehicle confrontation system is a many-to-many system, based on the characteristics of the unmanned vehicle in pursuit and escape, this embodiment will first use the minimum approximation function and the maximum approximation function to design a differentiable system confrontation index, and then calculate the confrontation speed instruction of the unmanned vehicle in pursuit by minimizing the confrontation index, and then calculate the confrontation speed instruction of the unmanned vehicle in escape by maximizing the confrontation index, so as to obtain the confrontation speed instruction of each unmanned vehicle.
[0063] In one embodiment, Figure 1 As shown, it can be implemented based on the minimum approximation function and the maximum approximation function. Specifically, the process of generating the confrontation speed instruction of the multi-unmanned vehicle confrontation system includes steps S110 to S140:
[0064] S110, using the minimum approximation function, calculating the differentiable minimum distance from each escaping unmanned vehicle to all the pursuing unmanned vehicles.
[0065] The input of the minimum approximation function is each escaping unmanned vehicle E j (j=1,2,…,M) to all the chasing unmanned vehicles P={P1…P N}, and its output is a differentiable approximation to the minimum of all distances.
[0066] For example, in one embodiment, the following minimum approximation function may be used:
[0067]
[0068] In the formula, represents the differentiable minimum distance between the jth escaping drone and all the chasing drones; represents the position of the i-th pursuit unmanned vehicle, represents the speed of the i-th unmanned vehicle, and there is represents the position of the jth escaping unmanned vehicle, represents the speed of the jth escaping unmanned vehicle, and τ(*) represents the minimum differentiable approximation function; α>0 represents the approximation design parameter; N represents the number of pursuing unmanned vehicles, and i=1, 2,…, N; M represents the number of escaping unmanned vehicles, and j=1, 2,…, M.
[0069] S120, using the maximum approximation function, calculating the maximum differentiable value of the minimum differentiable distances of all escaping unmanned vehicles as a confrontation index of the multi-unmanned vehicle confrontation system.
[0070] The input of the maximum approximation function is the differentiable minimum distance of all escaping unmanned vehicles calculated above (denoted as ), whose output is a differentiable approximation to the maximum value of all differentiable minimum distances, which is used here as a confrontation indicator for the multi-unmanned vehicle system.
[0071] For example, in one embodiment, the maximum approximation function of the following form may be used:
[0072]
[0073] Where V(E, P) represents the maximum differentiable value of the minimum differentiable distance of all escaping unmanned vehicles, that is, the confrontation index of the multi-unmanned vehicle system; represents the maximum differentiable approximation function.
[0074] S130, obtaining a confrontation speed instruction for chasing the unmanned vehicle that meets the maximum allowable speed constraint by minimizing the above confrontation index.
[0075] For the confrontation index V(E, P), the purpose of all the confrontations of the unmanned vehicle is to minimize the confrontation index. To this end, minimization processing can be used, and constraints that meet the maximum allowable speed of the unmanned vehicle can be set. For example, the confrontation speed instructions of each unmanned vehicle can be calculated by the following formula:
[0076]
[0077] In the formula, represents the confrontation speed instruction of the i-th unmanned vehicle; represents the maximum permissible speed of the i-th pursuit unmanned vehicle; The specific calculation is as follows:
[0078]
[0079] S140, by maximizing the above-mentioned confrontation index, a confrontation speed instruction of the escaping unmanned vehicle that meets the maximum allowable speed constraint is obtained.
[0080] For the confrontation index V(E, P), the confrontation purpose of all escaping unmanned vehicles is to maximize the confrontation index. To this end, maximization processing can be used and constraints that meet the maximum allowable speed of the escaping unmanned vehicle can be set. For example, the confrontation speed command of each escaping unmanned vehicle can be calculated by the following formula:
[0081]
[0082] In the formula, represents the confrontation speed command of the jth escaping unmanned vehicle; represents the maximum permissible speed of the jth escaping unmanned vehicle; The specific calculation is as follows:
[0083]
[0084] In addition to obtaining the counter-speed instructions for the pursuing unmanned vehicle and the escaping unmanned vehicle, considering that the unmanned vehicle may need to avoid obstacles, this embodiment will also calculate the obstacle avoidance speed instruction of the unmanned vehicle and its corresponding zero space, and then calculate the unconstrained unmanned vehicle speed instruction based on zero space obstacle avoidance based on the projection component of the counter-speed instruction on the zero space and the obstacle avoidance speed instruction.
[0085] In one embodiment, Figure 2 As shown, the process of generating the unconstrained speed instruction of the multi-unmanned vehicle system specifically includes steps S210 to S240:
[0086] S210, based on the positions of each of the pursuing unmanned vehicles and the escaping unmanned vehicles, respectively calculate the distance functions to the safety threatening obstacles and the Jacobian matrix of each distance function.
[0087] Among them, it is assumed that there is an obstacle O that poses a safety threat. k , k = 1, 2, ..., K, and the distance functions between it and the pursuing unmanned vehicle and the escaping unmanned vehicle are calculated as follows:
[0088]
[0089] In the formula, represents the distance function between the i-th pursuing unmanned vehicle and the k-th obstacle; represents the distance function between the jth escaping autonomous vehicle and the kth obstacle. Furthermore, each Jacobian matrix can be calculated as follows:
[0090]
[0091] In the formula, express Relative to the i-th pursuit unmanned vehicle P i The Jacobian matrix of ; express Relative to the jth escaping unmanned vehicle E j The Jacobian matrix of .
[0092] S220, calculating the obstacle avoidance speed instructions of each pursuing unmanned vehicle or escaping unmanned vehicle according to their corresponding Jacobian matrices.
[0093] Specifically, the obstacle avoidance speed instructions of the pursuit unmanned vehicle and the escaping unmanned vehicle can be calculated according to the following formulas:
[0094]
[0095]
[0096] In the formula, represents the obstacle avoidance speed instruction of the i-th pursuing unmanned vehicle; represents the obstacle avoidance speed instruction of the jth escaping unmanned vehicle; represents the Jacobian matrix The generalized inverse of represents the Jacobian matrix The generalized inverse of .
[0097] In order to generate an unconstrained speed instruction, this embodiment will use the technology of obstacle avoidance in zero space to achieve the task of avoiding obstacles while completing the confrontation.
[0098] S230, calculating the null space of the obstacle avoidance speed command of each unmanned vehicle according to the corresponding Jacobian matrix.
[0099] Among them, the zero space of each obstacle avoidance speed instruction can be calculated according to the following formula:
[0100]
[0101] In the formula, Represents the obstacle avoidance speed instruction of the i-th pursuit unmanned vehicle The null space of Represents the obstacle avoidance speed instruction of the jth escaping unmanned vehicle The null space of ; I2 represents the identity matrix.
[0102] S240, respectively calculating each unconstrained unmanned vehicle speed command by combining the obstacle avoidance speed command and the projection component of the counter speed command on the obstacle avoidance speed command null space.
[0103] Among them, each pursuit unmanned vehicle avoids and escapes the unmanned vehicle's confrontation speed instructions and The projection components on the corresponding null space can be calculated according to the following formulas:
[0104]
[0105] Therefore, the obstacle avoidance speed command of the multi-unmanned vehicle system is calculated and And the projection component of the adversarial velocity command on its null space and The unconstrained speed instructions of each of the pursuit unmanned vehicle and the escape unmanned vehicle can be calculated. For example, in one embodiment, they can be calculated as follows:
[0106]
[0107] Wherein, λ1>0 represents the weight coefficient of the obstacle speed command; λ2>0 represents the weight coefficient of the projection component of the counter speed command in the null space of the obstacle speed command. λ1 and λ2 can be selected according to actual needs and are not limited here.
[0108] Next, after obtaining the unconstrained speed instructions of each unmanned vehicle, this embodiment will consider improvements in special cases and maximum allowable speed constraints, and then use the unconstrained unmanned vehicle speed instructions to obtain multi-unmanned vehicle confrontation command signals based on zero-space obstacle avoidance.
[0109] In one embodiment, Figure 3 As shown, the generation process of the confrontation command signal of the multi-unmanned vehicle system specifically includes steps S310 to S350:
[0110] S310, determining whether the speed instructions of each unconstrained unmanned vehicle are zero.
[0111] If yes, execute step S320; if no, jump to step S330.
[0112] In one embodiment, the binary norm of the unconstrained speed command can be calculated and determined whether it is 0. Specifically, the binary norm of the unconstrained speed command of the pursuit unmanned vehicle can be calculated. Is it equal to 0? The result is no; if Then the answer is yes. Similarly, the 2-norm of the unconstrained speed command of the escaping unmanned vehicle can be calculated as Is it equal to 0? The result is no; if The result is yes. It can be understood that the judgment based on the second Fanshu is only an example, and other methods can also be used to determine whether it is zero, which is not limited here.
[0113] S320: If it is zero, the countermeasure speed instruction of the unmanned vehicle is improved to obtain an improved speed instruction of the unmanned vehicle.
[0114] When the speed command of the unconstrained unmanned vehicle is zero, the counter speed command can be improved. Furthermore, before the improvement, it can be determined whether the zero space of the counter speed command of the unmanned vehicle and the obstacle avoidance speed command of the unmanned vehicle is orthogonal; if so, the improvement operation is performed, otherwise, the improvement operation is not performed.
[0115] In one embodiment, the improved operation includes: using a small angle rotation matrix to counter the speed command of the multi-unmanned vehicle system and Rotate an angle (i.e. adjust) to obtain a new anti-speed command, and then project it onto the corresponding obstacle avoidance speed command zero space to obtain an improved unmanned vehicle speed command. It can be understood that the adjusted command is usually not zero. The above improvement operation can be expressed by the following formula:
[0116]
[0117] In the formula, ε represents a preset small angle; R(ε) represents the small angle rotation matrix, which is expressed as follows:
[0118]
[0119] S330, determining whether the non-zero unconstrained unmanned vehicle speed instruction or the improved unmanned vehicle speed instruction exceeds the maximum allowable speed.
[0120] If yes, execute step S340; if no, jump to step S350.
[0121] For example, the unconstrained velocity command of the pursuit vehicle can be calculated by The maximum permissible speed If the size relationship That is, less than or equal to the maximum allowed speed, the result is no; if Then the answer is yes. Similarly, the bi-norm of the unconstrained speed command of the escaping unmanned vehicle can be calculated The maximum permissible speed If the size relationship That is, it is greater than the maximum allowed speed, the result is no; if The result is yes.
[0122] S340: If the maximum allowable speed is exceeded, a saturation correction is performed on the unconstrained unmanned vehicle speed instruction or the improved unmanned vehicle speed instruction according to the corresponding maximum allowable speed.
[0123] Among them, saturation correction means that when the calculated speed command exceeds the corresponding maximum allowable speed, that is, when saturation occurs, the current speed command needs to be corrected so that it does not exceed the maximum allowable speed. After saturation correction, step S350 can be further executed. For example, in one embodiment, the speed command of the unconstrained unmanned vehicle can be saturated according to the respective maximum allowable speeds, and calculated according to the following formulas:
[0124]
[0125] In the formula, and are the corrected speed instructions respectively.
[0126] S350: If the maximum permissible speed is not exceeded, a multi-unmanned vehicle confrontation command signal based on zero-space obstacle avoidance is generated.
[0127] Exemplarily, according to whether obstacle avoidance is required, whether improved processing is required, and whether saturation correction is required, the multi-unmanned vehicle confrontation command signal based on zero-space obstacle avoidance can be described by the following expression:
[0128]
[0129]
[0130] It can be understood that after the corresponding information is known, the multi-unmanned vehicle confrontation command signal can be generated through the above formula.
[0131] The following embodiment proposes a multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance. The method can be applied to the centralized control equipment of the pursuit party or the escape party. It can be understood that a multi-unmanned vehicle confrontation system usually includes two parties, namely the pursuit party and the escape party, wherein the pursuit party includes a number of pursuit unmanned vehicles and a centralized control device (also called a central control terminal) for centralized control of each pursuit unmanned vehicle. Similarly, the escape party includes a number of escape unmanned vehicles and a centralized control device for centralized control of each escape unmanned vehicle. The method of this embodiment can be applied to the pursuit party and the escape party. Since the two parties are performing confrontation operations, the confrontation process is basically the same, except that when generating confrontation instructions, the pursuit party aims to minimize the confrontation index, while the escape party aims to maximize the confrontation index. Therefore, the centralized control device of one of the parties is taken as an example here.
[0132] like Figure 4 As shown, exemplary, the multi-unmanned vehicle confrontation method includes the following steps:
[0133] S401, obtaining the position information of each unmanned vehicle, and calculating the distance information of each unmanned vehicle from the obstacle if there is an obstacle.
[0134] Generally, it is necessary to clarify the basic information of the multi-unmanned vehicle confrontation scenario. For example, the basic information may include but is not limited to the number of unmanned vehicles on both sides, the number and position of each obstacle in the presence of obstacles, the maximum allowable speed of each unmanned vehicle, and the maximum safety distance threshold. Furthermore, in the actual multi-unmanned vehicle confrontation scenario, situation awareness can be performed. For example, the position information of each unmanned vehicle can be obtained by positioning each unmanned vehicle, and then, according to the position of each unmanned vehicle and the position of known obstacles, the distance from the surrounding obstacles is calculated, wherein the distance information here includes the distance size of the obstacles that pose a safety threat, etc.
[0135] S402: Determine whether obstacle avoidance is required based on the distance information.
[0136] If yes, then execute step S404. Alternatively, if no, then jump to step S403.
[0137] For example, it can be determined whether the distance to the obstacle posing a safety threat is less than or equal to the maximum safety distance threshold of the unmanned vehicle. If it is less than or equal to, obstacle avoidance is required, and the result is yes; if it is greater than the maximum safety distance threshold, obstacle avoidance is not required, and the result is no. It can be understood that the maximum safety distance threshold can be set according to actual needs. For example, when the speed of the unmanned vehicle is faster, the threshold can be appropriately selected to be a larger value, otherwise, a smaller value can be appropriately selected, etc.
[0138] S403, when obstacle avoidance is not required, the confrontation speed instructions of each unmanned vehicle that meets the maximum allowable speed constraint are obtained, and then jump to S407 to directly obtain the confrontation command signal of multiple unmanned vehicles. It can be understood that the confrontation speed instruction calculated at this time can be used as the confrontation command signal of multiple unmanned vehicles. Similarly, for scenes where there are no obstacles, the confrontation speed instructions of each unmanned vehicle that meets the maximum allowable speed constraint can be directly obtained to obtain the confrontation command signal of multiple unmanned vehicles.
[0139] S404, when obstacle avoidance is required, obtaining obstacle avoidance speed instructions of each unmanned vehicle, and calculating the zero space of the obstacle avoidance speed instructions respectively.
[0140] Among them, the above-mentioned calculation formula for the obstacle avoidance speed command can be referred to to calculate the obstacle avoidance speed commands of each pursuing unmanned vehicle and escaping unmanned vehicle, as well as their corresponding zero spaces, which will not be repeated here.
[0141] S405, obtaining the confrontation speed command of each unmanned vehicle, and respectively calculating the projection component of the confrontation speed command on the null space of the obstacle avoidance speed command.
[0142] Similarly, the above-mentioned method based on the minimum approximation function and the maximum approximation function can be referred to to calculate the counter speed command of each unmanned vehicle, and then project it into the null space of the obstacle avoidance speed command to obtain the corresponding projection component. It can be understood that the difference from the case where obstacle avoidance is not required is that the counter speed command is combined with the obstacle avoidance speed command to generate an unconstrained speed command based on null space obstacle avoidance.
[0143] S406, based on the projection components of each countermeasure speed instruction on the above-mentioned null space and the obstacle avoidance speed instruction, respectively calculate the unconstrained unmanned vehicle speed instructions based on null space obstacle avoidance.
[0144] In one embodiment, the two speed instructions can be integrated by the weighted summation method shown above. Specifically, weighted calculations are performed based on the obstacle avoidance speed instructions of each pursuing unmanned vehicle (or escaping unmanned vehicle) and the corresponding weighting coefficients, as well as the projection components of its counter-speed instructions on the corresponding null space and the corresponding weighting coefficients, so as to obtain the unconstrained unmanned vehicle speed instructions of each pursuing unmanned vehicle (or escaping unmanned vehicle), respectively.
[0145] S407, using each unconstrained unmanned vehicle speed instruction, generate each unmanned vehicle counter-instruction signal that meets the maximum allowable speed constraint.
[0146] In one embodiment, referring to the above Figure 3 As shown, step S408 includes: determining whether each unconstrained unmanned vehicle speed instruction is zero. If it is zero, the counter speed instruction of the corresponding unmanned vehicle is improved to obtain an improved unmanned vehicle speed instruction that is not zero; then determining whether the unconstrained unmanned vehicle speed instruction or the improved unmanned vehicle speed instruction that is not zero exceeds the maximum allowable speed; if it exceeds the maximum allowable speed, the unconstrained unmanned vehicle speed instruction or the improved unmanned vehicle speed instruction is saturated corrected according to the corresponding maximum allowable speed, and a multi-unmanned vehicle counter instruction signal is generated. Further optionally, if it does not exceed the maximum allowable speed, a multi-unmanned vehicle counter instruction signal is generated according to the unconstrained unmanned vehicle speed instruction or the improved unmanned vehicle speed instruction.
[0147] S408, controlling each unmanned vehicle to perform corresponding movement according to the confrontation command signal of each unmanned vehicle.
[0148] Exemplarily, after obtaining the confrontation command signal of each pursuing unmanned vehicle or escaping unmanned vehicle, the system can send the corresponding confrontation command signal to the corresponding unmanned vehicle, so that each unmanned vehicle can meet the obstacle avoidance requirements while performing confrontation. It can be understood that if this method is applied to the pursuing party, the centralized control device of the pursuing party will control the motion of each pursuing unmanned vehicle; if it is applied to the escaping party, the centralized control device of the escaping party will control the motion of each escaping unmanned vehicle.
[0149] In order to verify the method of generating the multi-unmanned vehicle confrontation command signal based on zero-space obstacle avoidance in the above embodiment, a confrontation scene including 3 chasing unmanned vehicles, 2 escaping unmanned vehicles, 1 circular obstacle, and 1 rectangular obstacle is set here, and the following initial information is selected respectively:
[0150] The first pursuit vehicle: Position P1 = [-5 0] T m; Maximum permissible speed
[0151] Second pursuit vehicle: Position P2 = [0 0] Tm; Maximum permissible speed
[0152] The third pursuit vehicle: Position P3 = [5 0] T m; Maximum permissible speed
[0153] The first escaping autonomous vehicle: position E1 = [-2 10] T m; Maximum permissible speed
[0154] The second escaping autonomous vehicle: position E2 = [10 5] T m; Maximum permissible speed
[0155] The first circular obstacle: center c1 = [-2 5] T m; radius r1 = 2m; the corresponding maximum safety distance threshold
[0156] The first rectangular obstacle: lower left vertex c2 = [10 8] T m; length l = 4m; width w = 2m; the corresponding maximum safety distance threshold
[0157] In addition, the relevant parameters are selected as follows: approximation design parameter α = 3, rotation angle ε = 1°, weighting coefficient λ1 = 10 and weighting coefficient λ2 = 1. According to the confrontation method of steps S401 to S409 above, the following can be calculated: Figure 5 The figure shows the adversarial motion trajectory of the multi-unmanned vehicle system in an obstacle avoidance environment.
[0158] The multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance in this embodiment can solve the problem of generating confrontation instructions in obstacle scenes according to the current situation of the multi-unmanned vehicle system, provide new ideas for the research on the game confrontation mechanism of the multi-unmanned vehicle system, and provide real-time confrontation instructions for various tasks such as firepower strikes, cluster defense, regional expulsion, and logistics supply. In addition, the method of this embodiment can also be migrated to other multi-robot systems that meet the requirements of confrontation scenarios, by obtaining the confrontation command signal of the multi-robot system under obstacle avoidance constraints in real time, and then facilitate motion control.
[0159] Please refer to Figure 6Based on the method of the above embodiment, this embodiment proposes a multi-unmanned vehicle confrontation device 100 based on zero-space obstacle avoidance, which is mainly used for a centralized control device of a pursuing party or a escaping party in a multi-unmanned vehicle confrontation system including a pursuing unmanned vehicle and an escaping unmanned vehicle, wherein the pursuing party and the escaping party respectively include a plurality of pursuing unmanned vehicles and an escaping unmanned vehicle, and the maximum allowable speeds of the pursuing unmanned vehicles are all greater than the maximum allowable speeds of the escaping unmanned vehicles, etc.
[0160] Exemplarily, the multi-unmanned vehicle confrontation device 100 based on zero-space obstacle avoidance includes:
[0161] The information acquisition module 110 is used to obtain the position information of each unmanned vehicle and calculate the distance information of each unmanned vehicle from the obstacle when there is an obstacle.
[0162] The first calculation module 120 is used to determine whether obstacle avoidance is required based on the distance information, and when obstacle avoidance is required, obtain the obstacle avoidance speed command of each unmanned vehicle, and calculate the zero space of the obstacle avoidance speed command respectively.
[0163] The second calculation module 130 is used to obtain the confrontation speed command of each unmanned vehicle, and respectively calculate the projection component of the confrontation speed command on the null space of the obstacle avoidance speed command.
[0164] The third calculation module 140 is used to calculate the unconstrained unmanned vehicle speed instructions based on zero space obstacle avoidance based on the projection components of the counter speed instructions of each unmanned vehicle on the zero space and the obstacle avoidance speed instructions.
[0165] The instruction generation module 150 is used to generate each unmanned vehicle counter-instruction signal that meets the maximum allowable speed constraint by using each of the unconstrained unmanned vehicle speed instructions.
[0166] The control module 160 is used to control each unmanned vehicle to perform corresponding movements according to the confrontation command signal of each unmanned vehicle.
[0167] Furthermore, the multi-unmanned vehicle confrontation device 100 based on zero-space obstacle avoidance may also include a scene setting module. Specifically, the scene setting module is used to configure the basic information of the multi-unmanned vehicle confrontation scene. For example, the basic information may include but is not limited to the number of the pursuit unmanned vehicle and the escape unmanned vehicle, the location of each obstacle, the maximum allowable speed of each unmanned vehicle, and the maximum safety distance threshold, etc. In addition, the number of the pursuit unmanned vehicles should be greater than or equal to the number of the escape unmanned vehicles; the maximum allowable speed of the pursuit unmanned vehicles should all be greater than the maximum allowable speed of the escape unmanned vehicles. And, when a certain escaped unmanned vehicle is caught by any of the pursuit unmanned vehicles, the escaped unmanned vehicle and the pursuit unmanned vehicle will exit the subsequent multi-unmanned vehicle confrontation process. And, each time the obstacle avoidance function is activated, only one or zero obstacles will pose a security threat to the pursuit unmanned vehicle and the escaped unmanned vehicle.
[0168] It can be understood that the device of this embodiment corresponds to the method of the above embodiment, and the options in the above embodiment are also applicable to this embodiment, so they will not be described repeatedly here.
[0169] The present application also provides a multi-unmanned vehicle system. Exemplarily, the multi-unmanned vehicle system mainly includes a number of pursuing unmanned vehicles, a number of escaping unmanned vehicles, and centralized control devices of the pursuing party and the escaping party, etc., wherein the number of the pursuing unmanned vehicles is greater than or equal to the number of the escaping unmanned vehicles, and the maximum allowable speeds of the pursuing unmanned vehicles are all greater than the maximum allowable speeds of the escaping unmanned vehicles; the centralized control devices of the pursuing party and the escaping party respectively adopt the multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance of the above-mentioned embodiment to control each pursuing unmanned vehicle and each escaping unmanned vehicle to perform confrontation movements.
[0170] The present application also provides a readable storage medium storing a computer program. When the computer program is executed on a processor, the multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance of the above embodiment is implemented.
[0171] In several embodiments provided in the present application, it should be understood that the disclosed devices and methods can also be implemented in other ways. The device embodiments described above are merely schematic. For example, the flowcharts and structure diagrams in the accompanying drawings show the possible architecture, functions and operations of the devices, methods and computer program products according to multiple embodiments of the present application. In this regard, each box in the flowchart or block diagram can represent a module, a program segment or a part of a code, and the module, a program segment or a part of a code contains one or more executable instructions for implementing the specified logical function. It should also be noted that in an alternative implementation, the functions marked in the box can also occur in a different order from the order marked in the accompanying drawings. For example, two consecutive boxes can actually be executed substantially in parallel, and they can sometimes be executed in the opposite order, depending on the functions involved. It should also be noted that each box in the structure diagram and / or the flow diagram, and the combination of boxes in the structure diagram and / or the flow diagram, can be implemented with a dedicated hardware-based system that performs a specified function or action, or can be implemented with a combination of dedicated hardware and computer instructions.
[0172] In addition, the functional modules or units in the various embodiments of the present application may be integrated together to form an independent part, or each module may exist separately, or two or more modules may be integrated to form an independent part.
[0173] If the function is implemented in the form of a software function module and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present application can be essentially or partly embodied in the form of a software product that contributes to the prior art, and the computer software product is stored in a storage medium, including several instructions for a computer device (which can be a smart phone, a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present application. The aforementioned storage medium includes: various media that can store program codes, such as a USB flash drive, a mobile hard disk, a read-only memory (ROM), a random access memory (RAM), a disk or an optical disk.
[0174] The above description is only a specific implementation manner of the present application, but the protection scope of the present application is not limited thereto. Any technician familiar with the technical field can easily think of changes or substitutions within the technical scope disclosed in the present application, which should be included in the protection scope of the present application.
Claims
1. A multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance, characterized in that: A centralized control device applied to a pursuit party or a fleeing party in a multi-unmanned vehicle confrontation system, wherein the pursuit party and the fleeing party respectively include a plurality of pursuit unmanned vehicles and fleeing unmanned vehicles; the method includes: Obtain the location information of each unmanned vehicle and calculate the distance information of each unmanned vehicle from the obstacle if there is an obstacle; Determining whether obstacle avoidance is required based on the distance information, and when obstacle avoidance is required, obtaining obstacle avoidance speed instructions for each unmanned vehicle, and respectively calculating the zero space of the obstacle avoidance speed instructions; Obtaining the confrontation speed command of each unmanned vehicle, and respectively calculating the projection components of the confrontation speed command on the null space of the obstacle avoidance speed command; Based on the projection components of each of the counter speed instructions on the null space and the obstacle avoidance speed instructions, respectively calculating the unconstrained unmanned vehicle speed instructions based on null space obstacle avoidance; Using each of the unconstrained unmanned vehicle speed instructions, generating each unmanned vehicle countermeasure instruction signal that satisfies the maximum allowable speed constraint; Controlling each unmanned vehicle to perform corresponding movement according to the confrontation command signal of each unmanned vehicle; The confrontation speed instructions of each unmanned vehicle are generated based on the minimum approximation function and the maximum approximation function, including: Using the minimum approximation function, the differentiable minimum distance from each of the escaping unmanned vehicles to all the pursuing unmanned vehicles is calculated; using the maximum approximation function, the differentiable maximum value of the differentiable minimum distances of all the escaping unmanned vehicles is calculated as the confrontation index of the multi-unmanned vehicle confrontation system; When applied to the pursuit party, the confrontation speed instruction of the pursuit unmanned vehicle that satisfies the maximum allowable speed constraint is obtained by minimizing the confrontation index; Alternatively, when applied to the escaping party, the confrontation index is maximized to obtain a confrontation speed instruction for the escaping unmanned vehicle that meets the maximum allowable speed constraint.
2. The multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance according to claim 1 is characterized in that: The obtaining of the obstacle avoidance speed instruction of each unmanned vehicle includes: According to the positions of each of the pursuing unmanned vehicle and the escaping unmanned vehicle, the Jacobian matrix of each distance function is calculated based on the distance function to the obstacle posing a safety threat; According to each of the Jacobian matrices, an obstacle avoidance speed instruction of each of the pursuing unmanned vehicle or the escaping unmanned vehicle is calculated.
3. The method for multiple unmanned vehicles to fight against each other based on zero-space obstacle avoidance according to claim 2 is characterized in that: The calculation is based on the unconstrained unmanned vehicle speed instruction for zero-space obstacle avoidance, including: According to the projection component of the countermeasure speed command of the corresponding unmanned vehicle on the null space and the corresponding weighting coefficient, as well as the obstacle avoidance speed command and the corresponding weighting coefficient, a weighted calculation is performed to obtain the unconstrained unmanned vehicle speed command of each unmanned vehicle respectively.
4. The method for multiple unmanned vehicles to fight against each other based on zero-space obstacle avoidance according to claim 1, characterized in that: The number of pursuing unmanned vehicles in the multi-unmanned vehicle confrontation system is greater than or equal to the number of escaping unmanned vehicles, and the maximum allowable speeds of the pursuing unmanned vehicles are all greater than the maximum allowable speeds of the escaping unmanned vehicles.
5. The method for multiple unmanned vehicles to fight against each other based on zero-space obstacle avoidance according to claim 1, characterized in that: The method of utilizing each of the unconstrained unmanned vehicle speed instructions to generate a multi-unmanned vehicle confrontation instruction signal that satisfies the corresponding maximum allowable speed constraint includes: Determining whether the speed instructions of each of the unconstrained unmanned vehicles are zero; If it is zero, then the countermeasure speed command of the corresponding unmanned vehicle is improved to obtain an improved unmanned vehicle speed command that is not zero; Determining whether the non-zero unconstrained unmanned vehicle speed command or the improved unmanned vehicle speed command exceeds a maximum allowable speed; If the maximum permissible speed is not exceeded, generating a multi-unmanned vehicle confrontation command signal according to the unconstrained unmanned vehicle speed command or the improved unmanned vehicle speed command; If the maximum allowable speed is exceeded, a saturation correction is performed on the unconstrained unmanned vehicle speed command or the improved unmanned vehicle speed command according to the corresponding maximum allowable speed, and a multi-unmanned vehicle confrontation command signal is generated.
6. The method for multiple unmanned vehicles to fight against each other based on zero-space obstacle avoidance according to claim 5 is characterized in that: The improvement of the counter-speed instruction of the corresponding unmanned vehicle also includes: Determining whether the null space of the confrontation speed command of the unmanned vehicle and the obstacle avoidance speed command of the unmanned vehicle is orthogonal; If they are orthogonal, the improvement operation is performed, otherwise the improvement operation is not performed; The improving the counter-speed instruction of the corresponding unmanned vehicle includes: The countermeasure speed of the unmanned vehicle is adjusted using a small-angle rotation matrix to obtain an improved unmanned vehicle speed instruction that is not zero.
7. The multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance according to any one of claims 1 to 6, characterized in that: Also includes: When obstacle avoidance is not required or when no obstacle exists, the counter-speed instructions of each unmanned vehicle that meets the maximum allowable speed constraint are obtained as the counter-speed instruction signals of each unmanned vehicle.
8. A multi-unmanned vehicle confrontation device based on zero-space obstacle avoidance, characterized in that: A centralized control device for a pursuit party or a fleeing party in a multi-unmanned vehicle confrontation system, wherein the pursuit party and the fleeing party respectively include a plurality of pursuit unmanned vehicles and fleeing unmanned vehicles; the device includes: An information acquisition module is used to obtain the position information of each unmanned vehicle and calculate the distance information of each unmanned vehicle from the obstacle when there is an obstacle; A first calculation module is used to determine whether obstacle avoidance is required based on the distance information, and when obstacle avoidance is required, obtain obstacle avoidance speed instructions of each unmanned vehicle, and calculate the zero space of the obstacle avoidance speed instructions respectively; A second calculation module is used to obtain the confrontation speed command of each unmanned vehicle, and respectively calculate the projection component of the confrontation speed command on the null space of the obstacle avoidance speed command; A third calculation module is used to calculate the unconstrained unmanned vehicle speed instructions based on null space obstacle avoidance based on the projection components of the confrontation speed instructions of each unmanned vehicle on the null space and the obstacle avoidance speed instructions; An instruction generation module, used to generate each unmanned vehicle counter-instruction signal that meets the maximum allowable speed constraint by using each of the unconstrained unmanned vehicle speed instructions; A control module, used for controlling each unmanned vehicle to perform corresponding movement according to the confrontation command signal of each unmanned vehicle; The confrontation speed instructions of each unmanned vehicle are generated based on the minimum approximation function and the maximum approximation function, including: Using the minimum approximation function, the differentiable minimum distance from each of the escaping unmanned vehicles to all the pursuing unmanned vehicles is calculated; using the maximum approximation function, the differentiable maximum value of the differentiable minimum distances of all the escaping unmanned vehicles is calculated as the confrontation index of the multi-unmanned vehicle confrontation system; When applied to the pursuit party, the confrontation speed instruction of the pursuit unmanned vehicle that satisfies the maximum allowable speed constraint is obtained by minimizing the confrontation index; Alternatively, when applied to the escaping party, the confrontation index is maximized to obtain a confrontation speed instruction for the escaping unmanned vehicle that meets the maximum allowable speed constraint.
9. A multi-unmanned vehicle confrontation system, characterized in that: The multi-unmanned vehicle confrontation system includes a plurality of pursuit unmanned vehicles, a plurality of escape unmanned vehicles, and centralized control devices of the pursuit party and the escape party, wherein the number of the pursuit unmanned vehicles is greater than or equal to the number of the escape unmanned vehicles, and the maximum allowable speeds of the pursuit unmanned vehicles are all greater than the maximum allowable speeds of the escape unmanned vehicles; The respective centralized control devices of the pursuing party and the escaping party respectively adopt the multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance described in any one of claims 1-7 to correspondingly control each of the pursuing unmanned vehicles and each of the escaping unmanned vehicles to perform confrontational movements.
10. A readable storage medium, characterized in that: It stores a computer program, which, when executed on a processor, implements the multi-unmanned vehicle confrontation method based on zero-space obstacle avoidance according to any one of claims 1-7.
