Underwater robot cooperative surrounding target control method

By directly or indirectly observing targets and other robots using underwater robots, and calculating driving torque and driving force, cooperative target encirclement control under conditions of no communication is achieved, solving the cooperative encirclement problem caused by reduced communication quality, and realizing trajectory and velocity convergence.

CN118938970APending Publication Date: 2024-11-12XIAMEN UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410997661.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-24
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

Existing underwater robots struggle to effectively achieve coordinated target encirclement control due to reduced communication quality, resulting in data packet loss and delays.

Method used

A cooperative target encirclement control method using underwater robots is adopted. By having each underwater robot directly or indirectly observe the target and other robots, the driving torque and driving force are calculated to achieve cooperative encirclement without communication.

Benefits of technology

Without relying on communication, the underwater robots can work together to surround a fixed target, and the trajectory and velocity eventually converge to the expected value, while the position tracking error and separation angle error converge to zero.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938970A_ABST
    Figure CN118938970A_ABST
Patent Text Reader

Abstract

The invention discloses a control method for an underwater robot to cooperatively surround a target, which does not depend on any communication among an underwater robot group, and each underwater robot calculates a driving torque and a driving force only according to relative state information of the underwater robot and a neighbor underwater robot and / or a distance between the underwater robot and the target measured under a coordinate system of the underwater robot. Therefore, the control purposes that the multiple underwater robots rotate around the circle with the fixed target as the circle center and the set radius as the radius at the same set angular speed and a set separation angle is formed between any two robots are achieved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of cooperation among underwater robots without communication, and in particular to a method for controlling a cooperative target encirclement by underwater robots. Background Art

[0002] With the rapid development of marine energy engineering, underwater robots have been widely used due to their flexibility, cost and energy saving, and improved system reliability. The motion control of underwater robots is challenging due to environmental interference, underactuation problems, and system coupling. Therefore, further research on the dynamic characteristics and encirclement control methods of underwater robot motion systems is of great practical significance for improving the performance of underwater missions.

[0003] In order to solve the problem of cooperative encirclement of underwater robots, some researchers have developed controllers based on all-to-all communication and local communication to solve this problem. However, the application premise of these control methods is to accurately obtain the internal information of neighboring underwater robots through communication equipment. In the actual underwater environment, the communication quality will decrease with the increase of distance. When the underwater robots are far apart, data packet loss and communication delay may occur, making it impossible to effectively achieve cooperative encirclement of the target. Summary of the invention

[0004] The purpose of this application is to overcome the above-mentioned defects or problems existing in the background technology and to provide a method for controlling an underwater robot to cooperatively surround a target, which does not rely on communication between underwater robots or between underwater robots and the target, and can achieve cooperative encirclement of fixed targets.

[0005] In order to achieve the above purpose, the following technical solutions are adopted:

[0006] A method for controlling an underwater robot to cooperatively surround a target, which is used to rotate around a circle with a fixed target as the center and a set radius at the same set angular velocity and form a set separation angle between any two robots under the premise that a first condition and a second condition are met; the first condition is that at least one underwater robot among the underwater robots can be directly observed or indirectly observed by all other underwater robots; the second condition is that the target can be directly observed or indirectly observed by all underwater robots; each of the underwater robots can identify and directly observe the target and / or can identify and directly observe at least one other underwater robot, and when the underwater robot can directly observe the target, the underwater robot can measure the distance to the target; when the underwater robot can directly observe other underwater robots, the underwater robot can measure the distance and relative heading angle between it and the other underwater robots; the underwater robot can also measure its own linear velocity and angular velocity; the control method includes each underwater robot measuring the data that it can measure at every set period and calculating the driving force and driving torque according to the data; each underwater robot drives the underwater robot to move according to the calculated driving torque and driving force; wherein the driving torque and driving force are calculated by the following formula:

[0007]

[0008] In the above formula,

[0009] Γ i (t) is the driving torque applied to the i-th underwater robot at time t;

