Mooring underwater docking platform attitude stabilization control method and system

By designing the outer layer robust attitude calming controller and the inner layer thruster speed sliding mode controller on the tied underwater docking platform, the attitude offset and docking stability problems are solved, and the attitude stability under external disturbances are achieved. The connection was successful.

CN118938973APending Publication Date: 2024-11-12SHANGHAI MARINE ELECTRONIC EQUIP RES INST (NO 726 RES INST OF CHINA STATE SHIPBUILDING CORP)
View PDF 0 Cites 0 Cited by

Patent Information

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

AI Technical Summary

Technical Problem

The posture of the tethered underwater docking platform is susceptible to currents, resulting in attitude deviation. It is difficult for the prior art to achieve stable docking under the bottom conditions of the seat, and there is a risk of docking failure and collision.

Method used

Design a multi-propulsion system including an outer robust attitude calming controller and an inner thruster speed sliding mode controller. By establishing kinematic and dynamic models, three-axis control torque is generated and distributed to the thruster, ensuring that the platform is in The posture is stable under external disturbances.

Benefits of technology

The attitude stability and docking success rate of the underwater docking platform are improved, the impact of changes in mechanical and electrical characteristics on the thruster operation is overcome, and the robustness and accuracy of thrust output are enhanced.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938973A_ABST
    Figure CN118938973A_ABST
Patent Text Reader

Abstract

The invention provides an attitude stabilization control method and system for a mooring underwater docking platform. The attitude stabilization control method comprises the following steps: establishing kinematics and dynamics models of the mooring underwater docking platform and a propeller arrangement matrix; establishing a rotating speed equation and a thrust equation of the thruster, and describing a relationship between the control voltage and the rotating speed of the thruster; setting expected attitude information, generating a three-axis control moment by a controller, and distributing the three-axis control moment to expected thrust of each propeller through an instruction distributor; obtaining an expected rotating speed value of the thruster according to a mathematical relationship between the rotating speed and thrust of the thruster; and controlling the mooring underwater docking platform to keep the posture stable under the condition of external disturbance. According to the method, an inner-layer closed-loop controller and an outer-layer closed-loop controller are designed, an attitude adaptive controller on the outer layer adopts a modeling-free design, a switching item composed of state quantities and an adaptive gain coefficient item are added, and the robustness of the controllers is ensured; the inner-layer controller overcomes the uncertain influence of motor performance changes, and the precision of output thrust of the thruster is guaranteed.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of attitude control methods for underwater platforms, and in particular to an attitude stabilization control method and system for a moored underwater docking platform. Background Art

[0002] With the exploration and development of the ocean by humans, autonomous unmanned underwater vehicles are increasingly being used in the fields of seabed topography detection, sea search and rescue, and marine environment data collection. However, due to the size limitation, the energy they can carry is very limited, and they cannot operate for a long time. Moreover, the data they collect can often only be obtained after the equipment floats to the surface or returns to the home port. Therefore, underwater docking platforms that provide docking, charging, and data transmission for underwater unmanned vehicles have emerged.

[0003] At present, most underwater docking platforms are bottom-mounted. The seabed geological environment has the following effects on underwater docking:

[0004] The undulating terrain of the bottom sea area makes it impossible for the underwater docking platform to ensure the horizontality of its bottom posture, which may affect the success rate of underwater docking.

[0005] In addition, the acoustic guidance of the underwater docking platform is also easily affected by the seabed geological environment near the seabed, and there is a risk of ineffective acoustic guidance.

[0006] Underwater docking is achieved under the condition of being seated on the bottom. If the docking fails, the unmanned vehicle is at risk of colliding with the seabed.

[0007] In order to solve the posture adjustment problem of the bottom-mounted underwater docking platform, invention patents CN104986305B and CN115384736A, based on the bottom-mounted docking platform, adjust the pitch and horizontal angles within a certain range by adding a telescopic or rotating mechanical structure to improve the success rate of underwater docking.

[0008] By using the method of seabed mooring, the docking platform is suspended and anchored in the sea. On the one hand, it can avoid the influence of seabed geology, and on the other hand, its operating depth can be flexibly adjusted according to needs. However, the attitude of the moored underwater docking platform (especially the bow angle and pitch angle) is easily affected by the ocean current and causes deviation. Therefore, it is very necessary to design an active attitude stabilization system control method for the moored underwater docking platform.

