Underwater propeller driving signal detection method capable of improving stability

By introducing a weight matrix into the underwater propulsion system to handle the thruster failure and generate a safe and reliable driving signal, the problems of stability and reliability of the underwater propulsion system in complex environments are solved, and the control accuracy and robustness are improved.

CN118964812AInactive Publication Date: 2024-11-15BEI JING SHI HANG HUA YUAN KE JI YOU XIAN GONG SI +1

Patent Information

Application Number
CN202411062259.9
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-05
Publication Date
2024-11-15
Estimated Expiration
Not applicable · inactive patent

AI Technical Summary

Technical Problem

In complex underwater environments, the stable operation of the underwater propulsion system is affected by thruster failure and signal transmission errors, resulting in limited control performance and it is difficult to ensure the stable and reliable operation of the underwater robot.

Method used

By introducing a weight matrix that reflects the state of the thruster, the driving signals generated by the current control strategy are reassigned to generate safe and reliable driving signals, considering the faults that may exist or have occurred in the thruster, and improving the stability and reliability of underwater propulsion drives. sex.

Benefits of technology

It effectively improves the stability and reliability of underwater propulsion drives, can respond to thruster failures and environmental changes in a timely manner, enhances the control accuracy and robustness of the system, and reduces control problems caused by signal transmission errors.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118964812A_ABST
    Figure CN118964812A_ABST
Patent Text Reader

Abstract

The invention belongs to the technical field of underwater robots, and provides an underwater thruster driving signal detection method capable of improving stability, the method is applied to an underwater propulsion system of an underwater robot, the underwater propulsion system comprises a plurality of thrusters, and the method comprises the following steps: obtaining an expected state of the underwater robot; acquiring system state information of the underwater propulsion system and thruster state information of each thruster; an initial input signal is further determined, a weight matrix is updated, and the weight matrix is used for revealing the propelling contribution of each propeller to the underwater propelling system; and based on the weight matrix and the initial input signal, generating a propulsion driving signal for driving an underwater propulsion system of the underwater robot. According to the scheme, the thruster state information of each thruster can be effectively considered to update the weight matrix and participate in distribution of the control quantity of the driving signals, so that the fault state of each thruster can be timely considered, and safe and reliable driving signals are generated to drive the thrusters.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the technical field of underwater robots, and in particular to a method for detecting a driving signal of an underwater propeller for improving stability. Background Art

[0002] As the core component of an underwater robot, the underwater propulsion system mainly provides the necessary thrust to ensure that the underwater robot can operate stably in the water according to the preset trajectory and speed. The underwater propulsion system is usually composed of multiple thrusters, each of which has the ability to independently control the thrust size and direction. By collaboratively adjusting the output of each thruster, the system can achieve all-round motion control of the underwater robot.

[0003] The generation of thrust mainly depends on the rotation of the propeller or the operation of the water pump, which generates a reaction force through interaction with the water flow, thereby pushing the underwater robot forward or changing direction. In order to achieve precise thrust control, the propulsion system consists of several key parts: a propulsion control unit, a thruster actuator, and a feedback system. The control unit is responsible for receiving instructions from the upper control system, and based on this, calculates the thrust and direction required for each thruster, and then transmits these instructions to the actuator; the actuator drives the propeller or water pump to generate the corresponding thrust according to the instructions; at the same time, the feedback system monitors the working status of the thruster and the motion status of the robot in real time, and feeds back the relevant information to the control unit for necessary adjustments and optimizations.

[0004] Given the complexity and dynamics of the underwater environment, efficient and stable control strategies are required for propulsion systems. Traditional PID control methods are widely used due to their simplicity and ease of use, but their performance may be limited in complex environments. Therefore, more advanced control algorithms such as adaptive control and sliding mode control have also been introduced to deal with nonlinearity, uncertainty, and dynamic changes, thereby improving the control accuracy and robustness of the propulsion system. The selection and application of these control strategies are intended to ensure that underwater robots can achieve stable and precise motion control in various tasks.

[0005] However, in a complex underwater environment, signal transmission error is an important factor affecting the control performance of the propulsion system, and underwater communication is limited by the complexity of the environment. Therefore, a control terminal (located on land) is usually used to control the target of the propulsion system (such as the state of movement, the destination of movement, etc.), and the underwater propulsion system generates a drive signal according to its own real-time state to achieve the target. In this way, it can be less restricted by the communication transmission error in the complex underwater environment, and the state feedback can be considered in time, so that it has the ability to better respond to emergencies.

[0006] The stable operation of the underwater propulsion system is an important guarantee for the underwater robot to achieve various goals. The underwater propulsion system usually includes multiple thrusters. In essence, even if some of the multiple thrusters fail, the underwater robot can still operate. However, thruster failure is caused by various factors and usually occurs suddenly, making it difficult to consider the original control instructions in the short period of thruster failure, thus causing hidden dangers in the operation of the underwater robot. Therefore, how to provide a more reliable control scheme for the underwater propulsion system to ensure the stable operation of the underwater robot is a technical problem that needs to be solved in this field. Summary of the invention

