A method for heel control of underwater vehicle based on separated stern rudder
Through the differential control of the separate stern rudder, the separation ship motion model and optimal control method are used to solve the problem that traditional underwater vehicles cannot control the horizontal tilt, and high-precision horizontal tilt control is achieved.
Patent Information
- Application Number
- CN202411111299.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-14
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2044-08-14
AI Technical Summary
Traditional underwater vehicles cannot generate controllable tilt torque due to the linkage transmission of the stern rudder, which makes it impossible to control the tilt of the underwater vehicle, and the hydrodynamic coefficient is difficult to obtain, resulting in the tilt control with unknown models. .
Differential control of the separated stern rudder is adopted, and closed-loop control of the horizontal inclination angle of the underwater vehicle is realized through the modeling of the separated ship motion model, the least squares parameter identification, the polar configuration method, and the optimal control method design controller. .
The horizontal tilt control is realized when the underwater vehicle rotates. During the control process, the horizontal tilt is not overshooted, the left and right stern rudders are gentle and the number of rudders is low, which improves the control accuracy of horizontal tilt control.
Smart Images

Figure CN118625849B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of underwater vehicle motion control, and in particular to an underwater vehicle roll control method based on a separated stern rudder. Background Art
[0002] Traditional underwater vehicles cannot generate controllable heeling moment due to the linkage transmission of the stern rudder and steering gear, so the heel of the underwater vehicle cannot be controlled. The separated stern rudder can form an effective and controllable heeling moment through differential steering of the left and right stern rudders, thereby controlling the heel of the underwater vehicle. However, the hydrodynamic coefficients of the underwater vehicle are often difficult to obtain, so the heel control of the underwater vehicle has the characteristic of unknown model. Summary of the invention
[0003] The present invention aims to solve at least one of the technical problems existing in the related art. To this end, the present invention provides a method for controlling the roll of an underwater vehicle based on a separated stern rudder, which realizes the roll control of the underwater vehicle during its rotation through the differential control of the separated stern rudder, and there is no overshoot of the roll during the roll control process, the left and right stern rudders are steered smoothly, the number of steering times is low, and the control accuracy of the roll control is improved.
[0004] The present invention provides a method for controlling the roll of an underwater vehicle based on a separated stern rudder, comprising:
[0005] S1: Using the modeling method of the separated ship motion model, a heeling motion state space model is established with the separated stern rudder differential rudder angle as input and the underwater vehicle heel angle as output;
[0006] S2: Parameter identification of the heel motion state space model using the least squares method;
[0007] S3: Using the pole placement method, the observer is designed for the identified heel motion state space model to obtain the heel angular rate value of the underwater vehicle;
[0008] S4: Using the optimal control method, the optimal controller is designed based on the identified heel motion state space model;
[0009] S5: according to the heel measurement value of the underwater vehicle, the differential rudder angle feedback value of the separated stern rudder and the heel angle rate value, the separated stern rudder command differential rudder angle value is solved by the optimal controller;
[0010] S6: The separated stern rudder is driven by the separated stern rudder to complete the closed-loop control of the heeling motion through the separated stern rudder command differential rudder angle value.
[0011] According to the present invention, a heel control method for an underwater vehicle based on a separated stern rudder is provided, which further includes, in the step S1, using a modeling method of a separated ship motion model to establish a heel motion state space model with a separated stern rudder differential rudder angle as input and an underwater vehicle heel angle as output; the underwater vehicle heel motion model is:
[0012]
[0013] in, is the heel angular velocity, is the pitch angular velocity, is the heading angular velocity, is the heel angle, is the pitch angle, is the moment of inertia about the X-axis of the hull, is the moment of inertia about the Y axis of the hull, is the moment of inertia about the Z axis of the hull, is the viscous hydrodynamic torque, is the heeling moment caused by the separate stern rudder differential, is the heel righting moment coefficient, for The derivative of for The derivative of
[0014] Viscous hydrodynamic torque The calculation expression is:
[0015]
[0016] in, is the first-order viscous hydrodynamic coefficient of the hull, is the second-order viscous hydrodynamic coefficient of the hull, is the second-order viscous hydrodynamic state quantity;
[0017] Heeling moment caused by split stern rudder differential The calculation expression is:
[0018]
[0019] in, is the hydrodynamic coefficient of the differential rudder angle of the separated stern rudder, It is a separate stern rudder differential rudder angle.
[0020] According to a method for controlling the roll of an underwater vehicle based on a separated stern rudder provided by the present invention, when the vehicle performs a roll motion, a simplified roll motion model is:
[0021]
[0022] Heeling motion state space model:
[0023]
[0024] in, is the heel motion state space matrix, is the heel motion state matrix.
[0025] According to the present invention, a method for controlling the heeling of an underwater vehicle based on a separated stern rudder further includes the step S2 of using the least square method to perform parameter identification on the heeling motion state space model, and the heeling motion state space model is:
[0026]
[0027] in, is the heel angular velocity, is the heel angle, for The derivative of for The derivative of for , for , for , is the moment of inertia about the X-axis of the hull, is the heel righting moment coefficient, is the first-order viscous hydrodynamic coefficient of the hull, is the hydrodynamic coefficient of the differential rudder angle of the separated stern rudder, It is a separate stern rudder differential rudder angle;
[0028] The heeling motion state space model is rewritten into the form of a difference equation:
[0029]
[0030] in, To control the cycle, For the current moment, Push one control cycle moment forward from the current moment, Represents the current moment pushed forward by two control cycles, is the heel angle at the current moment, for The heel angle at the moment, for The heel angle at the moment, for Separate stern rudder differential rudder angle at the moment;
[0031] The simplified difference equation is:
[0032]
[0033] in, , , .
[0034] According to a heel control method for an underwater vehicle based on a separated stern rudder provided by the present invention, the method further includes performing least square identification on a simplified differential equation, wherein the input sequence of the heel motion is a differential rudder angle sequence of the separated stern rudder:
[0035]
[0036] in, is the number of input sequences, For the Separate stern rudder differential rudder angle;
[0037] The output sequence of the heel motion is the heel angle sequence of the underwater vehicle:
[0038]
[0039] in, For the The heel angle of the underwater vehicle;
[0040] According to the simplified difference equation, we can obtain Equations:
[0041]
[0042] Will The equation is written in vector matrix form:
[0043]
[0044] The result of parameter identification is:
[0045]
[0046] in, , , For parameters The identification value of For parameters The identification value of For parameters Identification value of
[0047] The parameter values after identification are:
[0048]
[0049] The identified heel motion state space model is:
[0050]
[0051] in, For parameters The identification value of For parameters The identification value of For parameters identification value.
[0052] According to the present invention, a method for controlling the heeling of an underwater vehicle based on a separated stern rudder further comprises the following step S3: using a pole configuration method to perform observer design on the identified heeling motion state space model to obtain a heeling angular rate value of the underwater vehicle;
[0053] Design an observer to estimate the heel angle rate value. The observer is:
[0054]
[0055] in, is the observed value of heel rate, is the observed heel angle, is the observation matrix, is the one-dimensional coefficient of the observation matrix, is the two-dimensional coefficient of the observation matrix, for The derivative of for The derivative of .
[0056] According to the invention, a method for controlling the heel of an underwater vehicle based on a separated stern rudder is provided, which also includes solving the observation matrix by using a pole configuration method. , the solution formula of the observation matrix is:
[0057]
[0058] in, Configure values for the specified observer poles.
[0059] According to the present invention, a method for controlling the heeling of an underwater vehicle based on a separated stern rudder further includes, in the step S4, adopting an optimal control method to design an optimal controller based on the identified heeling motion state space model, and adopting an LQR linear quadratic regulator optimal control algorithm to design an optimal controller;
[0060] S41: Rewrite the identified heel motion state space equation into an augmented matrix. The augmented matrix expression is:
[0061]
[0062] in, for The derivative of
[0063] S42: The state matrix of the heeling motion state space equation is obtained according to the augmented matrix:
[0064]
[0065] in, is the state matrix;
[0066] The input matrix of the heeling motion state space equation is obtained according to the augmented matrix:
[0067]
[0068] in, is the input matrix;
[0069] S43: Design the first weight vector as:
[0070]
[0071] in, is the first weight vector, is the weight coefficient corresponding to the heel angular velocity, is the weight coefficient corresponding to the heel angle,
[0072] Design the second weight vector The input quantity is set The corresponding weight coefficient, and ;
[0073] S44: Solve the constant matrix through the Riccati equation, which is:
[0074]
[0075] in, is a constant matrix, is transposed;
[0076] S45: The state parameter matrix is obtained as:
[0077]
[0078] in, is the state parameter matrix, is the control coefficient of the heel angular velocity, is the control coefficient of the heel angle, is the control coefficient of the differential rudder angle of the separated stern rudder;
[0079] S46: The optimal controller for heeling motion is:
[0080]
[0081] in, is the command differential rudder angle rate, is the heel measurement value, is the differential rudder angle feedback value of the separated stern rudder.
[0082] According to the present invention, a method for controlling the heeling of an underwater vehicle based on a separated stern rudder is provided, which further includes the step S5, according to the heeling measurement value of the underwater vehicle, the differential rudder angle feedback value of the separated stern rudder and the heel angle rate value, solving the separated stern rudder command differential rudder angle value through an optimal controller, and according to the observed value of the heel rate , obtain the command differential rudder angular rate, the command differential rudder angular rate is:
[0083]
[0084] in, is the command differential rudder angle rate; is the heel measurement value, is the differential rudder angle feedback value of the separated stern rudder, is the observed value of heel rate, is the control coefficient of the heel angular velocity, is the control coefficient of the heel angle, is the control coefficient of the differential rudder angle of the separated stern rudder;
[0085] The command differential rudder angle value of the separated stern rudder is:
[0086]
[0087] in, is the differential rudder angle value of the separated stern rudder command, To control the cycle.
[0088] The above one or more technical solutions in the embodiments of the present invention have at least one of the following technical effects:
[0089] The present invention provides a heel control method for an underwater vehicle based on a separated stern rudder. The heel control of the underwater vehicle during its rotation is realized through differential control of the separated stern rudder. In addition, there is no heel overshoot during the heel control process. The left and right stern rudders are steered smoothly and the number of steering times is low, thereby improving the control accuracy of the heel control.
[0090] Additional aspects and advantages of the present invention will be given in part in the following description and in part will be obvious from the following description, or will be learned through practice of the present invention. BRIEF DESCRIPTION OF THE DRAWINGS
[0091] In order to more clearly illustrate the technical solutions in the present invention or the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.
[0092] Figure 1 A schematic flow chart of a method for heel control of an underwater vehicle based on a separated stern rudder provided by the present invention.
[0093] Figure 2 A schematic diagram of the underwater vehicle heading change according to the underwater vehicle heel control method based on the separated stern rudder provided by the present invention.
[0094] Figure 3 A digital simulation heel curve of an underwater vehicle heel control method based on a separated stern rudder provided by the present invention.
[0095] Figure 4 The invention provides a digitally simulated stern rudder angle curve of an underwater vehicle heel control method based on a separated stern rudder. DETAILED DESCRIPTION
[0096] In order to make the purpose, technical scheme and advantages of the present invention clearer, the technical scheme in the present invention will be clearly and completely described below. Obviously, the described embodiments are part of the embodiments of the present invention, rather than all the embodiments. Based on the embodiments in the present invention, all other embodiments obtained by ordinary technicians in the field without creative work are within the scope of protection of the present invention. The following embodiments are used to illustrate the present invention, but cannot be used to limit the scope of the present invention.
[0097] In the description of this specification, the description with reference to the terms "one embodiment", "some embodiments", "example", "specific example", or "some examples" etc. means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the embodiment of the present invention. In this specification, the schematic representations of the above terms do not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described may be combined in any one or more embodiments or examples in a suitable manner. In addition, those skilled in the art may combine and combine the different embodiments or examples described in this specification and the features of the different embodiments or examples, without contradiction.
[0098] Combine the following Figures 1 to 4 The present invention describes a method for controlling the heel of an underwater vehicle based on a separated stern rudder.
[0099] like Figure 1 As shown, a method for heel control of an underwater vehicle based on a separated stern rudder comprises:
[0100] S1: Using the modeling method of the separated ship motion model, a heeling motion state space model is established with the separated stern rudder differential rudder angle as input and the underwater vehicle heel angle as output;
[0101] S2: Parameter identification of the heel motion state space model using the least squares method;
[0102] S3: Using the pole placement method, the observer is designed for the identified heel motion state space model to obtain the heel angular rate value of the underwater vehicle;
[0103] S4: Using the optimal control method, the optimal controller is designed based on the identified heel motion state space model;
[0104] S5: using the optimal controller, the differential rudder angle value of the separated stern rudder command is solved through the heel measurement value of the underwater vehicle, the heel angle rate value and the differential rudder angle feedback value of the separated stern rudder;
[0105] S6: The separated stern rudder is driven by the separated stern rudder to complete the closed-loop control of the heeling motion through the separated stern rudder command differential rudder angle value.
[0106] The invention adopts a modeling method of a separated ship motion model (ship maneuvering mathematical model group, MMG for short) to establish a heeling motion state space model with a separated stern rudder differential steering angle as input and an underwater vehicle heeling angle as output, adopts a least square method to identify parameters of the heeling motion state space model, adopts a pole configuration method to design an observer, adopts an optimal control method to design an optimal controller, adopts the optimal controller to solve a separated stern rudder command differential steering angle value, and uses the separated stern rudder command differential steering angle value to drive the separated stern rudder to complete closed-loop control of heeling motion, thereby improving the control accuracy of heeling control.
[0107] Specifically, S1: using the MMG modeling method, a heel motion state space model is established with the separated stern rudder differential rudder angle as input and the underwater vehicle heel angle as output; the underwater vehicle heel motion model is:
[0108]
[0109] in, is the heel angular velocity, is the pitch angular velocity, is the heading angular velocity, is the heel angle, is the pitch angle, is the moment of inertia about the X-axis of the hull, is the moment of inertia about the Y axis of the hull, is the moment of inertia about the Z axis of the hull, is the viscous hydrodynamic torque, is the heeling moment caused by the separate stern rudder differential, is the heel righting moment coefficient, for The derivative of for The derivative of
[0110] Viscous hydrodynamic torque The calculation expression is:
[0111]
[0112] in, is the first-order viscous hydrodynamic coefficient of the hull, is the second-order viscous hydrodynamic coefficient of the hull, is the second-order viscous hydrodynamic state quantity;
[0113] Heeling moment caused by split stern rudder differential The calculation expression is:
[0114]
[0115] in, is the hydrodynamic coefficient of the differential rudder angle of the separated stern rudder, It is a separate stern rudder differential rudder angle.
[0116] In some specific embodiments of the present invention, when the aircraft is rolling, the longitudinal inclination angle can be approximately considered to be Fixed to 0, so the pitch angular velocity is also 0, and it is assumed that the heel angle changes within a smaller range, so , and the second-order viscous hydrodynamic coefficient of the hull Compared with the first-order viscous hydrodynamic coefficient of the hull Because it is a small term, it can be ignored item.
[0117] The simplified heeling motion model is:
[0118]
[0119] Heeling motion state space model:
[0120]
[0121] in, is the heel motion state space matrix, is the heel motion state matrix.
[0122] S2: The least square method is used to identify the parameters of the heel motion state space model; the heel motion state space model is:
[0123]
[0124] in, is the heel angular velocity, is the heel angle, for The derivative of for The derivative of for , for , for , is the moment of inertia about the X-axis of the hull, is the heel righting moment coefficient, is the first-order viscous hydrodynamic coefficient of the hull, is the hydrodynamic coefficient of the differential rudder angle of the separated stern rudder, It is a separate stern rudder differential rudder angle;
[0125] The heeling motion state space model is rewritten into the form of a difference equation:
[0126]
[0127] in, To control the cycle, For the current moment, Push one control cycle moment forward from the current moment, Represents the current moment pushed forward by two control cycles, is the heel angle at the current moment, for The heel angle at the moment, for The heel angle at the moment, for Separate stern rudder differential rudder angle at the moment;
[0128] The simplified difference equation is:
[0129]
[0130] in, , , .
[0131] The simplified differential equation is identified by least squares, and the input sequence of the heeling motion is separated from the stern rudder differential angle sequence:
[0132]
[0133] in, is the number of input sequences, For the Separate stern rudder differential rudder angle;
[0134] The output sequence of the heel motion is the heel angle sequence of the underwater vehicle:
[0135]
[0136] in, For the The heel angle of the underwater vehicle;
[0137] According to the simplified difference equation, we can obtain Equations:
[0138]
[0139] The equation can be written in the form of a vector matrix:
[0140]
[0141] The result of parameter identification is:
[0142]
[0143] in, , , For parameters The identification value of For parameters The identification value of For parameters The identification value of
[0144] The parameter values after identification are:
[0145]
[0146] The identified heel motion state space model is:
[0147]
[0148] in, For parameters The identification value of For parameters The identification value of For parameters identification value.
[0149] S3: Using the pole placement method, the observer is designed for the identified heel motion state space model to obtain the heel angular rate value of the underwater vehicle;
[0150] In some specific embodiments of the present invention, the heel angle rate value is generally difficult to measure, so an observer is designed to estimate the heel angle rate value, and the observer is:
[0151]
[0152] in, is the observed value of heel rate, is the observed heel angle, is the observation matrix, is the one-dimensional coefficient of the observation matrix, is the two-dimensional coefficient of the observation matrix, for The derivative of for The derivative of .
[0153] Solving the measurement matrix using the pole placement method , the solution formula of the observation matrix is:
[0154]
[0155] in, Configure the values for the observer poles you set, .
[0156] S4: Adopt the optimal control method to design the optimal controller based on the identified heel motion state space model; adopt the LQR (Linear Quadratic Regulator) linear quadratic regulator optimal control algorithm to design the optimal controller;
[0157] S41: Rewrite the identified heel motion state space equation into an augmented matrix. The augmented matrix expression is:
[0158]
[0159] in, for The derivative of
[0160] S42: The state matrix of the heeling motion state space equation is obtained according to the augmented matrix:
[0161]
[0162] in, is the state matrix;
[0163] The input matrix of the heeling motion state space equation is obtained according to the augmented matrix:
[0164]
[0165] in, is the input matrix;
[0166] S43: Design the first weight vector as:
[0167]
[0168] in, is the first weight vector, is the weight coefficient corresponding to the heel angular velocity, is the weight coefficient corresponding to the heel angle, and , ;
[0169] Design the second weight vector The input quantity is set The corresponding weight coefficient, and ;
[0170] S44: Solve the constant matrix through the Riccati equation, which is:
[0171]
[0172] in, is a constant matrix, is transposed;
[0173] S45: The state parameter matrix is obtained as:
[0174]
[0175] in, is the state parameter matrix, is the control coefficient of the heel angular velocity, is the control coefficient of the heel angle, is the control coefficient of the differential rudder angle of the separated stern rudder;
[0176] S46: The optimal controller for heeling motion is:
[0177]
[0178] in, is the command differential rudder angle rate, is the heel measurement value, is the differential rudder angle feedback value of the separated stern rudder.
[0179] S5: The optimal controller is used to calculate the differential rudder angle value of the separated stern rudder command through the heel measurement value of the underwater vehicle, the heel angle rate value and the differential rudder angle feedback value of the separated stern rudder; according to the observed value of the heel rate , get the command differential rudder angle rate:
[0180]
[0181] in, is the command differential rudder angle rate; is the heel measurement value, is the differential rudder angle feedback value of the separated stern rudder, is the observed value of heel rate, is the control coefficient of the heel angular velocity, is the control coefficient of the heel angle, is the control coefficient of the differential rudder angle of the separated stern rudder;
[0182] The command differential rudder angle value of the separated stern rudder is:
[0183]
[0184] in, is the differential rudder angle value of the separated stern rudder command, To control the cycle.
[0185] S6: The separated stern rudder is driven by the separated stern rudder to complete the closed-loop control of the heeling motion through the separated stern rudder command differential rudder angle value.
[0186] In some specific embodiments of the present invention, Figure 2 and Figure 3 As shown in the figure, the underwater vehicle sets the initial heading to 30°, the speed to 6kn, the rudder is turned to the right, and the heel control is performed by the left and right separated stern rudder differential. The simulation results are shown in Figure 4 As shown, an underwater vehicle roll control method based on a separated stern rudder is adopted. When the underwater vehicle turns at full rudder, the differential control of the separated stern rudder is used to realize the roll control of the underwater vehicle during the turning. In addition, there is no overshoot of the roll during the roll control process, the steering of the left and right stern rudders is smooth, and the number of steering times is low, thereby improving the control accuracy of the roll control.
[0187] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or make equivalent replacements for some of the technical features therein. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present invention.
Claims
1. A method for controlling the roll of an underwater vehicle based on a separated stern rudder, characterized in that: include: S1: Using the modeling method of the separated ship motion model, a heeling motion state space model is established with the separated stern rudder differential rudder angle as input and the underwater vehicle heel angle as output; The heel motion model of underwater vehicle is: in, is the heel angular velocity, is the pitch angular velocity, is the heading angular velocity, is the heel angle, is the pitch angle, is the moment of inertia about the X-axis of the hull, is the moment of inertia about the Y axis of the hull, is the moment of inertia about the Z axis of the hull, is the viscous hydrodynamic torque, is the heeling moment caused by the separate stern rudder differential, is the heel righting moment coefficient, for The derivative of for The derivative of Viscous hydrodynamic torque The calculation expression is: in, is the first-order viscous hydrodynamic coefficient of the hull, is the second-order viscous hydrodynamic coefficient of the hull, is the second-order viscous hydrodynamic state quantity; Heeling moment caused by split stern rudder differential The calculation expression is: in, is the hydrodynamic coefficient of the differential rudder angle of the separated stern rudder, It is a separate stern rudder differential rudder angle; When the spacecraft rolls, the simplified rolling motion model is: Heeling motion state space model: in, is the heel motion state space matrix, is the heeling motion state moment; S2: Parameter identification of the heel motion state space model using the least squares method; S3: Using the pole placement method, the observer is designed for the identified heel motion state space model to obtain the heel angular rate value of the underwater vehicle; S4: Using the optimal control method, the optimal controller is designed based on the identified heel motion state space model; S5: according to the heel measurement value of the underwater vehicle, the differential rudder angle feedback value of the separated stern rudder and the heel angle rate value, the separated stern rudder command differential rudder angle value is solved by the optimal controller; S6: The separated stern rudder is driven by the separated stern rudder to complete the closed-loop control of the heeling motion through the separated stern rudder command differential rudder angle value.
2. The method for controlling the heel of an underwater vehicle based on a separated stern rudder according to claim 1, characterized in that: In step S2, the least square method is used to identify the parameters of the heel motion state space model, and the heel motion state space model is: in, is the heel angular velocity, is the heel angle, for The derivative of for The derivative of for , for , for , is the moment of inertia about the X-axis of the hull, is the heel righting moment coefficient, is the first-order viscous hydrodynamic coefficient of the hull, is the hydrodynamic coefficient of the differential rudder angle of the separated stern rudder, It is a separate stern rudder differential rudder angle; The heeling motion state space model is rewritten into the form of a difference equation: in, To control the cycle, For the current moment, Push one control cycle moment forward from the current moment, Represents the current moment pushed forward by two control cycles, is the heel angle at the current moment, for The heel angle at the moment, for The heel angle at the moment, for Separate stern rudder differential rudder angle at the moment; The simplified difference equation is: in, , , .
3. The method for controlling the heel of an underwater vehicle based on a separated stern rudder according to claim 2, characterized in that: The simplified differential equation is identified by least squares, and the input sequence of the heeling motion is the differential rudder angle sequence of the separated stern rudder: in, is the number of input sequences, For the Separate stern rudder differential rudder angle; The output sequence of the heel motion is the heel angle sequence of the underwater vehicle: in, For the The heel angle of the underwater vehicle; According to the simplified difference equation, we can obtain Equations: Will The equation is written in vector matrix form: The result of parameter identification is: in, , , For parameters The identification value of For parameters The identification value of For parameters Identification value of The parameter values after identification are: The identified heel motion state space model is: in, For parameters The identification value of For parameters The identification value of For parameters identification value.
4. The method for controlling the heel of an underwater vehicle based on a separated stern rudder according to claim 3, characterized in that: In the step S3, a pole placement method is used to design an observer for the identified heel motion state space model to obtain a heel angular rate value of the underwater vehicle; Design an observer to estimate the heel angle rate value. The observer is: in, is the observed value of heel rate, is the observed heel angle, is the observation matrix, is the one-dimensional coefficient of the observation matrix, is the two-dimensional coefficient of the observation matrix, for The derivative of for The derivative of .
5. The method for controlling the heel of an underwater vehicle based on a separated stern rudder according to claim 4, characterized in that: Solving the measurement matrix using the pole placement method , the solution formula of the observation matrix is: in, Configure values for the specified observer poles.
6. The method for controlling the heel of an underwater vehicle based on a separated stern rudder according to claim 5, characterized in that: In the step S4, an optimal control method is used to design an optimal controller based on the identified heel motion state space model, and an LQR linear quadratic regulator optimal control algorithm is used to design an optimal controller; S41: Rewrite the identified heel motion state space equation into an augmented matrix. The augmented matrix expression is: in, for The derivative of S42: The state matrix of the heeling motion state space equation is obtained according to the augmented matrix: in, is the state matrix; The input matrix of the heeling motion state space equation is obtained according to the augmented matrix: in, is the input matrix; S43: Design the first weight vector as: in, is the first weight vector, is the weight coefficient corresponding to the heel angular velocity, is the weight coefficient corresponding to the heel angle, Design the second weight vector The input value is set The corresponding weight coefficients, and ; S44: Solve the constant matrix through the Riccati equation, which is: in, is a constant matrix, is transposed; S45: Substitution The state parameter matrix is obtained as: in, is the state parameter matrix, is the control coefficient of the heel angular velocity, is the control coefficient of the heel angle, is the control coefficient of the differential rudder angle of the separated stern rudder; S46: The optimal controller for heeling motion is: in, is the command differential rudder angle rate, is the heel measurement value, is the differential rudder angle feedback value of the separated stern rudder.
7. The method for controlling the heel of an underwater vehicle based on a separated stern rudder according to claim 1, characterized in that: In the step S5, according to the heel measurement value of the underwater vehicle, the differential rudder angle feedback value of the separated stern rudder and the heel angle rate value, the separated stern rudder command differential rudder angle value is solved by the optimal controller, and according to the observed value of the heel rate , obtain the command differential rudder angular rate, the command differential rudder angular rate is: in, is the command differential rudder angle rate; is the heel measurement value, is the differential rudder angle feedback value of the separated stern rudder, is the observed value of heel rate, is the control coefficient of the heel angular velocity, is the control coefficient of the heel angle, is the control coefficient of the differential rudder angle of the separated stern rudder; The command differential rudder angle value of the separated stern rudder is: in, is the differential rudder angle value of the separated stern rudder command, To control the cycle.