[0009] Therefore, it is necessary to propose a new technical solution to improve the above technical problems. Summary of the invention

[0010] In view of the defects in the prior art, the object of the present invention is to provide a method and system for attitude stabilization control of a moored underwater docking platform.

[0011] According to a method for controlling the attitude stabilization of a moored underwater docking platform provided by the present invention, the method comprises the following steps:

[0012] Step S1: establishing kinematic and dynamic models of the moored underwater docking platform, and establishing a thruster arrangement matrix according to the thruster arrangement;

[0013] Step S2: Establish a propeller speed equation to describe the relationship between the propeller control voltage and the speed, and establish a propeller thrust equation to describe the relationship between the propeller speed and the thrust;

[0014] Step S3: Set the desired attitude information and input it into the robust attitude stabilization controller. The controller generates the control torque of the three axes and distributes the three-axis control torque to the desired thrust of each thruster through the instruction distributor.

[0015] Step S4: according to the mathematical relationship between the propeller speed and the thrust, the desired speed value of the propeller is obtained, and the underlying propeller speed sliding mode controller is designed to output the control voltage to control the propeller to reach the desired speed;

[0016] Step S5: The multi-propulsion system outputs the target thrust under the control of the outer layer robust attitude stabilization controller and the inner layer thruster speed controller, and finally controls the attitude of the moored underwater docking platform to be stable in the presence of external disturbances, thereby completing the docking.

[0017] Preferably, in step S1:

[0018] The kinematic model of the underwater docking platform is as follows:

[0019]

[0020] Where η=(q0 q1 q2 q3) T =(q0 q v ) T is the unit quaternion, v = (pqr) T is the angular velocity of the underwater platform (rad / s), p, q, r are the angular velocities of rotation around the x-axis, y-axis and z-axis of the carrier coordinate system respectively; J(η) is the coordinate transformation matrix:

[0021]

[0022] Preferably, in step S2:

[0023] The propeller speed equation is expressed as:

[0024]

[0025] Where ω is the propeller speed, u s is the control voltage, va is the water velocity at the propeller inlet; n b is the propeller reduction ratio, k e is the motor back electromotive force, J is the comprehensive moment of inertia of all rotating parts, R is the phase resistance, B is the motor damping coefficient, ρ is the density of water, D is the propeller diameter, a1 and a2 are two coefficients that characterize the propeller torque characteristics;

[0026] The thrust equation of the propeller is expressed as:

[0027]

[0028] Among them, b1 and b2 are two parameters that characterize the propeller thrust characteristics.

[0029] Preferably, in step S3:

[0030] The robust attitude stabilization controller is designed as:

[0031]

[0032] Where K p =diag(k p1 ,k p2 ,k p3 ), K d =diag(k d1 ,k d2 ,k d3 ), k pi >0,k di >0,λ i >0,i=1,2,3, γ=v+μ(ε)ε,c>0, ε is the improved Rodrigues parameter, H(ε) is the transformation matrix, and the definition is The output control torque τ of the robust attitude stabilization controller is T The desired output thrust is distributed to each thruster according to the following relationship:

[0033]

[0034] in, For B T The generalized inverse of .

[0035] Preferably, in step S4:

[0036] The desired propeller speed is expressed as:

[0037]

[0038] Design the inner sliding mode controller:

[0039]

[0040] Among them, u i is the control voltage of each thruster, s i is the sliding mode function of the ith thruster: s i =δ(ω id -ω i ),ω id is the desired speed of the i-th propeller, ω i is the actual speed of the i-th propeller, λ1, λ2, and δ are all parameters of the sliding mode controller.

[0041] The present invention also provides a moored underwater docking platform attitude stabilization control system, the system comprising the following modules:

[0042] Module M1: Establish the kinematic and dynamic models of the moored underwater docking platform, and establish the thruster arrangement matrix according to the thruster arrangement;

[0043] Module M2: Establish the propeller speed equation to describe the relationship between the propeller control voltage and speed, and establish the propeller thrust equation to describe the relationship between the propeller speed and thrust;

[0044] Module M3: Set the desired attitude information and input it into the robust attitude stabilization controller. The controller generates the control torque of the three axes and distributes the three-axis control torque to the desired thrust of each thruster through the instruction distributor.