[0007] The purpose of the embodiments of the present application is to provide a method for detecting underwater thruster drive signals with improved stability, so as to redistribute the drive signals generated by the current control strategy by introducing a weight matrix that reflects the state of the thrusters. This allows timely consideration of possible or existing failures of each thruster, and generates safe and reliable drive signals to drive the thrusters, thereby effectively improving the stability and reliability of the underwater propulsion drive.

[0008] In order to achieve the above purpose, the embodiments of the present application are implemented in the following ways:

[0009] In a first aspect, an embodiment of the present application provides a method for detecting an underwater propeller drive signal with improved stability, which is applied to an underwater propulsion system of an underwater robot, wherein the underwater propulsion system includes multiple propellers, and the method includes: obtaining an expected state of the underwater robot; obtaining system state information of the underwater propulsion system and propeller state information of each propeller; based on the expected state of the underwater robot, the system state information of the underwater propulsion system and the propeller state information, determining an initial input signal and updating a weight matrix, wherein the weight matrix is ​​used to reveal the propulsion contribution of each propeller to the underwater propulsion system; based on the weight matrix and the initial input signal, generating a propulsion drive signal for driving the underwater propulsion system of the underwater robot.

[0010] In combination with the first aspect, in a first possible implementation of the first aspect, obtaining system status information of the underwater propulsion system and propeller status information of each propeller includes: obtaining dynamic state information of the underwater propulsion system, including parameters of the underwater robot in an inertial coordinate system and parameters in a propulsion system coordinate system, wherein the parameters in the inertial coordinate system are x, y, z are the x-coordinate, y-coordinate, and z-coordinate of the underwater robot in the inertial coordinate system. θ,μ are the rolling angles of the underwater robot in the inertial coordinate system. Pitch angle θ and yaw angle μ, parameters v = [abcαβγ] in the propulsion system coordinate system T ∈R 6×1, a, b, c are the linear velocity components of the underwater robot on each axis in the propulsion system coordinate system, α, β, γ are the angular velocity components of the underwater robot on each axis in the propulsion system coordinate system; the propeller status information of each propeller in the underwater propulsion system is obtained, and the status information of each propeller is faulty or not faulty, forming a propeller fault description matrix O, where O is a k×k order diagonal matrix, denoted as O=diag[o1,o2,...,o k ]∈R k×k , k is the number of thrusters in the underwater propulsion system.

[0011] In combination with the first possible implementation of the first aspect, in the second possible implementation of the first aspect, based on the expected state of the underwater robot, the system state information of the underwater propulsion system and the thruster state information, an initial input signal is determined, and the weight matrix is ​​updated, including: based on the dynamic state information of the underwater propulsion system, the dynamic equation and dynamic model of the underwater propulsion system are determined; based on the thruster fault description matrix O, the dynamic model and the dynamic equation, the real-time dynamic model is determined; based on the expected state of the underwater robot, the initial input signal is determined; based on the thruster fault description matrix O, the real-time dynamic model and the initial input signal, the weight matrix is ​​updated.

[0012] In combination with the second possible implementation of the first aspect, in a third possible implementation of the first aspect, determining a dynamic equation and a dynamic model of the underwater propulsion system based on the dynamic state information of the underwater propulsion system includes: determining a dynamic equation of the underwater propulsion system based on the dynamic state information of the underwater propulsion system:

[0013]

[0014] in, is the derivative of Φ(t), Φ(t) is the function of parameter Φ with respect to time t, J∈R 6×6 represents the rotation matrix, which is used to realize the conversion between the inertial coordinate system and the propulsion system coordinate system. v(t) is the function of the parameter v with respect to time t. Based on the dynamic state information of the underwater propulsion system, the dynamic model of the underwater propulsion system is determined:

[0015]

[0016] in, is the derivative of v(t), f = -M -1 [C+D],f∈R 6×6 is a system parameter matrix, M∈R 6×6 is the matrix reflecting mass and inertia, C∈R 6×6 is the Coriolis centripetal force matrix, D = M -1 d, D∈R6×1 is the matrix reflecting the system damping and external disturbance, d∈R 6×1 is an external disturbance, G∈R 6×1 is the matrix reflecting gravity, buoyancy and their torque, E∈R 6×k is the thruster configuration matrix, u(t)=[u1,u2,...,u k ] T ∈R k×1 , is the initial input signal.

[0017] In combination with the third possible implementation of the first aspect, in a fourth possible implementation of the first aspect, a real-time dynamic model is determined based on the thruster fault description matrix O, the dynamic model, and the dynamic equation, including:

[0018] Based on the thruster fault description matrix O=diag[o1,o2,...,o k ]∈R k×k , and the kinetic model And dynamic equations, the real-time dynamic model is determined as:

[0019]