[0010] F i (t) is the driving force applied to the i-th underwater robot at time t;

[0011]

[0012] is the first inertial hydrodynamic coefficient;

[0013] v i (t) is the linear velocity measured by the i-th underwater robot at time t;

[0014] ω i (t) is the angular velocity measured by the i-th underwater robot at time t;

[0015]

[0016] is the moment of inertia of the i-th underwater robot;

[0017] is the second inertial hydrodynamic coefficient;

[0018] k Γ is an adjustable parameter, and its value range is kΓ>0;

[0019] Z ωi (t) = ω i (t)-ω id (t);

[0020] ω id (t) = ω c +k ω tanhθ ei (t);

[0021] ω c is the angular velocity of each underwater robot expected to orbit the target;

[0022] k ω It is an adjustable parameter, and its value range is 0 <k ω <||PS+S T P|| -1 ;

[0023]

[0024] k v is an adjustable parameter, and its value range is k v >0;

[0025] S T Transposed from S;

[0026]

[0027]

[0028] j is the serial number of the jth underwater robot;

[0029] C i is the set of other underwater robots that the i-th underwater robot can directly observe;

[0030] θ ji (t) is the relative heading angle between the i-th underwater robot and the j-th underwater robot measured at time t; ψ ji is the preset separation angle between the i-th underwater robot and the j-th underwater robot;

[0031] By id (t) = ω c +k ω tanhθ ei (t) is differentiated to obtain;

[0032]

[0033] is the third inertial hydrodynamic coefficient;

[0034]

[0035] m i is the mass of the i-th underwater robot;

[0036] is the fourth inertial hydrodynamic coefficient;

[0037] k F is an adjustable positive parameter, and its value range is

[0038] v is an adjustable parameter, and its value range is 0 <v<σ / (16k v 2 ||P|| 2 +4σ 2 ε);

[0039] m is an adjustable parameter, and its value range is m>0;

[0040]

[0041] σ=(1-k ω ||PS+S T P||);

[0042] ε is an adjustable parameter, and its value range is 0<ε<1;

[0043] Z vi (t) = v i (t)-v id (t);

[0044] v i (t) is the linear velocity of the i-th underwater robot at time t;

[0045]

[0046] r c The set radius of the circle that the underwater robot surrounds the target;

[0047] is the time t Integrate to obtain;

[0048]

[0049] The value obtained and stored in the previous calculation The starting time is any value;

[0050]

[0051] μ is an adjustable parameter, and its value range is 0<μ<1;

[0052]

[0053] p ei (t) = P ci (t)-r c

[01] T ;

[0054] P ci (t) is the distance between the i-th underwater robot and the target at time t;

[0055]

[0056] θ ij (t) = -θ ji (t);

[0057] R c =[0r c ] T ;

[0058] pji(t) is the distance between the i-th underwater robot and the j-th underwater robot measured at time t;

[0059] Depend on Transposed;

[0060] By Differentiate to get .

[0061] Compared with the prior art, the above solution has the following beneficial effects:

[0062] In the above technical solution, the driving torque and driving force can be calculated without using data other than the measured values, so there is no need for communication between the underwater robots or between the underwater robots and the target to achieve coordinated encirclement of the fixed target. BRIEF DESCRIPTION OF THE DRAWINGS

[0063] In order to more clearly illustrate the technical solution of the embodiment, the following briefly introduces the drawings required for use:

[0064] Figure 1 Schematic diagram of objects that can be directly observed by each underwater robot in the embodiment;

[0065] Figure 2 is the motion trajectory of each underwater robot in the embodiment;

[0066] Figure 3 is the angular velocity variation curve of each underwater robot in the embodiment;

[0067] Figure 4 is the linear velocity variation curve of each underwater robot in the embodiment;

[0068] Figure 5 is a curve showing a change in the observer tracking error of each underwater robot in the embodiments;

[0069] Figure 6 is a position tracking error variation curve of each underwater robot in the embodiment;