[0045] Module M4: According to the mathematical relationship between propeller speed and thrust, the desired speed value of the propeller is obtained, and the underlying propeller speed sliding mode controller is designed to output the control voltage to control the propeller to reach the desired speed;

[0046] Module M5: The multi-propulsion system outputs the target thrust under the control of the outer layer's robust attitude stabilization controller and the inner layer's thruster speed controller, and ultimately controls the attitude of the moored underwater docking platform to be stable in the presence of external disturbances and complete the docking.

[0047] Preferably, in the module M1:

[0048] The kinematic model of the underwater docking platform is as follows:

[0049]

[0050] Where η=(q0 q1 q2 q3) T =(q0 q v ) T is the unit quaternion, v = (pqr) Tis the angular velocity of the underwater platform (rad / s), p, q, r are the angular velocities of rotation around the x-axis, y-axis and z-axis of the carrier coordinate system respectively; J(η) is the coordinate transformation matrix:

[0051]

[0052] Preferably, in the module M2:

[0053] The propeller speed equation is expressed as:

[0054]

[0055] Where ω is the propeller speed, u s is the control voltage, v a is the water velocity at the propeller inlet; n b is the propeller reduction ratio, k e is the motor back electromotive force, J is the comprehensive moment of inertia of all rotating parts, R is the phase resistance, B is the motor damping coefficient, ρ is the density of water, D is the propeller diameter, a1 and a2 are two coefficients that characterize the propeller torque characteristics;

[0056] The thrust equation of the propeller is expressed as:

[0057]

[0058] Among them, b1 and b2 are two parameters that characterize the propeller thrust characteristics.

[0059] Preferably, in the module M3:

[0060] The robust attitude stabilization controller is designed as:

[0061]

[0062] Where K p =diag(k p1 ,k p2 ,k p3 ), K d =diag(k d1 ,k d2 ,k d3 ), k pi >0,k di >0,λ i >0,i=1,2,3, γ=v+μ(ε)ε,c>0, ε is the improved Rodrigues parameter, H(ε) is the transformation matrix; definition The output control torque τ of the robust attitude stabilization controller isT The desired output thrust is distributed to each thruster according to the following relationship:

[0063]

[0064] in, For B T The generalized inverse of .

[0065] Preferably, in the module M4:

[0066] The desired propeller speed is expressed as:

[0067]

[0068] Design the inner sliding mode controller:

[0069]

[0070] Among them, u i is the control voltage of each thruster, s i is the sliding mode function of the ith thruster: s i =δ(ω id -ω i ),ω id is the desired speed of the i-th propeller, ω i is the actual speed of the i-th propeller, λ1, λ2, and δ are all parameters of the sliding mode controller.

[0071] Compared with the prior art, the present invention has the following beneficial effects:

[0072] 1. The present invention designs two layers of closed-loop controllers, the outer layer of which is a model-free design. On the basis of the traditional PD controller, a switching term consisting of state quantities is added, and an adaptive gain coefficient term is introduced to ensure the robustness of the attitude stabilization controller under external disturbances.

[0073] 2. Aiming at the multi-propulsion system used on the underwater docking platform, the present invention has carried out mathematical modeling of the motor thruster and designed a speed closed-loop sliding mode controller, which has effectively improved the accuracy of the thrust output of the thruster and overcome the influence of changes in mechanical and electrical characteristics on the operation of the thruster. BRIEF DESCRIPTION OF THE DRAWINGS

[0074] Other features, objects and advantages of the present invention will become more apparent from the detailed description of non-limiting embodiments made with reference to the following drawings:

[0075] Figure 1 This is a schematic diagram of the attitude stabilization control principle of the moored underwater docking platform of the present invention;

[0076] Figure 2 This is a schematic diagram of the moored underwater docking platform of the present invention;

[0077] Figure 3 A top view of the moored underwater docking platform of the present invention;

[0078] Figure 4 It is a curve showing the change of Euler angle when the underwater mooring docking platform of the present invention has an initial posture deviation;

[0079] Figure 5 It is a Rodrigues parameter variation curve when the underwater mooring docking platform of the present invention has an initial posture deviation;

[0080] Figure 6 It is a propeller speed curve when the underwater moored docking platform of the present invention has an initial posture deviation;

[0081] Figure 7 It is a curve showing the change of Euler angles when the underwater mooring docking platform of the present invention is disturbed by the external environment;