[0020] in, Is and The spliced ​​12×1 matrix is It is a 12×12 matrix obtained by concatenating J and f with a square matrix of “0” elements. is a 12×1 matrix obtained by concatenating Φ(t) and v(t), By its internal matrix M -1 EO∈R 6×k The 12×k matrix is ​​concatenated with the 6×k matrix of “0” elements. It is a 12×6 matrix obtained by concatenating a 6×6 matrix of “0” elements and a 6×6 matrix of “1” elements.

[0021] In combination with the fourth possible implementation of the first aspect, in a fifth possible implementation of the first aspect, determining the initial input signal based on the expected state of the underwater robot includes:

[0022] Based on the expected state Φ d , calculate the state tracking quantity e(t):

[0023] e(t)=Φ-Φ d ,

[0024] Where e(t)∈R 6×1 is the state tracking quantity;

[0025] Substitute the state tracking quantity into the following formula to calculate the initial input signal:

[0026]

[0027] Where u is the initial input signal, i.e., u(t), j is the derivative of J, c1 and c2 are both sliding surface parameters, s is the sliding surface, and sign(s) is the sign function used to implement the switching logic of sliding mode control. is the gain control parameter, which is used to adjust the gain in the control law. ∈0 is a very small positive scalar. For the matrix D∈J 6×1 The upper bound estimate of the disturbance of the lth component in , and its adaptive law is:

[0028]

[0029] Among them, γ l is the adaptive gain, is the adaptive estimation error of the upper bound of the perturbation.

[0030] In combination with the fourth possible implementation of the first aspect, in a sixth possible implementation of the first aspect, based on the thruster fault description matrix O, the real-time dynamic model and the initial input signal, updating the weight matrix includes: obtaining an initial weight matrix W0=diag(w1,…,w k ), where W0 is a diagonal matrix; based on the initial weight matrix W0 and the initial input signal u, a cost function L is generated; the cost function L is minimized to obtain the optimal solution Q; based on the optimal solution Q and the initial weight matrix W0, an updated weight matrix W is determined.

[0031] In combination with the sixth possible implementation of the first aspect, in a seventh possible implementation of the first aspect, the cost function L is:

[0032]

[0033] Among them, L is the cost function, is a 12×1 matrix, x T is the transpose of x, Q∈R 12×12 is the optimal solution, u∈R k×1 is the initial input signal, u T is the transpose of u.

[0034] In combination with the seventh possible implementation of the first aspect, in an eighth possible implementation of the first aspect, based on the optimal solution Q and the initial weight matrix W0, an updated weight matrix W is determined, including:

[0035] Substitute the optimal solution Q into the following formula:

[0036] A T P+PA-PBW0 -1 B T P+Q=0,

[0037] in, P∈R 12×12 is the solution to the equation;

[0038] After solving P, combined with the initial weight matrix W0, the weight matrix is ​​updated using the following formula:

[0039] W=B T PB+W0,

[0040] Among them, W is the updated weight matrix.

[0041] In combination with the sixth possible implementation of the first aspect, in a ninth possible implementation of the first aspect, generating a propulsion drive signal based on a weight matrix and an initial input signal includes:

[0042] Substitute the updated weight matrix W and the initial input signal u into the following formula to calculate the propulsion drive signal u * :

[0043] u * =O -1 W T u,

[0044] Among them, u * ∈R k×1 To propel the drive signal.

[0045] Beneficial effects:

[0046] 1. This scheme obtains the desired state of the underwater robot, the system state information of the underwater propulsion system and the propeller state information of each propeller, and then determines the initial input signal based on the desired state of the underwater robot, the system state information of the underwater propulsion system and the propeller state information, and updates the weight matrix (revealing the propulsion contribution of each propeller to the underwater propulsion system); based on the weight matrix and the initial input signal, a propulsion drive signal is generated to drive the underwater propulsion system of the underwater robot. This scheme realizes the generation of the initial input signal by tracking the difference between the real-time state of the underwater robot and the desired state (converted by the target of the control terminal controlling the propulsion system), introduces a real-time weight matrix (which can be dynamically updated according to the propeller state information), can effectively consider the propeller state information of each propeller to update the weight matrix, participate in the distribution of the drive signal control amount, so that each propeller state (such as possible or existing faults) can be considered in time, and a safe and reliable drive signal can be generated to drive the propeller, effectively improving the stability and reliability of the underwater propulsion drive.

[0047] 2. Based on the dynamic state information of the underwater propulsion system, this scheme constructs the dynamic equation and dynamic model, considers the thruster state information to introduce the fault description matrix, completes the construction of the dynamic model, and can accurately describe the dynamic behavior of the underwater propulsion system, providing a solid foundation for the formulation of the control strategy. At the same time, the real-time feedback mechanism ensures that the underwater propulsion system can adjust the control parameters in time to cope with changes in the external environment and the occurrence of internal faults. At the same time, the real-time dynamic model constructed by this scheme provides a basis for the application of advanced control algorithms (such as sliding mode control, adaptive control, etc.), which can be combined with existing advanced control algorithms to improve the control accuracy and robustness of the system. Through real-time monitoring (the system state can be predicted), potential problems can be discovered in advance and corresponding measures can be taken, thereby further reducing the control problems caused by signal transmission errors or delays. In addition, the weight update mechanism designed in this scheme makes the system highly flexible and scalable. When the number of thrusters needs to be increased or decreased, it is only necessary to adjust the parameters in the thruster state description matrix and the weight matrix accordingly, without changing the overall control strategy, so that the control scheme can be modularized and the operation efficiency can be improved.