[0070] Figure 7 : is the separation angle tracking error variation curve of each underwater robot in the embodiment. DETAILED DESCRIPTION

[0071] In the claims and the description, unless otherwise defined, the terms "first", "second" or "third", etc. are intended to distinguish different objects rather than to describe a specific order.

[0072] In the claims and the description, unless otherwise defined, the terms "includes", "has" and their variations mean "including but not limited to".

[0073] The technical solutions in the embodiments will be described clearly and completely below in conjunction with the accompanying drawings.

[0074] Example

[0075] The embodiment includes 6 underwater robots and a fixed target. Of course, in other embodiments, the number of underwater robots can be any natural number greater than two. Each underwater robot includes a measurement module, a calculation module, a control module and a drive module.

[0076] The measuring module is used to measure its own linear velocity and angular velocity at set intervals, and is also used to identify and directly observe the target and / or identify and directly observe at least one other underwater robot. When the target can be directly observed, the measuring module can measure the distance to the target at set intervals; when other underwater robots can be directly observed, the measuring module can measure the distance and relative heading angle to the other underwater robots at set intervals. The calculation module is used to calculate the driving torque value and the driving force value according to the data measured by the measuring module at set intervals, and store some intermediate values. The control module controls the driving module to drive the underwater robot to move according to the driving torque value and the driving force value calculated by the calculation module.

[0077] like Figure 1As shown, among the six underwater robots of this embodiment, the measurement module of the first underwater robot AUV1 can directly observe the target Target, the measurement module of the second underwater robot AUV2 can directly observe the first underwater robot AUV1 and the fourth underwater robot AUV4, the measurement module of the third underwater robot AUV3 can directly observe the second underwater robot AUV2 and the fifth underwater robot AUV5, the measurement module of the fourth underwater robot AUV4 can directly observe the first underwater robot AUV1, the measurement module of the fifth underwater robot can directly observe the second underwater robot AUV2, and the measurement module of the sixth underwater robot AUV6 can directly observe the third underwater robot AUV3.

[0078] In this embodiment, each underwater robot achieves the purpose of cooperatively surrounding the target through a control method without communicating with each other and with the target. Specifically, the control method is used to make multiple underwater robots rotate around a circle with a fixed target as the center and a set radius at the same set angular velocity and form a set separation angle between any two robots under the premise that the first condition and the second condition are met; the first condition is that at least one underwater robot among each underwater robot can be directly observed or indirectly observed by all other underwater robots; the second condition is that the target can be directly observed or indirectly observed by all underwater robots. Among them, "indirect observation" means that any other underwater robot that can be directly observed by a certain underwater robot can directly or indirectly observe a certain object. For example, in this embodiment, the measurement module of the sixth underwater robot AUV6 can directly observe the third underwater robot AUV3, the measurement module of the third underwater robot AUV3 can directly observe the second underwater robot AUV2, and the measurement module of the second underwater robot AUV2 can directly observe the first underwater robot AUV1, then the measurement module of the sixth underwater robot AUV6 can indirectly observe the first underwater robot AUV1. Similarly, the measurement module of the first underwater robot AUV1 can directly observe the target Target, and the measurement module of the sixth underwater robot AUV6 can indirectly observe the target Target.

[0079] The underwater robot cooperative surrounding target control method of this embodiment includes that the measurement module of each underwater robot measures the data that it can measure every set period, the calculation module of the underwater robot calculates the driving force and driving torque according to the measured value and the stored value; the control module of the underwater robot controls the driving module to drive the underwater robot to move according to the calculated driving torque and driving force. In the calculation module, the driving torque and driving force are calculated by the following formula:

[0080]

[0081] In the above formula,

[0082] Γ i (t) is the driving torque applied to the i-th underwater robot at time t;

[0083] F i (t) is the driving force applied to the i-th underwater robot at time t;

[0084]

[0085] is the first inertial hydrodynamic coefficient, and in this embodiment its value is -1427N·m·s 2 ;

[0086] v i (t) is the linear velocity measured by the i-th underwater robot at time t;