[0082] Figure 8 It is a Rodrigues parameter variation curve when the underwater mooring docking platform of the present invention is subject to external environmental disturbance;

[0083] Fig. 9 This is a propeller speed curve when the underwater moored docking platform of the present invention is subject to external environmental disturbance.

[0084] in:

[0085] Docking bay 1 Horizontal thruster 4

[0086] Platform shell 2 bottom anchor 5

[0087] Vertical thruster 3 Cable 6 DETAILED DESCRIPTION

[0088] The present invention is described in detail below in conjunction with specific embodiments. The following embodiments will help those skilled in the art to further understand the present invention, but are not intended to limit the present invention in any form. It should be noted that, for those of ordinary skill in the art, several changes and improvements can also be made without departing from the concept of the present invention. These all belong to the protection scope of the present invention.

[0089] Embodiment 1:

[0090] Reference Figure 1 and Figure 2 According to a method for controlling the attitude stabilization of a moored underwater docking platform provided by the present invention, the method comprises the following steps:

[0091] Step S1: establishing kinematic and dynamic models of the moored underwater docking platform, and establishing a thruster arrangement matrix according to the thruster arrangement;

[0092] The kinematic model of the underwater docking platform is as follows:

[0093]

[0094] Where η=(q0 q1 q2 q3) T =(q0 q v ) T is the unit quaternion, v = (pqr) T is the angular velocity of the underwater platform (rad / s), p, q, r are the angular velocities of rotation around the x-axis, y-axis and z-axis of the carrier coordinate system respectively; J(η) is the coordinate transformation matrix:

[0095]

[0096] Step S2: Establish a propeller speed equation to describe the relationship between the propeller control voltage and the speed, and establish a propeller thrust equation to describe the relationship between the propeller speed and the thrust;

[0097] The propeller speed equation is expressed as:

[0098]

[0099] Where ω is the propeller speed, u s is the control voltage, v a is the water velocity at the propeller inlet; n b is the propeller reduction ratio, k e is the motor back electromotive force, J is the comprehensive moment of inertia of all rotating parts, R is the phase resistance, B is the motor damping coefficient, ρ is the density of water, D is the propeller diameter, a1 and a2 are two coefficients that characterize the propeller torque characteristics;

[0100] The thrust equation of the propeller is expressed as:

[0101]

[0102] Among them, b1 and b2 are two parameters that characterize the propeller thrust characteristics.

[0103] Step S3: Set the desired attitude information and input it into the robust attitude stabilization controller. The controller generates the control torque of the three axes and distributes the three-axis control torque to the desired thrust of each thruster through the instruction distributor.

[0104] The robust attitude stabilization controller is designed as:

[0105]

[0106] Where K p =diag(k p1 ,k p2 ,k p3 ), K d =diag(k d1 ,k d2 ,k d3 ), k pi >0,k di >0,λ i >0,i=1,2,3, γ=v+μ(ε)ε,c>0, ε is the improved Rodrigues parameter, H(ε) is the transformation matrix; definition The output control torque τ of the robust attitude stabilization controller is T The desired output thrust is distributed to each thruster according to the following relationship:

[0107]

[0108] in, For B T The generalized inverse of .

[0109] Step S4: according to the mathematical relationship between the propeller speed and the thrust, the desired speed value of the propeller is obtained, and the underlying propeller speed sliding mode controller is designed to output the control voltage to control the propeller to reach the desired speed;

[0110] The desired propeller speed is expressed as:

[0111]

[0112] Design the inner sliding mode controller:

[0113]

[0114] Among them, u i is the control voltage of each thruster, s i is the sliding mode function of the ith thruster: s i =δ(ω id -ω i ),ω id is the desired speed of the i-th propeller, ω i is the actual speed of the i-th propeller, λ1, λ2, and δ are all parameters of the sliding mode controller.

[0115] Step S5: The multi-propulsion system outputs the target thrust under the control of the outer layer robust attitude stabilization controller and the inner layer thruster speed controller, and finally controls the attitude of the moored underwater docking platform to be stable in the presence of external disturbances, thereby completing the docking.

[0116] The present invention also provides a tethered underwater docking platform attitude stabilization control system, which can be implemented by executing the process steps of the tethered underwater docking platform attitude stabilization control method, that is, those skilled in the art can understand the tethered underwater docking platform attitude stabilization control method as a preferred implementation of the tethered underwater docking platform attitude stabilization control system.