[0048] 3. This solution introduces a sliding mode control strategy and takes into account adaptive disturbance estimation. It has strong anti-interference ability against external disturbances and internal parameter changes, and can effectively deal with unknown disturbances that may occur during system operation, which helps to improve the overall performance and control accuracy of the system. The introduction of adaptive gain and gain control parameters provides additional degrees of freedom for gain adjustment in the control law, allowing the system to automatically adjust the control gain according to different situations, further enhancing the flexibility and adaptability of the system.

[0049] 4. The weight matrix update scheme designed in this scheme realizes the dynamic update of the weight matrix by introducing the minimization solution of the cost function and the matrix equation based on the dynamic characteristics of the system, which is conducive to the system to track the desired state more accurately and reduce unnecessary control inputs, thereby improving the overall performance of the system. The dynamic update mechanism of the weight matrix enables the system to automatically adjust the weights according to the current state and input signals, so as to better adapt to the complex underwater working environment and enhance the stability of the system. Compared with the weight matrix update scheme in the traditional control strategy (some schemes do not consider faults, or some schemes consider faults, but the weight update relies on simple changes to achieve a linearized weight matrix update), it has stronger adaptability and better control effect to complex environments and emergencies. In addition, the state error is also considered in the cost function. and control input (u TW0u), this design not only focuses on the tracking performance of the underwater propulsion system (i.e., minimizing the state error), but also pays attention to the energy consumption or smoothness of the control input (realized by the weight matrix W0). This balance consideration helps to optimize the economy and feasibility of the control strategy while ensuring system performance. By solving the equation to find the optimal solution Q and further solving the P matrix, this scheme is conducive to providing the optimal control strategy for the underwater propulsion system and improving system performance.

[0050] In order to make the above-mentioned objects, features and advantages of the present application more obvious and easy to understand, preferred embodiments are specifically cited below and described in detail with reference to the attached drawings. BRIEF DESCRIPTION OF THE DRAWINGS

[0051] In order to more clearly illustrate the technical solutions of the embodiments of the present application, the drawings required for use in the embodiments of the present application 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.

[0052] Figure 1 Schematic diagram of the propulsion drive framework of the underwater propulsion system in the underwater robot.

[0053] Figure 2 A flow chart of a method for detecting an underwater thruster drive signal with improved stability provided in an embodiment of the present application. DETAILED DESCRIPTION

[0054] The technical solutions in the embodiments of the present application will be described below in conjunction with the drawings in the embodiments of the present application.

[0055] First, see Figure 1 , Figure 1 Schematic diagram of the propulsion drive framework of the underwater propulsion system in the underwater robot.

[0056] In this embodiment, the control terminal (such as the land control console of the underwater robot, the intelligent terminal, etc.) controls the operating state of the underwater robot (such as which destination to go to, at what speed to travel, the state to be achieved, etc.), and the underwater propulsion system of the underwater robot is equipped with k thrusters. Based on the operating state to be achieved, the signal is converted into a driving signal to control the k thrusters (part or all), thereby comprehensively realizing the drive control of the underwater robot.

[0057] In order to facilitate the understanding of the present solution, the driving process of the underwater propulsion system of the underwater robot will be introduced in detail below through a detection method of an underwater propeller driving signal with improved stability.

[0058] See also Figure 2 , Figure 2 Flow chart of the underwater propeller drive signal detection method for improving stability provided in an embodiment of the present application. In this embodiment, the underwater propeller drive signal detection method for improving stability is applied to the underwater propulsion system of an underwater robot, and may include steps S10, S20, S30, and S40.

[0059] First, the underwater propulsion system may execute step S10.

[0060] Step S10: Obtain the desired state of the underwater robot.

[0061] In this embodiment, the control terminal can send a control target to the underwater robot to control the operating state of the underwater robot. The main control unit of the underwater robot can analyze the control target and convert it into the expected state of the underwater robot at each node (such as the position and posture of the underwater robot at each time node). Of course, the control terminal can also generate the expected state of the underwater robot based on the control target and the underwater environment parameters and send it to the underwater robot. The underwater robot obtains the expected state through analysis, which is not limited here.

[0062] After obtaining the desired state of the underwater robot, the underwater propulsion system may execute step S20.

[0063] Step S20: Obtaining system status information of the underwater propulsion system and thruster status information of each thruster.

[0064] In this embodiment, the underwater propulsion system can obtain the dynamic state information of the underwater propulsion system, including the parameters of the underwater robot in the inertial coordinate system and the parameters in the propulsion system coordinate system.

[0065] Parameters in the inertial coordinate system:

[0066]