[0087] ω i (t) is the angular velocity measured by the i-th underwater robot at time t;

[0088]

[0089] is the moment of inertia of the ith underwater robot, which is 2000 N·m·s in this embodiment. 2 ;

[0090] is the second inertial hydrodynamic coefficient, and in this embodiment its value is -1329N·m·s 2 ;

[0091] k Γ is an adjustable parameter, and its value range is k Γ >0, in this embodiment, its value is 0.8;

[0092] Z ωi (t) = ω i (t)-ω id (t);

[0093] ω id (t) = ω c +k ω tanhθ ei (t);

[0094] ω c is the angular velocity of each underwater robot expected to orbit the target, which is 0.5 rad / s in this embodiment;

[0095] k ω It is an adjustable parameter, and its value range is 0 <k ω <||PS+S T P||-1 , in this embodiment, its value is 0.28;

[0096]

[0097] k v is an adjustable parameter, and its value range is k v >0, in this embodiment, its value is 0.92;

[0098] S T Transposed from S;

[0099]

[0100] j is the serial number of the jth underwater robot;

[0101] C i is the set of other underwater robots that the i-th underwater robot can directly observe;

[0102] θ ji (t) is the relative heading angle between the i-th underwater robot and the j-th underwater robot measured at time t;

[0103] ψ ji is the preset separation angle between the i-th underwater robot and the j-th underwater robot, ψ ji =ψ j -ψ i ,

[0104] In this embodiment, ψ1=0, ψ4=π,

[0105] By id (t) = ω c +k ω tanhθ ei (t) is differentiated to obtain;

[0106]

[0107] is the third inertial hydrodynamic coefficient, and its value in this embodiment is -35kg / m;

[0108]

[0109] m i is the mass of the i-th underwater robot, which is 2234 kg in this embodiment;

[0110] is the fourth inertial hydrodynamic coefficient, and its value in this embodiment is -142kg;

[0111] k F is an adjustable positive parameter, and its value range is In this embodiment, its value is 1.2;

[0112] v is an adjustable parameter, and its value range is 0 <v<σ / (16k v 2 ||P|| 2 +4a 2 ε), in this embodiment, its value is 0.006;

[0113] m is an adjustable parameter, and its value range is m>0. In this embodiment, its value is 2;

[0114]

[0115] σ=(1-k ω ||PS+S T P||);

[0116] ε is an adjustable parameter, and its value range is 0<ε<1. In this embodiment, its value is 0.5;

[0117] Z vi (t) = v i (t)-v id (t);

[0118] v i (t) is the linear velocity of the i-th underwater robot at time t;

[0119]

[0120] r c is the set radius of the circle that the underwater robot surrounds the target, and its value in this embodiment is 5m;

[0121] is the time t Integrate to obtain;

[0122]

[0123] The value obtained and stored in the previous calculation The starting time is any value;

[0124]

[0125] μ is an adjustable parameter, and its value range is 0<μ<1. In this embodiment, its value is 0.09;

[0126]

[0127] p ei (t) = P ci (t)-r c

[01] T ;

[0128] P ci (t) is the distance between the i-th underwater robot and the target at time t;

[0129]

[0130] θ ij (t) = -θ ji (t);

[0131] R c =[0r c ] T ;

[0132] p ji (t) is the distance between the i-th underwater robot and the j-th underwater robot measured at time t;

[0133] Depend on Transposed;

[0134] By Differentiate to get .

[0135] The experimental results obtained by using Matlab software to simulate the control method in this embodiment are shown in Figures 2 to 7 .like Figure 2 As shown in , the trajectory of each underwater robot eventually converges to the desired circular trajectory and moves around the circle with the target as the center. Figure 3 and Figure 4 As shown in , the linear velocity and angular velocity of each underwater robot finally converge to the desired velocity value. Figure 5 As shown in the figure, the estimated position tracking error of each underwater robot Can converge to the actual position tracking error p ei (t). Figure 6 As shown, the position tracking error of each underwater robot ||p ei (t)|| eventually converges to 0. Figure 7 As shown, the separation angle tracking error of each underwater robot finally converges to 0. It can be seen that in this embodiment, when the underwater robots do not communicate with each other and do not communicate with the target, they can achieve the purpose of collaboratively surrounding the fixed target through the above control method under the premise of satisfying the first condition and the second condition.