[0117] Embodiment 2:

[0118] The present invention also provides a moored underwater docking platform attitude stabilization control system, the system comprising the following modules:

[0119] Module M1: Establish the kinematic and dynamic models of the moored underwater docking platform, and establish the thruster arrangement matrix according to the thruster arrangement;

[0120] The kinematic model of the underwater docking platform is as follows:

[0121]

[0122] Where η=(q0 q1 q2 q3) T =(q0 q v ) T is the unit quaternion, v = (pqr) T is the angular velocity of the underwater platform (rad / s), p, q, r are the angular velocities of rotation around the x-axis, y-axis and z-axis of the carrier coordinate system respectively; J(η) is the coordinate transformation matrix:

[0123]

[0124] Module M2: Establish the propeller speed equation to describe the relationship between the propeller control voltage and speed, and establish the propeller thrust equation to describe the relationship between the propeller speed and thrust;

[0125] The propeller speed equation is expressed as:

[0126]

[0127] Where ω is the propeller speed, u s is the control voltage, v a is the water velocity at the propeller inlet; n bis the propeller reduction ratio, k e is the motor back electromotive force, J is the comprehensive moment of inertia of all rotating parts, R is the phase resistance, B is the motor damping coefficient, ρ is the density of water, D is the propeller diameter, a1 and a2 are two coefficients that characterize the propeller torque characteristics;

[0128] The thrust equation of the propeller is expressed as:

[0129]

[0130] Among them, b1 and b2 are two parameters that characterize the propeller thrust characteristics.

[0131] Module M3: Set the desired attitude information and input it into the robust attitude stabilization controller. The controller generates the control torque of the three axes and distributes the three-axis control torque to the desired thrust of each thruster through the instruction distributor.

[0132] The robust attitude stabilization controller is designed as:

[0133]

[0134] Where K p =diag(k p1 ,k p2 ,k p3 ), K d =diag(k d1 ,k d2 ,k d3 ), k pi >0,k di >0,λ i >0,i=1,2,3, γ=v+μ(ε)ε,c>0, ε is the improved Rodrigues parameter, H(ε) is the transformation matrix; definition The output control torque τ of the robust attitude stabilization controller is T The desired output thrust is distributed to each thruster according to the following relationship:

[0135]

[0136] in, For B T The generalized inverse of .

[0137] Module M4: According to the mathematical relationship between propeller speed and thrust, the desired speed value of the propeller is obtained, and the underlying propeller speed sliding mode controller is designed to output the control voltage to control the propeller to reach the desired speed;

[0138] The desired propeller speed is expressed as:

[0139]

[0140] Design the inner sliding mode controller:

[0141]

[0142] Among them, u i is the control voltage of each thruster, s i is the sliding mode function of the ith thruster: s i =δ(ω id -ω i ),ω id is the desired speed of the i-th propeller, ω i is the actual speed of the i-th propeller, λ1, λ2, and δ are all parameters of the sliding mode controller.

[0143] Module M5: The multi-propulsion system outputs the target thrust under the control of the outer layer's robust attitude stabilization controller and the inner layer's thruster speed controller, and ultimately controls the attitude of the moored underwater docking platform to be stable in the presence of external disturbances and complete the docking.

[0144] Embodiment 3:

[0145] The present invention provides a method for controlling the attitude stabilization of a moored underwater docking platform. The method designs an inner and outer two-layer closed-loop controller, wherein the outer controller has robustness to external fluid disturbances, and the inner controller overcomes the uncertain influence of changes in the power supply voltage, motor performance, etc. on the output thrust, thereby ensuring the accuracy of the thrust output by the thruster. The two-layer closed-loop controller effectively improves the robustness of the underwater moored docking platform under the influence of external interference and uncertainty of its own equipment.

[0146] In this embodiment, a method for controlling the attitude stabilization of a moored underwater docking platform is provided, comprising the following steps:

[0147] Step 1: Establish the kinematic and dynamic models of the moored underwater docking platform, and establish the thruster layout matrix according to the thruster layout.

[0148] The kinematic model of the underwater docking platform is as follows:

[0149]