[0067] Among them, x, y, z are the x-coordinate, y-coordinate, and z-coordinate of the underwater robot in the inertial coordinate system, respectively. θ,μ are the rolling angles of the underwater robot in the inertial coordinate system. The pitch angle θ and the yaw angle μ.

[0068] Parameters in the propulsion system coordinate system:

[0069] v=[abcαβγ] T ∈R 6×1 , (2)

[0070] Among them, a, b, c are the linear velocity components of the underwater robot on each axis in the propulsion system coordinate system, and α, β, γ are the angular velocity components of the underwater robot on each axis in the propulsion system coordinate system.

[0071] It should be noted that in this embodiment, the parameters Φ and v are shown in static form, and these parameters can be written as functions of time t, that is, dynamic forms, such as Φ(t), v(t), etc. Of course, the u and u(t) that will appear later are also like this, which are essentially different forms in different scenarios, and the parameters Φ and v obtained in real time are not written as functions of time t, but this should not be regarded as a limitation to the present application.

[0072] At the same time, the underwater propulsion system can also obtain the propeller status information of each propeller in the underwater propulsion system. The status information of each propeller is faulty or fault-free (or can also be expressed as the probability of fault occurrence), thereby forming a propeller fault description matrix O, where O is a k×k order diagonal matrix, recorded as:

[0073] O = diag[o1,o2,...,o k ]∈R k×k , (3)

[0074] Where k is the number of thrusters in the underwater propulsion system.

[0075] After obtaining the system status information of the underwater propulsion system and the thruster status information of each thruster, the underwater propulsion system may execute step S30.

[0076] Step S30: Based on the desired state of the underwater robot, the system state information of the underwater propulsion system and the thruster state information, an initial input signal is determined, and a weight matrix is ​​updated, wherein the weight matrix is ​​used to reveal the propulsion contribution of each thruster to the underwater propulsion system.

[0077] In this embodiment, the underwater propulsion system can determine the dynamic equation and dynamic model of the underwater propulsion system based on the dynamic state information of the underwater propulsion system.

[0078] Exemplarily, the underwater propulsion system may determine the dynamic equation of the underwater propulsion system based on the dynamic state information of the underwater propulsion system:

[0079]

[0080] in, is the derivative of Φ(t), Φ(t) is the function of parameter Φ with respect to time t; J∈R 6×6 Represents the rotation matrix, which is used to realize the conversion between the inertial coordinate system and the propulsion system coordinate system; v(t) is the function of parameter v with respect to time t.

[0081] And, the underwater propulsion system can determine the dynamic model of the underwater propulsion system based on the dynamic state information of the underwater propulsion system:

[0082]

[0083] in, is the derivative of v(t), f = -M -1 [C+D],f∈R 6×6 is a system parameter matrix, M∈R 6×6 is the matrix reflecting mass and inertia, C∈R 6×6 is the Coriolis centripetal force matrix, D = M -1 d, D∈R 6×1 is the matrix reflecting the system damping and external disturbance, d∈R 6×1 is an external disturbance, G∈R 6×1 is the matrix reflecting gravity, buoyancy and their torque, E∈R 6×k is the thruster configuration matrix, u(t)=[u1,u2,...,u k ] T ∈R k×1 , is the initial input signal (the value is to be determined at this time and needs to be calculated later).

[0084] After determining the dynamic equation and dynamic model of the underwater propulsion system, considering the fault information (fault description matrix O), the real-time dynamic model of the underwater propulsion system can be determined as:

[0085]

[0086] in, Is and The spliced ​​12×1 matrix is It is a 12×12 matrix obtained by concatenating J and f with a square matrix of “0” elements. is a 12×1 matrix obtained by concatenating Φ(t) and v(t), By its internal matrix M -1 EO∈R 6×k The 12×k matrix is ​​concatenated with the 6×k matrix of “0” elements. It is a 12×6 matrix obtained by concatenating a 6×6 matrix of “0” elements and a 6×6 matrix of “1” elements.

[0087] After determining the real-time dynamic model of the underwater propulsion system, the underwater propulsion system can further determine the initial input signal based on the desired state of the underwater robot. The key to determining the initial input signal lies in the current state, desired state and control law (i.e., control algorithm) of the system. Due to its excellent scalable structure, this solution can be combined with existing advanced control algorithms (such as sliding mode control) to achieve control, and the initial input signal is determined by this control law. The following is an example of using sliding mode control as the control law to calculate the initial input signal.

[0088] First, the underwater propulsion system can be based on the desired state Φ d , calculate the state tracking quantity e(t):

[0089] e(t)=Φ-Φ d , (7)

[0090] Where e(t)∈R 6×1 is the state tracking quantity.

[0091] Then construct the integral sliding surface:

[0092] s(t)=s1(t)+c1s2(t)+c2s3(t), (8)

[0093] in, c1 and c2 are both sliding surface parameters, and c1 and c2 are both greater than 0; s is the sliding surface, that is, s(t).

[0094] Then, substituting formula (7) into formula (8), we have:

[0095]

[0096] Deriving formula (9) and substituting formula (4) and formula (5) into it, we get:

[0097]

