Multi-UUV formation reconstruction method for dynamic complex tasks
By designing a dynamic formation reconstruction method in a UUV cluster, using the Navigator UUV to identify the crashed node and apply specific principles to adjust the formation, the problems of slow response speed and poor robustness of formation reconstruction in the existing technology are solved, and the UUV cluster is realized Stable and continuous task execution.
Patent Information
- Application Number
- CN202411191157.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-28
- Publication Date
- 2024-11-29
- Estimated Expiration
- 2044-08-28
AI Technical Summary
In the prior art, under the conditions of underwater communication limitation, the UUV cluster responds slowly to the formation reconstruction decision, and the result is poor robustness and reliability, making it difficult to quickly deal with unexpected situations such as node crashes.
A multi-UUV formation reconstruction method for dynamic and complex tasks was designed. The Navigator UUV identified the crashed node based on real-time position signals, and adopted the principle of "front row priority, back row replacement, shortest distance, least adjustment, and even distribution" Formation reconstruction, using kinematics and dynamic models to achieve node filling.
Real-time formation reconstruction of UUV clusters in the event of node crashes is realized, ensuring task stability and continuity, and improving the robustness and reliability of formations.
Smart Images

Figure CN119045514A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to a multi-UUV formation reconstruction method for dynamic and complex tasks, and belongs to the technical field of unmanned underwater vehicle formation control. Background Art
[0002] Compared with land resources, the ocean contains a wide variety of resources and huge reserves, which can effectively alleviate the problem of land resource shortage. Unmanned Underwater Vehicle (UUV), as an intelligent unmanned ocean carrier platform, has significant advantages such as small size, light weight, and unmanned operation. It can load a variety of mission modules and independently complete various high-complexity tasks to meet various needs, becoming an important equipment for the development and utilization of marine resources. For example, in the civilian field, UUV is widely used in the exploration of marine resources, mapping of seabed topography, and maritime search and rescue. The intelligent and unmanned characteristics of UUV indicate that in future ocean exploration, it will replace humans to perform more high-risk tasks.
[0003] In a complex seabed environment, a single UUV may encounter an accident while performing a mission, resulting in mission interruption. Under conditions where underwater communications are limited, once the UUV is damaged and loses contact with the base or ship, it will not only hinder mission execution, but also increase the difficulty of searching. If UUVs perform missions in clusters, they can accelerate mission progress by quickly and accurately collecting environmental information through cooperation. At the same time, the increase in the number of UUVs also enhances the redundancy of the system. Even if a UUV fails, it will not lead to the failure of the entire mission. It not only improves the safety and mission completion rate of unmanned operations, but also completes tasks that are difficult to achieve with a single UUV.
[0004] Since a single UUV has problems such as small detection range and low accuracy, the use of multiple UUVs to work together through information sharing and data fusion technology can not only expand the detection range, but also improve the detection accuracy of the target. Therefore, the study of UUV cluster technology has important practical value.
[0005] When a UUV cluster performs a mission underwater, some nodes may crash. In order to continue the mission, the cluster's formation needs to be reconstructed according to the status of the remaining nodes. Since UUVs are greatly restricted in underwater communication, existing methods usually use manual decision-making for formation reconstruction, which has the problems of slow response speed, poor robustness and reliability of formation results. Summary of the invention
[0006] Aiming at the problem that formation reconstruction with some nodes crashed adopts manual decision-making, has slow response speed and poor reliability of formation results, the present invention provides a multi-UUV formation reconstruction method for dynamic and complex tasks.
[0007] A multi-UUV formation reconstruction method for dynamic and complex tasks of the present invention comprises:
[0008] Establishing a formation model for the UUV cluster, wherein the formation model includes the number of rows of the UUV cluster and the row and column numbers of each node UUV;
[0009] The leader UUV determines the current position matrix of the UUV cluster based on the position signal transmitted in real time by each node UUV, and identifies the crashed node UUV based on the row and column numbers of each node UUV when the current position matrix is different from the expected position matrix;
[0010] The leader UUV determines the row number k where the crash occurred based on the row and column number of the crash node UUV;
[0011] If the row number k where the crash occurred is less than the total number of rows K, according to the principle of prioritizing the back row to ensure the front row shape, starting from the k+1 row, the replacement distance of each adjustment plan is calculated according to the current position matrix in the selected row number; the adjustment plan with the smallest replacement distance is selected to control the corresponding node UUV to replace the crashed node UUV; if there are multiple adjustment plans with the same replacement distance, the adjustment plan involving the least number of node UUVs is selected to control the corresponding node UUV to replace the crashed node UUV;
[0012] If the row number k where the crash occurs is equal to the total row number K, according to the principle of uniform distribution, multiple node UUVs in the Kth row are controlled to be evenly arranged according to the row boundaries of the expected position matrix.
[0013] According to the multi-UUV formation reconstruction method for dynamic and complex tasks of the present invention, the adjustment scheme includes a combination scheme of selecting multiple node UUVs in the selected rows to sequentially fill in the crashed node UUV, and a scheme of selecting one node UUV in the selected rows to directly fill in the crashed node UUV.
[0014] According to the multi-UUV formation reconstruction method for dynamic complex tasks of the present invention, if there is only one node UUV in the Kth row, the node UUV is controlled to be on the longitudinal symmetry axis of the formation.
[0015] According to the multi-UUV formation reconstruction method for dynamic complex tasks of the present invention, the formation model includes a longitudinal model, a lateral model and a composite model.
[0016] According to the multi-UUV formation reconstruction method for dynamic complex tasks of the present invention, the selected number of rows includes k+1 rows to k+3 rows.
[0017] According to the multi-UUV formation reconstruction method for dynamic complex tasks of the present invention, the replacement control of the node UUV is implemented based on the kinematic model and dynamic model of the node UUV.
[0018] According to the multi-UUV formation reconstruction method for dynamic complex tasks of the present invention, the kinematic model of the node UUV is:
[0019]
[0020] Where (x, y, z) represents the three-dimensional center of gravity coordinates of the node UUV in the inertial coordinate system. represents the roll angle, pitch angle and bow angle of the node UUV in the inertial coordinate system; (u, v, w) represents the forward linear velocity, lateral linear velocity and heave linear velocity of the node UUV relative to the ocean current in the carrier coordinate system; (p, q, r) is the angular velocity of rotation of the three coordinate axes in the carrier coordinate system.
[0021] According to the multi-UUV formation reconstruction method for dynamic complex tasks of the present invention, the dynamic model of the node UUV is:
[0022]
[0023] Where M is the generalized mass matrix of the node UUV:
[0024] Among them, M RB is the mass and inertia matrix, M A is the additional mass matrix, is the set of real numbers;
[0025] C(V) is the Coriolis centripetal force matrix:
[0026] Among them C A (V) is the hydrodynamic centripetal force matrix, C RB (V) is the rigid body centripetal force matrix;
[0027] D(V) is the nonlinear hydrodynamic damping matrix,
[0028] g(η) is the restoring force matrix,
[0029] τ is the control matrix of node UUV:
[0030] Where F is the thrust, δ s is the horizontal rudder angle, δ r is the vertical rudder angle;
[0031] τ e For environmental interference,
[0032]
[0033] Beneficial effects of the invention: When dealing with unexpected situations such as a single node crash in a UUV cluster, the method of the invention reconstructs the formation by designing a formation reconstruction principle of "front row priority, back row substitute, shortest distance, least adjustment, and uniform distribution" to ensure that the UUV cluster can successfully complete the task.
[0034] The method of the invention is applicable to the control of unmanned underwater vehicle formations, and is used to design real-time formation reconstruction strategies to cope with unexpected situations, which has important application and practical value. The formation reconstruction principle of the invention takes into account the crash of individual nodes in the UUV cluster, etc., and can ensure the stability and continuity of the unmanned underwater vehicle formation during the mission execution process, thereby improving the robustness and reliability of the UUV formation. BRIEF DESCRIPTION OF THE DRAWINGS
[0035] Figure 1 It is a schematic diagram of the process of the multi-UUV formation reconstruction method for dynamic and complex tasks according to the present invention;
[0036] Figure 2 It is the multi-UUV lateral formation diagram corresponding to the lateral model;
[0037] Figure 3 This is the longitudinal formation diagram of multiple UUVs corresponding to the longitudinal model;
[0038] Figure 4 It is the multi-UUV composite formation diagram corresponding to the composite model;
[0039] Figure 5 This is a schematic diagram of the principle of "front row priority, back row substitute" in the method of the present invention;
[0040] Figure 6 This is a schematic diagram of the principle of "shortest distance, least adjustment" in the method of the present invention;
[0041] Figure 7 This is a schematic diagram of the "even distribution" principle of horizontal formation;
[0042] Figure 8 This is a schematic diagram of the "even distribution" principle of the composite formation;
[0043] Fig. 9 It is the node change diagram of multiple UUV formations;
[0044] Fig.10 This is a schematic diagram of the reconstruction of the cluster UUV formation;
[0045] Fig.11 Schematic diagram of the heading angle error curve for reconstructing the swarm UUV formation;
[0046] Fig.12 Schematic diagram of the eastward position error curve for reconstructing the cluster UUV formation;
[0047] Fig.13 Schematic diagram of the north position error curve for reconstructing the cluster UUV formation. DETAILED DESCRIPTION
[0048] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. 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.
[0049] It should be noted that, in the absence of conflict, the embodiments of the present invention and the features in the embodiments may be combined with each other.
[0050] The present invention will be further described below in conjunction with the accompanying drawings and specific embodiments, but they are not intended to limit the present invention.
[0051] Specific implementation method 1. Combination Figures 1 to 6 As shown, the present invention provides a multi-UUV formation reconstruction method for dynamic and complex tasks, including:
[0052] Establishing a formation model for the UUV cluster, wherein the formation model includes the number of rows of the UUV cluster and the row and column numbers of each node UUV;
[0053] The leader UUV determines the current position matrix of the UUV cluster based on the position signal transmitted in real time by each node UUV, and identifies the crashed node UUV based on the row and column numbers of each node UUV when the current position matrix is different from the expected position matrix;
[0054] The leader UUV determines the row number k where the crash occurred based on the row and column number of the crash node UUV;
[0055] If the row number k where the crash occurred is less than the total number of rows K, according to the principle of prioritizing the back row to ensure the front row shape, starting from the k+1 row, the replacement distance of each adjustment plan is calculated according to the current position matrix in the selected row number; the adjustment plan with the smallest replacement distance is selected to control the corresponding node UUV to replace the crashed node UUV; if there are multiple adjustment plans with the same replacement distance, the adjustment plan involving the least number of node UUVs is selected to control the corresponding node UUV to replace the crashed node UUV;
[0056] If the row number k where the crash occurs is equal to the total row number K, according to the principle of uniform distribution, multiple node UUVs in the Kth row are controlled to be evenly arranged according to the row boundaries of the expected position matrix.
[0057] Further, combined with Figures 5 to 9As shown, the adjustment scheme includes a combination scheme of selecting multiple node UUVs in the selected rows to sequentially fill in the crashed node UUV, and a scheme of selecting one node UUV in the selected rows to directly fill in the crashed node UUV.
[0058] As an example, combining Figure 8 As shown, if there is only one node UUV in the Kth row at present, the node UUV is controlled to be on the longitudinal symmetry axis of the formation.
[0059] In this implementation, the formation model includes a longitudinal model, a transverse model and a composite model.
[0060] When establishing the formation model, the formations for common tasks such as cluster search and detection, rapid crossing, etc. are divided into longitudinal formations, transverse formations and composite formations, and the UUVs in the system are numbered.
[0061] Combination Figure 2 As shown in the figure, for the horizontal formation: the main arrangement direction of the UUVs in the formation group is consistent with the Gy axis of the carrier coordinate system. The horizontal formation is suitable for cluster search and detection tasks, which can effectively expand the search coverage area and improve the search efficiency.
[0062] Combination Figure 3 As shown, for the longitudinal formation: the arrangement direction of the UUVs in the formation group is consistent with the Gx axis of the carrier coordinate system. The use of this formation can improve the concealment and safety of the UUV group.
[0063] Combination Figure 4 As shown, for the compound formation: this formation is derived from the longitudinal formation and the transverse formation, and it has no obvious horizontal and vertical arrangement characteristics.
[0064] This implementation method is based on the principle of "front row priority, back row replacement, shortest distance, least adjustment, and uniform distribution" when selecting an adjustment plan.
[0065] During the execution process, the follower UUV transmits its own status to the leader UUV in real time for the leader UUV to identify the formation classification; the leader UUV identifies the number of the crashed and lost UUV and transmits the formation change instruction to each follower UUV in the formation system. When determining the adjustment plan, starting from the k+1 row, a matrix of the number of UUV rows is established to select UUV nodes to replace the vacant nodes.
[0066] As an example, the selected number of rows includes row k+1 to row k+3.
[0067] In this implementation, the selection of the formation reconstruction plan is affected by three factors, namely, the number of rows, the distance, and the number of adjustments. After the row number k of the crashed UUV is confirmed, the replacement UUV row number matrix is established starting from the k+1 row. In the established row number matrix, the set of plans with the smallest total adjustment distance is determined. When the total adjustment distances of different plans are the same, the plan with the least number of adjustments is selected. The details are as follows:
[0068] When a node crashes, based on the overall forward direction of the group, the nodes in front of the crashed node are considered front-row nodes, and the nodes behind the crashed node are back-row nodes, and the rest are same-row nodes. According to the formation reconstruction strategy, the vacancies created by the crashed node are filled by the back-row nodes to ensure that the front-row formation is compact, and the selection of the back-row filling nodes meets the principle of "shortest distance". When the front-row UUV crashes, a UUV node is selected from the back row to fill the vacancies, ensuring that there are no vacancies in the front row of the formation. The new vacancies created by the replacement will continue to be filled by the vacant back-row UUVs; for multiple formation reconstruction schemes, the scheme with the smallest total adjustment distance is selected first. When the total adjustment distances are the same, the reconstruction scheme with the least number of adjustments is selected.
[0069] When there is a vacancy in the last row of the formation due to replacement or node crash, no node is selected for replacement. Instead, the principle of "even distribution" is followed to evenly distribute the remaining UUVs in the row in the original position distribution range. If there is only one UUV node in the last row, it is placed on the longitudinal symmetry axis of the formation.
[0070] Furthermore, the replacement control of the node UUV is implemented based on the kinematic model and dynamic model of the node UUV.
[0071] The kinematic model of the node UUV is:
[0072]
[0073] Where (x, y, z) represents the three-dimensional center of gravity coordinates of the node UUV in the inertial coordinate system, ( (θ, ψ) represents the roll angle, pitch angle and bow angle of the node UUV in the inertial coordinate system; (u, v, w) represents the forward linear velocity, lateral linear velocity and heave linear velocity of the node UUV relative to the ocean current in the carrier coordinate system; (p, q, r) is the rotation angular velocity of the three coordinate axes in the carrier coordinate system.
[0074] The dynamic model of the node UUV is:
[0075]
[0076] Where M is the generalized mass matrix of the node UUV:
[0077] Among them, M RB is the mass and inertia matrix, M A is the additional mass matrix, is the set of real numbers;
[0078] C(V) is the Coriolis centripetal force matrix:
[0079] Among them C A (V) is the hydrodynamic centripetal force matrix, C RB (V) is the rigid body centripetal force matrix;
[0080] D(V) is the nonlinear hydrodynamic damping matrix,
[0081] g(η) is the restoring force matrix,
[0082] τ is the control matrix of node UUV:
[0083] Where F is the thrust, δ s is the horizontal rudder angle, δ r is the vertical rudder angle;
[0084] τ e For environmental interference,
[0085]
[0086] Embodiment 1:
[0087] Combination Figure 5 As shown in the figure, the principle of "front row priority, back row replacement" is mainly used in the case of node crashes in the longitudinal formation. When a node crashes, the node in front of the crashed node is regarded as the front row node, and the node behind the crashed node is the back row node, and the rest are the same row nodes. Therefore, according to the formation reconstruction strategy, the vacant position generated by the crashed node is filled by the back row node to ensure that the front row formation is compact, and the selection of the back row filling node meets the principle of "shortest distance". When UUV No. 2 and UUV No. 3 crashed, UUV No. 4 and UUV No. 5 in the back row were selected to fill the position, so that the total adjustment distance is shortest.
[0088] Embodiment 2:
[0089] Combination Figure 6As shown in the figure, the principle of "shortest distance, least adjustment" mainly solves the formation reconstruction of compound formations. When the front row UUV crashes, the UUV node is selected from the back row to fill the position, ensuring that there is no vacant position in the front row of the formation. The new vacant position generated by the replacement will continue to be replaced by the vacant UUV in the back row. However, if there are multiple formation reconstruction schemes, the scheme with the smallest total adjustment distance will be selected first. When the total adjustment distances are the same, the reconstruction scheme with the least number of adjustments will be selected. UUV No. 1 crashed. According to the principle of "front row priority, back row replacement", there are four formation reconstruction schemes. The first option is to select UUV No. 2 in the back row to fill the position. Due to the forward filling, the position of UUV No. 2 becomes vacant, and UUV No. 5 fills the position again; the second option is to first select UUV No. 4 to fill the vacancy of UUV No. 1, and then UUV No. 5 fills the vacancy of UUV No. 4; the third option is for UUV No. 3 to fill the position of UUV No. 1, and UUV No. 5 to replace UUV No. 3; the fourth option is for UUV No. 5 to directly replace the vacant position of UUV No. 1. According to the position distribution of each UUV node in the group formation, the total adjustment distance of Scheme 4 and Scheme 2 is shorter than the other two options, and the total adjustment distance of Scheme 4 and Scheme 2 is theoretically consistent, but Scheme 4 has the least number of adjustments, so Scheme 4 is finally selected as the formation reconstruction plan.
[0090] Embodiment three:
[0091] Combination Figure 7 and Figure 8 As shown in the figure, the "even distribution" principle is mainly for the reconstruction of the horizontal formation. When there is a vacancy in the last row of the formation due to filling or node crash, no node is selected for replacement. Instead, the "even distribution" principle is followed to evenly distribute the remaining UUVs in the row in the original position distribution range. If there is only one UUV node in the last row, it is placed on the longitudinal symmetry axis of the formation.
[0092] like Figure 7 As shown in the figure, in the 4-node formation group under scenario 1, after UUV No. 1 crashes, UUV No. 2 replaces the original formation position of UUV No. 1, and UUV No. 3 moves to the middle position of the row, satisfying the principle of "even distribution" and making the overall formation symmetrical. Figure 8 In the 3-node group of scenario 2 below, after UUV No. 2 crashes, only UUV No. 3 is left in the last row, so UUV No. 3 moves to the longitudinal symmetry axis.
[0093] Embodiment 4:
[0094] Combination Figures 9 to 13 As shown, a formation system consisting of 5 UUV nodes is considered.
[0095] UUV cluster formation Fig. 9In the diamond formation shown in (a), UUV No. 1 crashed and the formation began to be reconstructed. According to the formation reconstruction strategy, the formation will theoretically be as follows Fig. 9 (b) shows a triangle formation; UUV No. 5 is the leader and UUVs No. 1 to 4 are followers. At 1000 seconds, UUV No. 2 crashed and the formation was reconstructed again to form the following Fig. 9 (c) The V-shaped formation shown.
[0096] Combination Figures 10 to 13 During the entire formation process, the formation changes of the UUV cluster met the expected results. As the No. 1 follower UUV and No. 2 follower UUV crashed successively, their formation errors continued to increase. When the UUV cluster was reconstructing the formation, the formation errors of some follower nodes that needed to be adjusted suddenly changed, but the formation reconstruction error was still able to converge to zero in the end. The heading angle error of the follower UUV can converge to zero after a short adjustment.
[0097] In summary, the method of the present invention realizes the real-time and rapid response reconstruction of multiple UUV formations, takes into account the crash of individual nodes in the UUV cluster, ensures the stability and continuity of the unmanned underwater vehicle formation during mission execution, and improves the robustness and reliability of the UUV formation.
[0098] Although the present invention is described herein with reference to specific embodiments, it should be understood that these embodiments are merely examples of the principles and applications of the present invention. It should therefore be understood that many modifications may be made to the exemplary embodiments and that other arrangements may be devised without departing from the spirit and scope of the present invention as defined by the appended claims. It should be understood that the various dependent claims and features described herein may be combined in a manner different from that described in the original claims. It should also be understood that the features described in conjunction with a single embodiment may be used in other described embodiments.
Claims
1. A multi-UUV formation reconstruction method for dynamic and complex tasks, characterized by: include: Establishing a formation model for the UUV cluster, wherein the formation model includes the number of rows of the UUV cluster and the row and column numbers of each node UUV; The leader UUV determines the current position matrix of the UUV cluster based on the position signal transmitted in real time by each node UUV, and identifies the crashed node UUV based on the row and column numbers of each node UUV when the current position matrix is different from the expected position matrix; The leader UUV determines the row number k where the crash occurred based on the row and column number of the crash node UUV; If the row number k where the crash occurred is less than the total number of rows K, according to the principle of prioritizing the back row to ensure the front row shape, starting from the k+1 row, the replacement distance of each adjustment plan is calculated according to the current position matrix in the selected row number; the adjustment plan with the smallest replacement distance is selected to control the corresponding node UUV to replace the crashed node UUV; if there are multiple adjustment plans with the same replacement distance, the adjustment plan involving the least number of node UUVs is selected to control the corresponding node UUV to replace the crashed node UUV; If the row number k where the crash occurs is equal to the total row number K, according to the principle of uniform distribution, multiple node UUVs in the Kth row are controlled to be evenly arranged according to the row boundaries of the expected position matrix.
2. The multi-UUV formation reconstruction method for dynamic complex tasks according to claim 1 is characterized in that: The adjustment scheme includes a combination scheme of selecting multiple node UUVs in the selected rows to sequentially fill in the crashed node UUV, and a scheme of selecting one node UUV in the selected rows to directly fill in the crashed node UUV.
3. The multi-UUV formation reconstruction method for dynamic complex tasks according to claim 1 is characterized in that: If there is only one node UUV in the Kth row at present, the node UUV is controlled to be on the longitudinal symmetry axis of the formation.
4. The multi-UUV formation reconstruction method for dynamic complex tasks according to claim 1 is characterized in that: The formation model includes a longitudinal model, a transverse model and a composite model.
5. The multi-UUV formation reconstruction method for dynamic complex tasks according to claim 1 is characterized in that: The selected number of rows includes row k+1 to row k+3.
6. The multi-UUV formation reconstruction method for dynamic complex tasks according to claim 1 is characterized in that: The replacement control of the node UUV is realized based on the kinematic model and dynamic model of the node UUV.
7. The multi-UUV formation reconstruction method for dynamic complex tasks according to claim 6 is characterized in that: The kinematic model of the node UUV is: Where (x, y, z) represents the three-dimensional center of gravity coordinates of the node UUV in the inertial coordinate system. represents the roll angle, pitch angle and bow angle of the node UUV in the inertial coordinate system; (u, v, w) represents the forward linear velocity, lateral linear velocity and heave linear velocity of the node UUV relative to the ocean current in the carrier coordinate system; (p, q, r) is the angular velocity of rotation of the three coordinate axes in the carrier coordinate system.
8. The multi-UUV formation reconstruction method for dynamic complex tasks according to claim 7 is characterized in that: The dynamic model of the node UUV is: Where M is the generalized mass matrix of the node UUV: Among them, M RB is the mass and inertia matrix, M A is the additional mass matrix, is the set of real numbers; C(V) is the Coriolis centripetal force matrix: Among them C A (V) is the hydrodynamic centripetal force matrix, C RB (V) is the rigid body centripetal force matrix; D(V) is the nonlinear hydrodynamic damping matrix, g(η) is the restoring force matrix, τ is the control matrix of node UUV: Where F is the thrust, δ s is the horizontal rudder angle, δ r is the vertical rudder angle; τ e For environmental interference,
Citation Information
Patent Citations
Underwater unmanned cluster formation key node identification method based on swarm intelligence
CN115047892A
UUV adaptive fault-tolerant cluster coordination control method considering actuator faults
CN116107216A
Intelligent reconstruction method for unmanned aerial vehicle formation
CN116185066A
Formation reconstruction control method for unmanned ship formation escorting task
CN116859736A
Multi-UUV formation control method based on prediction compensation mechanism
CN117991813A
Cited By
UUV formation reconstruction method considering path cross influence
CN119739163A