[0150] Where η=(q0 q1 q2 q3) T =(q0 q v ) T is the unit quaternion, v = (pqr) Tis the angular velocity of the underwater platform (rad / s), p, q, r are the angular velocities of rotation around the x-axis, y-axis and z-axis of the carrier coordinate system respectively. J(η) is the coordinate transformation matrix:

[0151]

[0152] Let the expected unit quaternion be The error quaternion for Convert the equation of motion into error quaternion kinematic equations:

[0153]

[0154] The transformation matrix

[0155] In order to reduce the number of elements in the attitude information, the improved Rodrigues parameters are used to replace the unit quaternion, and the kinematic relationship is obtained:

[0156]

[0157] where ε=(ε1ε2ε3) T To improve the Rodrigues parameter, Transformation Matrix:

[0158]

[0159] The dynamic model of the underwater docking platform is as follows:

[0160]

[0161] Among them, M RB is the rigid body inertia matrix of the underwater platform, C RB is the Coriolis force-centrifugal force matrix of the rigid body.

[0162]

[0163] τ RB is the total external torque received by the underwater platform. During operation, the external torque received by the underwater platform can be divided into two categories: static torque and dynamic torque. Static torque is the torque generated by the underwater platform's own gravity and buoyancy in different postures; while dynamic torque is the torque from the water flow during the rotation of the underwater platform and the torque generated by multiple thrusters. Considering the above parts into the total external torque received by the underwater platform, τ RB It can be expressed as:

[0164]

[0165] in, is the inertia dynamic external torque, -D(v)v is the damping dynamic external torque, -g(η) is the static external torque, τ E is the sum of the disturbance torque of the water environment and the unbalanced torque of the mooring cable on the platform, τ T =(K MN) T is the resultant torque produced by the propulsion system.

[0166]

[0167] D(v) contains first-order damping terms and second-order damping terms:

[0168]

[0169] g(η) is the static moment generated by the center of gravity and the center of buoyancy of the platform, and its expression is:

[0170]

[0171] W is the total gravity of the underwater platform, B is the total buoyancy of the underwater platform in the water, (x g y g z g ) is the barycentric coordinate, (x b y b z b ) are the coordinates of the center of buoyancy.

[0172] The thruster layout matrix can be expressed as:

[0173]

[0174] Among them, L x is the vertical distance from thrusters ①-④ to the xoz plane, L y is the vertical distance from thrusters ①-④ to the yoz plane, L z It is the vertical distance from thrusters ⑤-⑧ to the xoz plane.

[0175] Step 2: Establish the propeller speed equation to describe the relationship between the propeller control voltage and the speed, and establish the propeller thrust equation to describe the relationship between the propeller speed and thrust.

[0176] The propeller speed equation driven by a three-phase brushless motor can be expressed as:

[0177]

[0178] Where ω is the propeller speed, u s is the control voltage, v a is the water velocity at the propeller inlet.

[0179] n b is the propeller reduction ratio, k e is the motor back electromotive force, J is the combined moment of inertia of all rotating parts, R is the phase resistance, B is the motor damping coefficient, ρ is the density of water, D is the propeller diameter, and a1 and a2 are two coefficients that characterize the propeller torque characteristics.

[0180] The thrust equation of the propeller can be expressed as:

[0181]

[0182] Among them, b1 and b2 are two parameters that characterize the propeller thrust characteristics.

[0183] Step 3: Set the desired attitude information and input it into the robust attitude stabilization controller. The controller generates the three-axis control torque and distributes the three-axis control torque to the desired thrust of each thruster through the instruction distributor.

[0184] The robust attitude stabilization controller is designed as:

[0185]

[0186] Where K p =diag(k p1 ,k p2 ,k p3 ),K d =diag(k d1 ,k d2 ,k d3 ),

[0187] k pi >0,k di >0,λ i >0,i=1,2,3.γ=v+μ(ε)ε,c>0,

[0188] definition

[0189] The output control torque τ of the robust attitude stabilization controller is T The desired output thrust is distributed to each thruster according to the following relationship:

[0190]

[0191] in, For B T The generalized inverse of .

[0192] It can be expressed as:

[0193]

[0194] Step 4: Based on the mathematical relationship between propeller speed and thrust, the desired propeller speed value is obtained, and the underlying propeller speed sliding mode controller is designed to output the control voltage to control the propeller to reach the desired speed.

[0195] In the bollard condition, the expected rotation speed of each thruster is expressed as:

[0196]