[0098] Based on this, the sliding mode control law can be obtained as follows:

[0099]

[0100] Among them, u is the initial input signal, that is, u(t), is the derivative of J, c1 and c2 are both sliding surface parameters, s is the sliding surface, sign(s) is the sign function, which is used to implement the switching logic of sliding mode control. is the gain control parameter, which is used to adjust the gain in the control law. ∈0 is a very small positive scalar. For the matrix D∈R 6×1 The upper bound estimate of the disturbance of the lth component in , and its adaptive law is:

[0101]

[0102] Among them, γ l is the adaptive gain, is the adaptive estimation error of the upper bound of the perturbation.

[0103] Then, substituting the state tracking quantity e(t) into formula (11) can calculate the initial input signal u, that is, u(t) = [u1,u2,...,u k ] T ∈R k×1 .

[0104] After the initial input signal is determined, the underwater propulsion system can update the weight matrix based on the thruster fault description matrix O, the real-time dynamic model and the initial input signal.

[0105] In this embodiment, the underwater propulsion system can obtain an initial weight matrix:

[0106] W0=diag(w1,…,w k ), (14)

[0107] Where W0 is a k×k diagonal matrix.

[0108] Then, based on the initial weight matrix W0 and the initial input signal u, the cost function L is generated:

[0109]

[0110] Among them, L is the cost function, is a 12×1 matrix, x T is the transpose of x, Q∈R 12×12 is the optimal solution, u∈R k×1 is the initial input signal, u T is the transpose of u.

[0111] By minimizing the cost function L, we get the optimal solution Q, and then substitute it into the following formula:

[0112] A T P+PA-PBW0 -1 B T P+Q=0, (16)

[0113] in, P∈R 12×12 Solve the equation.

[0114] After solving P, combined with the initial weight matrix W0, the weight matrix is ​​updated using the following formula:

[0115] W=BT PB+W0, (17)

[0116] Among them, W is the updated weight matrix.

[0117] After updating the weight matrix, the underwater propulsion system may execute step S40.

[0118] Step S40: Based on the weight matrix and the initial input signal, a propulsion drive signal is generated to drive the underwater propulsion system of the underwater robot.

[0119] In this embodiment, the underwater propulsion system can substitute the updated weight matrix W and the initial input signal u into the following formula to calculate the propulsion drive signal u: * :

[0120] u * =O -1 W T u,(18)

[0121] Among them, u * ∈R k×1 To propel the drive signal.

[0122] Thus, the generated underwater propulsion drive signal can take into account various real-time information such as the state of the underwater robot, the state of the thruster, whether a fault occurs, etc., can adapt well to the complex underwater environment, and can timely take into account the fault of the thruster in the underwater propulsion system (for example, if the thruster fails, the corresponding item is 0, and if the thruster is not faulty, the corresponding item is 1) or possible faults (for example, design a function about the failure rate, calculate the function value corresponding to the failure rate, and reflect it in the fault description matrix O, and the closer the failure rate of the thruster is to 0, the closer the value of the corresponding item in the fault description matrix O is to 1), thereby improving the stability and reliability of the underwater robot propulsion control.

[0123] In summary, the embodiment of the present application provides a detection method for underwater propeller drive signal with improved stability, by obtaining the desired state of the underwater robot, the system state information of the underwater propulsion system and the propeller state information of each propeller, and then based on the desired state of the underwater robot, the system state information of the underwater propulsion system and the propeller state information, determine the initial input signal, and update the weight matrix (revealing the propulsion contribution of each propeller to the underwater propulsion system); based on the weight matrix and the initial input signal, generate a propulsion drive signal for driving the underwater propulsion system of the underwater robot. This scheme realizes the generation of the initial input signal by tracking the difference between the real-time state of the underwater robot and the desired state (converted by the target of the control terminal controlling the propulsion system), introduces a real-time weight matrix (which can be dynamically updated according to the propeller state information), can effectively consider the propeller state information of each propeller to update the weight matrix, participate in the distribution of the drive signal control amount, so that each propeller state (such as possible or existing faults) can be considered in time, and a safe and reliable drive signal is generated to drive the propeller, effectively improving the stability and reliability of the underwater propulsion drive.

[0124] Based on the dynamic state information of the underwater propulsion system, this scheme constructs dynamic equations and dynamic models, considers the thruster state information to introduce the fault description matrix, completes the construction of the dynamic model, and can accurately describe the dynamic behavior of the underwater propulsion system, providing a solid foundation for the formulation of the control strategy. At the same time, the real-time feedback mechanism ensures that the underwater propulsion system can adjust the control parameters in time to cope with changes in the external environment and the occurrence of internal faults. At the same time, the real-time dynamic model constructed by this scheme provides a basis for the application of advanced control algorithms (such as sliding mode control, adaptive control, etc.), which can be combined with existing advanced control algorithms to improve the control accuracy and robustness of the system. Through real-time monitoring (the system state can be predicted), potential problems can be discovered in advance and corresponding measures can be taken, thereby further reducing the control problems caused by signal transmission errors or delays. In addition, the weight update mechanism designed in this scheme makes the system highly flexible and scalable. When the number of thrusters needs to be increased or decreased, it is only necessary to adjust the parameters in the thruster state description matrix and the weight matrix accordingly, without changing the overall control strategy, so that the control scheme can be modularized and the operation efficiency can be improved.