[0136] The above specification and description of the embodiments are used to explain the protection scope of the present application, but do not constitute a limitation on the protection scope of the present application.

Claims

1. A method for controlling an underwater robot to cooperatively surround a target. Its characteristics are: It is used to make multiple underwater robots rotate around a circle with a fixed target as the center and a set radius at the same set angular speed and form a set separation angle between any two robots under the premise that the first condition and the second condition are met; the first condition is that at least one underwater robot among the underwater robots can be directly observed or indirectly observed by all other underwater robots; the second condition is that the target can be directly observed or indirectly observed by all underwater robots; Each of the underwater robots is capable of identifying and directly observing a target and / or is capable of identifying and directly observing at least one other underwater robot. When the underwater robot is capable of directly observing a target, the underwater robot is capable of measuring the distance to the target; when the underwater robot is capable of directly observing other underwater robots, the underwater robot is capable of measuring the distance and relative heading angle between the underwater robot and the other underwater robots; the underwater robot is also capable of measuring its own linear velocity and angular velocity; The control method comprises that each underwater robot measures the data that can be measured at every set period and calculates the driving force and the driving torque according to the data; each underwater robot drives the underwater robot to move according to the calculated driving torque and driving force; wherein the driving torque and the driving force are calculated by the following formula: In the above formula, Γ i (t) is the driving torque applied to the i-th underwater robot at time t; F i (t) is the driving force applied to the i-th underwater robot at time t; is the first inertial hydrodynamic coefficient; v i () is the linear velocity measured by the i-th underwater robot at time t; ω i () is the angular velocity measured by the i-th underwater robot at time t; is the moment of inertia of the i-th underwater robot; is the second inertial hydrodynamic coefficient; k Γ is an adjustable parameter, and its value range is k Γ >0; ω id (t)= c + ω tanhθ ei (t); ω c is the angular velocity of each underwater robot expected to orbit the target; k ω It is an adjustable parameter, and its value range is 0< ω <∥PS+S T P∥ -1 ; k v is an adjustable parameter, and its value range is k v >0; S T Transposed from S; j is the serial number of the jth underwater robot; C i is the set of other underwater robots that the i-th underwater robot can directly observe; θ ji (t) is the relative heading angle between the i-th underwater robot and the j-th underwater robot measured at time t; ψ ji is the preset separation angle between the i-th underwater robot and the j-th underwater robot; By id (t)= c + ω tanhθ ei (t) is differentiated to obtain; is the third inertial hydrodynamic coefficient; m i is the mass of the i-th underwater robot; is the fourth inertial hydrodynamic coefficient; k F is an adjustable positive parameter, and its value range is v is an adjustable parameter, and its value range is 0 <v<σ / (16 v 2 ∥P∥ 2 +4σ 2 ε); m is an adjustable parameter, and its value range is m>0; σ=(1-k ω ∥PS+S T P∥); ε is an adjustable parameter, and its value range is 0<ε<1; z vi (t)= i (t)- id (t); v i (t) is the linear velocity of the i-th underwater robot at time t; r c The set radius of the circle that the underwater robot surrounds the target; is the time t Integrate to obtain; The value obtained and stored in the previous calculation The starting time is any value; μ is an adjustable parameter, and its value range is 0< <1; p ei (t)= ci (t)- c [0 1] T ; P ci (t) is the distance between the i-th underwater robot and the target at time t; i ij (t)=-θ ji (t); R c =[0 c ] T ; p ji (t) is the distance between the i-th underwater robot and the j-th underwater robot measured at time t; Depend on Transposed; By Differentiate to get .