[0197] Design the inner sliding mode controller:

[0198]

[0199] Among them, u i is the control voltage of each thruster, s i is the sliding mode function of the ith thruster: s i =δ(ω id -ω i ),ω id is the desired speed of the i-th propeller, ω i is the actual speed of the i-th propeller, λ1, λ2, and δ are all parameters of the sliding mode controller.

[0200] Step 5: The multi-propulsion system outputs the target thrust under the control of the outer layer's robust attitude stabilization controller and the inner layer's thruster speed controller, ultimately controlling the attitude of the moored underwater docking platform to be stable in the presence of external disturbances to ensure smooth docking.

[0201] Figure 4-Figure 9 It was demonstrated that the underwater tethered docking platform can introduce an attitude stabilization control system under two working conditions (the presence of initial attitude deviation and the presence of external environmental disturbance), and can correct the attitude deviation or resist external disturbance to ensure smooth docking with the underwater vehicle.

[0202] Those skilled in the art may understand this embodiment as a more specific description of Embodiment 1 and Embodiment 2.

[0203] Those skilled in the art know that, in addition to realizing the system and its various devices, modules, and units provided by the present invention in a purely computer-readable program code, it is entirely possible to realize the same functions in the form of logic gates, switches, application-specific integrated circuits, programmable logic controllers, and embedded microcontrollers by logically programming the method steps. Therefore, the system and its various devices, modules, and units provided by the present invention can be considered as a hardware component, and the devices, modules, and units included therein for realizing various functions can also be regarded as structures within the hardware component; the devices, modules, and units for realizing various functions can also be regarded as both software modules for realizing the method and structures within the hardware component.

[0204] The above describes the specific embodiments of the present invention. It should be understood that the present invention is not limited to the above specific embodiments, and those skilled in the art can make various changes or modifications within the scope of the claims, which does not affect the essence of the present invention. In the absence of conflict, the embodiments of the present application and the features in the embodiments can be combined with each other arbitrarily.

Claims

1. A method for attitude stabilization control of a moored underwater docking platform. It is characterized in that The method comprises the following steps: Step S1: establishing kinematic and dynamic models of the moored underwater docking platform, and establishing a thruster arrangement matrix according to the thruster arrangement; Step S2: Establish a propeller speed equation to describe the relationship between the propeller control voltage and the speed, and establish a propeller thrust equation to describe the relationship between the propeller speed and the thrust; Step S3: Set the desired attitude information and input it into the robust attitude stabilization controller. The controller generates the control torque of the three axes and distributes the three-axis control torque to the desired thrust of each thruster through the instruction distributor. Step S4: according to the mathematical relationship between the propeller speed and the thrust, the desired speed value of the propeller is obtained, and the underlying propeller speed sliding mode controller is designed to output the control voltage to control the propeller to reach the desired speed; Step S5: The multi-propulsion system outputs the target thrust under the control of the outer layer robust attitude stabilization controller and the inner layer thruster speed controller, and finally controls the attitude of the moored underwater docking platform to be stable in the presence of external disturbances, thereby completing the docking.

2. The method for controlling the attitude stabilization of a moored underwater docking platform according to claim 1, It is characterized in that In step S1: The kinematic model of the underwater docking platform is as follows: Where η=(q 0 q 1 q 2 q 3 ) T =(q 0 q v ) T is the unit quaternion, v = (pqr) T is the angular velocity of the underwater platform (rad / s), p, q, r are the angular velocities of rotation around the x-axis, y-axis and z-axis of the carrier coordinate system respectively; J(η) is the coordinate transformation matrix:

3. The method for controlling the attitude stabilization of a moored underwater docking platform according to claim 1, It is characterized in that In step S2: The propeller speed equation is expressed as: Where ω is the propeller speed, u s is the control voltage, v a is the water velocity at the propeller inlet; n b is the propeller reduction ratio, k e is the motor back electromotive force, J is the combined moment of inertia of all rotating parts, R is the phase resistance, B is the motor damping coefficient, ρ is the density of water, D is the propeller diameter, and a 1 ,a 2 are two coefficients that characterize the propeller torque characteristics; The thrust equation of the propeller is expressed as: Among them, b 1 , b 2 These are two parameters that characterize the propeller thrust characteristics.