[0125] This solution introduces a sliding mode control strategy and takes into account adaptive disturbance estimation. It has strong anti-interference ability against external disturbances and internal parameter changes, and can effectively deal with unknown disturbances that may occur during system operation, which helps to improve the overall performance and control accuracy of the system. The introduction of adaptive gain and gain control parameters provides additional degrees of freedom for gain adjustment in the control law, allowing the system to automatically adjust the control gain according to different situations, further enhancing the flexibility and adaptability of the system.

[0126] The weight matrix update scheme designed in this scheme realizes the dynamic update of the weight matrix by introducing the minimization solution of the cost function and the matrix equation based on the dynamic characteristics of the system, which is beneficial for the system to track the desired state more accurately and reduce unnecessary control inputs, thereby improving the overall performance of the system. The dynamic update mechanism of the weight matrix enables the system to automatically adjust the weights according to the current state and input signals, so as to better adapt to the complex underwater working environment and enhance the stability of the system. Compared with the weight matrix update scheme in the traditional control strategy (some schemes do not consider faults, or some schemes consider faults, but the weight update relies on a simple change to achieve a partial linear weight matrix update), it has stronger adaptability and better control effect to complex environments and emergencies. In addition, the state error is also considered in the cost function. and control input (u T W0u), this design not only focuses on the tracking performance of the underwater propulsion system (i.e., minimizing the state error), but also pays attention to the energy consumption or smoothness of the control input (realized by the weight matrix W0). This balance consideration helps to optimize the economy and feasibility of the control strategy while ensuring system performance. By solving the equation to find the optimal solution Q and further solving the P matrix, this scheme is conducive to providing the optimal control strategy for the underwater propulsion system and improving system performance.

[0127] The above description is only an embodiment of the present application and is not intended to limit the protection scope of the present application. For those skilled in the art, the present application may have various modifications and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present application shall be included in the protection scope of the present application.

Claims

1. A method for detecting a driving signal of an underwater propeller with improved stability, characterized in that: An underwater propulsion system applied to an underwater robot, the underwater propulsion system comprising a plurality of propellers, the method comprising: Obtain the desired state of the underwater robot; Obtaining system status information of the underwater propulsion system and thruster status information of each thruster; Based on the desired state of the underwater robot, the system state information of the underwater propulsion system and the state information of the thrusters, an initial input signal is determined, and a weight matrix is ​​updated, wherein the weight matrix is ​​used to reveal the propulsion contribution of each thruster to the underwater propulsion system; Based on the weight matrix and the initial input signal, a propulsion drive signal is generated to drive the underwater propulsion system of the underwater robot.

2. The method for detecting the driving signal of an underwater propeller with improved stability according to claim 1, characterized in that: Obtain the system status information of the underwater propulsion system and the thruster status information of each thruster, including: Obtain the dynamic state information of the underwater propulsion system, including the parameters of the underwater robot in the inertial coordinate system and the parameters in the propulsion system coordinate system. x, y, z are the x-coordinate, y-coordinate, and z-coordinate of the underwater robot in the inertial coordinate system, respectively. They are the roll angles of the underwater robot in the inertial coordinate system. Pitch angle θ and yaw angle μ, parameters v in the propulsion system coordinate system = [abc α βγ] T ∈R 6×1 , a, b, c are the linear velocity components of the underwater robot on each axis in the propulsion system coordinate system, α, β, γ are the angular velocity components of the underwater robot on each axis in the propulsion system coordinate system; The propeller status information of each propeller in the underwater propulsion system is obtained. The status information of each propeller is faulty or not faulty, and a propeller fault description matrix O is formed, where O is a k×k order diagonal matrix, denoted as O=diag[o1, o2, ..., o k ]∈R k×k , k is the number of thrusters in the underwater propulsion system.

3. The method for detecting the driving signal of an underwater propeller with improved stability according to claim 2, characterized in that: Based on the desired state of the underwater robot, the system state information of the underwater propulsion system and the thruster state information, the initial input signal is determined and the weight matrix is ​​updated, including: Based on the dynamic state information of the underwater propulsion system, the dynamic equation and dynamic model of the underwater propulsion system are determined; Based on the thruster fault description matrix O, the dynamic model and the dynamic equations, a real-time dynamic model is determined; Based on the desired state of the underwater robot, an initial input signal is determined; The weight matrix is ​​updated based on the thruster fault description matrix O, the real-time dynamic model and the initial input signal.

4. The method for detecting the driving signal of an underwater propeller with improved stability according to claim 3, characterized in that: Based on the dynamic state information of the underwater propulsion system, the dynamic equation and dynamic model of the underwater propulsion system are determined, including: Based on the dynamic state information of the underwater propulsion system, the dynamic equation of the underwater propulsion system is determined: in, is the derivative of Φ(t), Φ(t) is the function of parameter Φ with respect to time t, J∈R 6 × 6 represents the rotation matrix, which is used to realize the transformation between the inertial coordinate system and the propulsion system coordinate system. v(t) is the function of the parameter v with respect to time t; Based on the dynamic state information of the underwater propulsion system, the dynamic model of the underwater propulsion system is determined: in, is the derivative of v(t), f = -M -1 [C+D],f∈R 6×6 is a system parameter matrix, M∈R 6×6 is the matrix reflecting mass and inertia, C∈R 6×6 is the Coriolis centripetal force matrix, D = M -1 d, D∈R 6×1 is the matrix reflecting the system damping and external disturbance, d∈R 6×1 is an external disturbance, G∈R 6 × 1 is the matrix reflecting gravity, buoyancy and their torque, E∈R 6 × k is the thruster configuration matrix, u(t)=[u1,u2,...,u k ] T ∈R k×1 , is the initial input signal.

5. The method for detecting the driving signal of an underwater propeller with improved stability according to claim 4, characterized in that: Based on the thruster fault description matrix O, the dynamic model and the dynamic equation, the real-time dynamic model is determined, including: Based on the thruster fault description matrix O = diag[o1, o2, ..., o k ]∈R k×k , and the kinetic model And dynamic equations, the real-time dynamic model is determined as: in, Is and The 12×1 matrix obtained by splicing is It is a 12×12 matrix obtained by concatenating J and f with a square matrix of "0" elements. is a 12×1 matrix obtained by concatenating Φ(t) and v(t), By its internal matrix M- 1 EO∈R 6 The 12×k matrix is ​​obtained by concatenating the ×k and 6×k "0" element matrices. It is a 12×6 matrix obtained by concatenating a 6×6 matrix of "0" elements and a 6×6 matrix of "1" elements.

6. The method for detecting the driving signal of an underwater propeller for improving stability according to claim 5, characterized in that: Based on the desired state of the underwater robot, the initial input signal is determined, including: Based on the expected state Φ d , calculate the state tracking quantity e(t): e(t)=Φ-Φ d , Where e(t)∈R 6×1 is the state tracking quantity; Substitute the state tracking quantity into the following formula to calculate the initial input signal: Among them, u is the initial input signal, that is, u(t), is the derivative of J, c1 and c2 are both sliding surface parameters, s is the sliding surface, sign(s) is the sign function, which is used to implement the switching logic of sliding mode control, θ is the gain control parameter, which is used to adjust the gain in the control law, ∈0 is a very small positive scalar, For the matrix D∈R 6 × 1 The upper bound estimate of the disturbance of the lth component in , and its adaptive law is: Where γl is the adaptive gain, is the adaptive estimation error of the upper bound of the perturbation.

7. The method for detecting the driving signal of an underwater propeller with improved stability according to claim 5, characterized in that: Based on the thruster fault description matrix O, the real-time dynamic model and the initial input signal, the weight matrix is ​​updated, including: Get the initial weight matrix W0=diag(w1,…,w k ), where W0 is a diagonal matrix; Generate a cost function L based on the initial weight matrix W0 and the initial input signal u; Minimize the cost function L and obtain the optimal solution Q; Based on the optimal solution Q and the initial weight matrix W0, the updated weight matrix W is determined.

8. The method for detecting the underwater propeller driving signal for improving stability according to claim 7, characterized in that: The cost function L is: Where L is the cost function, is a 12×1 matrix, x T is the transpose of x, Q∈R 12×12 is the optimal solution, u∈R k×1 is the initial input signal, u T is the transpose of u.

9. The method for detecting the underwater propeller driving signal for improving stability according to claim 8, characterized in that: Based on the optimal solution Q and the initial weight matrix W0, the updated weight matrix W is determined, including: Substitute the optimal solution Q into the following formula: A T P+PA-PBW0 -1 B T P+Q=0, in, P∈R 12×12 is the solution to the equation; After solving P, combined with the initial weight matrix W0, the weight matrix is ​​updated using the following formula: W=B T PB+W0, Among them, W is the updated weight matrix.

10. The method for detecting the driving signal of an underwater propeller for improving stability according to claim 7, characterized in that: Based on the weight matrix and the initial input signal, a propulsion drive signal is generated, including: Substitute the updated weight matrix W and the initial input signal u into the following formula to calculate the propulsion drive signal u * : u * =O -1 W T u, Among them, u * ∈R k×1 To propel the drive signal.

Citation Information

Patent Citations

  • Fault-tolerant control method and system for manned submersible and electronic equipment

    CN116663148A

  • Underwater robot cruise searching and grabbing method and system based on self-adaptive control

    CN117055586A

  • Motion control method, robot, and computer-readable storage medium

    US20230191600A1

Cited By

  • Auto-disturbance rejection control method and system for motion of underwater robot, medium and equipment

    CN121300208A

  • An underwater robot motion active disturbance rejection control method, system, medium and device

    CN121300208B