4. The method for controlling the attitude stabilization of a moored underwater docking platform according to claim 1, It is characterized in that In step S3: The robust attitude stabilization controller is designed as: Where K p =diag(k p1 ,k p2 ,k p3 ), K d =diag(k d1 ,k d2 ,k d3 ), k pi >0,k di >0,λ i >0,i=1,2,3, γ=v+μ(ε)ε,c>0, ε is the improved Rodrigues parameter, H(ε) is the transformation matrix; definition The output control torque τ of the robust attitude stabilization controller is T The desired output thrust is distributed to each thruster according to the following relationship: in, For B T The generalized inverse of .

5. The method for controlling the attitude stabilization of a moored underwater docking platform according to claim 1, It is characterized in that In step S4: The desired propeller speed is expressed as: Design the inner sliding mode controller: Among them, u i is the control voltage of each thruster, s i is the sliding mode function of the ith thruster: s i =δ(ω id -ω i ),ω id is the desired speed of the i-th propeller, ω i is the actual speed of the i-th propeller, λ 1 , 2 , δ are the parameters of sliding mode controller.

6. A tethered underwater docking platform attitude stabilization control system, It is characterized in that The system includes the following modules: Module M1: Establish the kinematic and dynamic models of the moored underwater docking platform, and establish the thruster arrangement matrix according to the thruster arrangement; Module M2: Establish the propeller speed equation to describe the relationship between the propeller control voltage and speed, and establish the propeller thrust equation to describe the relationship between the propeller speed and thrust; Module M3: Set the desired attitude information and input it into the robust attitude stabilization controller. The controller generates the control torque of the three axes and distributes the three-axis control torque to the desired thrust of each thruster through the instruction distributor. Module M4: According to the mathematical relationship between propeller speed and thrust, the desired speed value of the propeller is obtained, and the underlying propeller speed sliding mode controller is designed to output the control voltage to control the propeller to reach the desired speed; Module M5: The multi-propulsion system outputs the target thrust under the control of the outer layer's robust attitude stabilization controller and the inner layer's thruster speed controller, and ultimately controls the attitude of the moored underwater docking platform to be stable in the presence of external disturbances and complete the docking.

7. The attitude stabilization control system for a moored underwater docking platform according to claim 6, It is characterized in that In the module M1: The kinematic model of the underwater docking platform is as follows: Where η=(q 0 q 1 q 2 q 3 ) T =(q 0 q v ) T is the unit quaternion, v = (pqr) T is the angular velocity of the underwater platform (rad / s), p, q, r are the angular velocities of rotation around the x-axis, y-axis and z-axis of the carrier coordinate system respectively; J(η) is the coordinate transformation matrix:

8. The attitude stabilization control system for a moored underwater docking platform according to claim 6, It is characterized in that In the module M2: The propeller speed equation is expressed as: Where ω is the propeller speed, u s is the control voltage, v a is the water velocity at the propeller inlet; n b is the propeller reduction ratio, k e is the motor back electromotive force, J is the combined moment of inertia of all rotating parts, R is the phase resistance, B is the motor damping coefficient, ρ is the density of water, D is the propeller diameter, and a 1 ,a 2 are two coefficients that characterize the propeller torque characteristics; The thrust equation of the propeller is expressed as: Among them, b 1 , b 2 These are two parameters that characterize the propeller thrust characteristics.

9. The attitude stabilization control system for a moored underwater docking platform according to claim 6, It is characterized in that In the module M3: The robust attitude stabilization controller is designed as: Where K p =diag(k p1 ,k p2 ,k p3 ), K d =diag(k d1 ,k d2 ,k d3 ), k pi >0,k di >0,λ i >0,i=1,2,3, γ=v+μ(ε)ε,c>0, ε is the improved Rodrigues parameter, H(ε) is the transformation matrix, and the definition is The output control torque τ of the robust attitude stabilization controller is T The desired output thrust is distributed to each thruster according to the following relationship: in, For B T The generalized inverse of .

10. The attitude stabilization control system for a moored underwater docking platform according to claim 6, It is characterized in that In the module M4: The desired propeller speed is expressed as: Design the inner sliding mode controller: Among them, u i is the control voltage of each thruster, s i is the sliding mode function of the ith thruster: s i =δ(ω id -ω i ),ω id is the desired speed of the i-th propeller, ω i is the actual speed of the i-th propeller, λ 1 , 2 , δ are the parameters of sliding mode controller.