A method for emergency control of a single rudder card of a separated rudder underwater vehicle
By establishing a six-degree of freedom motion model and rudder card detection algorithm in an underwater vehicle, optimal control in the case of a single rudder card is achieved, the risk of loss of control caused by a single rudder card is solved, and the safety of the vehicle is improved.
Patent Information
- Application Number
- CN202411098424.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-12
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2044-08-12
Smart Images

Figure CN118625843B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of underwater vehicle motion control, and in particular to an emergency control method for a single rudder card of a separated rudder underwater vehicle. Background Art
[0002] As a powerful tool for exploring the ocean, underwater vehicles are now receiving more and more attention. Nowadays, they have gradually become an important branch of the field of intelligent vehicles, playing an important role in military and civilian fields such as hydrographic surveying, oil and gas exploration, optical cable inspection, and covert reconnaissance. The depth control of underwater vehicles is an important basis for them to complete various tasks. When the left and right separated rudder underwater vehicles are sailing normally, the depth of the vehicle is controlled by manipulating the left tail horizontal rudder and the right tail horizontal rudder. When a single rudder is stuck, it is equivalent to a change in the vehicle's motion model and actuator. It is difficult to control the depth of the vehicle using conventional controllers. After a single rudder is stuck, the single tail horizontal rudder surface is fixed, and the actuator only has another tail horizontal rudder. Therefore, the controller of the vehicle needs to be redesigned to meet the new control requirements. 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 single rudder card emergency control method for a detached rudder underwater vehicle. The present invention is directed to a detached rudder vehicle, and uses a conventional controller to control the depth of the vehicle in a normal navigation state, and uses a rudder card detection algorithm to monitor the rudder card in real time. When a single horizontal rudder rudder card is stuck, the control law is reconstructed immediately, and the depth of the vehicle can be effectively controlled by the remaining other horizontal rudder angle, thereby reducing the risk of loss of control when a single rudder card of the detached rudder vehicle is stuck, and improving the navigation safety of the vehicle.
[0004] The present invention provides a method for emergency control of a single rudder card of a detachable rudder underwater vehicle, comprising:
[0005] S1: Establish a six-degree-of-freedom motion model of the aircraft;
[0006] S2: Obtaining a vertical plane linear motion equation of the first aircraft by linearizing the six-degree-of-freedom motion model of the aircraft;
[0007] S3: Based on the linear motion equation of the vertical plane of the first aircraft, the controller design for dual horizontal rudder control using the optimal control method;
[0008] S4: Design a rudder card detection algorithm by monitoring the relationship between the rudder angle, rudder angle command and rudder speed;
[0009] S5: when it is determined through the rudder card detection algorithm that no rudder jam occurs, the controller control during dual horizontal rudder control is adopted; when it is determined through the rudder card detection algorithm that a rudder jam occurs, a linear motion equation of the second aircraft in the vertical plane is established;
[0010] S6: Based on the linear motion equation of the second aircraft in the vertical plane, the controller design for single horizontal rudder control is performed using the optimal control method.
[0011] According to a single rudder card emergency control method for a detachable rudder underwater vehicle provided by the present invention, the six-degree-of-freedom motion model of the vehicle is also a six-degree-of-freedom nonlinear model, which describes the forward and backward motion, lateral motion, heave motion, roll motion, pitch motion, and bow turning motion of the vehicle.
[0012] According to the single rudder card emergency control method for a separated rudder underwater vehicle provided by the present invention, the method further includes that in the step S1, the six-degree-of-freedom motion model of the vehicle is:
[0013]
[0014] in, is the mass of the spacecraft, is the longitudinal velocity of the aircraft, is the lateral velocity, is the vertical speed, is the heel angular velocity, is the pitch angular velocity, is the bow angular velocity, is the longitudinal position of the center of gravity in the spacecraft coordinate system, is the lateral position of the center of gravity in the spacecraft coordinate system, is the vertical position of the center of gravity in the spacecraft coordinate system, is the lateral force of the spacecraft, is the longitudinal force of the vehicle, is the vertical force of the spacecraft, is the moment of the spacecraft's lateral rotation, is the moment of the vehicle's longitudinal rotation, is the moment of the spacecraft's vertical rotation, is the lateral force of the thruster, is the longitudinal force of the propeller, is the vertical force of the thruster, is the moment of the propeller rotating in the lateral direction, is the torque of the propeller rotating along the longitudinal direction, is the torque of the propeller rotating in the vertical direction, is the lateral force of the rudder, is the longitudinal force of the rudder, is the vertical force of the rudder, is the moment of rudder rotation in the lateral direction, is the moment of the rudder rotating in the longitudinal direction, is the moment of the rudder rotating in the vertical direction, The lateral force caused by external interference, The longitudinal force is caused by the external environment. is the vertical force caused by external interference, is the torque of the lateral rotation caused by the external environment interference, is the torque of the external environment interfering with the longitudinal rotation, is the torque of vertical rotation caused by external environment interference, is the lateral moment of inertia, is the longitudinal moment of inertia, is the vertical moment of inertia, for The derivative of for The derivative of for The derivative of for The derivative of for The derivative of for The derivative of .
[0015] According to the single rudder card emergency control method for a detachable rudder underwater vehicle provided by the present invention, the method further includes the step S2, in which the linear motion equation of the vertical plane of the first vehicle is obtained by expanding the six-degree-of-freedom motion equation according to Taylor series and selecting the motion state of the vertical plane of the vehicle. The linear motion equation of the vertical plane of the first vehicle is:
[0016]
[0017] in, is the vertical speed, is the pitch angular velocity, is the pitch angle, For depth, is the right tail horizontal rudder angle, is the left tail horizontal rudder angle, for The derivative of for The derivative of for The derivative of for The derivative of is the rudder angle coefficient, is the aircraft state coefficient.
[0018] According to the single rudder card emergency control method of a separated rudder underwater vehicle provided by the present invention, the method further includes the controller design when a quadratic optimal controller is used to control the dual horizontal rudders in the step S3, and the quadratic optimal controller is:
[0019]
[0020] in, For the right tail horizontal rudder command, For the left tail horizontal rudder command, is the depth instruction, is the vertical velocity, is the pitch angular velocity, is the pitch angle, For depth, is the vertical speed control parameter, is the pitch angular velocity control parameter, is the pitch angle control parameter, is the depth control parameter.
[0021] According to a single rudder card emergency control method for a separated rudder underwater vehicle provided by the present invention, the method further includes using a Kalman filter to estimate the vertical velocity, pitch angular velocity, pitch angle and depth of the vehicle, and the estimation equation is:
[0022]
[0023] in, is the estimation matrix, , for The derivative of is the estimated value of vertical velocity, is the estimated value of the pitch angular velocity, is the estimated value of the pitch angle, is the estimated value of depth, is the right tail horizontal rudder angle, is the left tail horizontal rudder angle, is the pitch angle, For depth, is the spacecraft state coefficient matrix, is the rudder angle coefficient matrix,
[0024] is the observer coefficient matrix.
[0025] According to a method for emergency control of a single rudder card of a detachable rudder underwater vehicle provided by the present invention, the rudder card detection algorithm in the step S4 is:
[0026]
[0027] in, For the rudder angle, is the rudder angle command, is the rudder speed, It is the threshold value for the rudder card.
[0028] According to a single rudder card emergency control method for a detachable rudder underwater vehicle provided by the present invention, the vertical plane linear motion equation of the second vehicle is the vertical plane linear motion equation behind the left horizontal rudder card or the vertical plane linear motion equation behind the right horizontal rudder card.
[0029] According to a single rudder card emergency control method for a detachable rudder underwater vehicle provided by the present invention, the method further includes, in the step S5, when the left horizontal rudder card is determined by the rudder card detection algorithm, establishing a vertical plane linear motion equation behind the left horizontal rudder card, and the vertical plane linear motion equation behind the left horizontal rudder card is:
[0030]
[0031] in, is the vertical velocity, is the pitch angular velocity, is the pitch angle, For depth, is the right tail horizontal rudder angle, for The derivative of for The derivative of for The derivative of is the linearization state coefficient of the single rudder card of the aircraft, for The derivative of is the linearized rudder vertical coefficient of the single rudder card of the aircraft, is the linearized rudder longitudinal coefficient of the single rudder card of the aircraft, is the linearized rudder pitch coefficient of the single rudder card of the aircraft, is the linearized rudder depth coefficient of the single rudder card of the aircraft;
[0032] When the rudder card detection algorithm is used to determine the right horizontal rudder card, the vertical plane linear motion equation behind the right horizontal rudder card is established. The vertical plane linear motion equation behind the right horizontal rudder card is:
[0033]
[0034] in, is the left tail horizontal rudder angle.
[0035] According to a single rudder card emergency control method for a detachable rudder underwater vehicle provided by the present invention, the method further includes the step S6, based on the vertical plane linear motion equation behind the left horizontal rudder card, adopting the optimal control method to design a controller when controlling the single horizontal rudder, the controller when controlling the single horizontal rudder behind the left horizontal rudder card is:
[0036]
[0037] in, is the right tail horizontal rudder command, is the vertical speed control parameter after the rudder card occurs, is the control parameter of the pitch angle velocity after the rudder card occurs, It is the control parameter of the trim angle after the rudder card occurs. It is the depth control parameter after the rudder card occurs;
[0038] Based on the vertical linear motion equation behind the right horizontal rudder clip, the optimal control method is used to design the controller for single horizontal rudder control. The controller for single horizontal rudder control behind the right horizontal rudder clip is:
[0039]
[0040] in, It is the right tail horizontal rudder command.
[0041] The above one or more technical solutions in the embodiments of the present invention have at least one of the following technical effects:
[0042] The present invention provides a single rudder card emergency control method for a detachable rudder underwater vehicle. For the detachable rudder vehicle, a conventional controller is used to control the depth of the vehicle in a normal navigation state, and a rudder card detection algorithm is used to monitor the rudder card in real time. When a single horizontal rudder is stuck, the control law is immediately reconstructed, and the depth of the vehicle can be effectively controlled by the remaining other horizontal rudder angle, thereby reducing the risk of loss of control of the detached rudder vehicle when a single rudder is stuck, and improving the navigation safety of the vehicle.
[0043] 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
[0044] 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.
[0045] Figure 1 The present invention provides a flow chart of a method for emergency control of a single rudder card of a detachable rudder underwater vehicle.
[0046] Figure 2 The invention provides a digital simulation depth curve of emergency manipulation of a rudder card of a separated-rudder underwater vehicle in an emergency control method of a single rudder card.
[0047] Figure 3 The invention provides a digital simulation longitudinal inclination curve of the emergency operation of a rudder card of a separated rudder underwater vehicle in an emergency control method of a single rudder card.
[0048] Figure 4 The invention provides a digital simulation horizontal rudder angle curve of a vehicle rudder card emergency operation of a separated rudder underwater vehicle single rudder card emergency control method. DETAILED DESCRIPTION
[0049] 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.
[0050] In the description of the embodiments of the present invention, it should be noted that the terms “first” and “second” are only used for descriptive purposes and cannot be understood as indicating or implying relative importance.
[0051] 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.
[0052] Combine the following Figures 1 to 4 The present invention describes a single rudder card emergency control method for a separated rudder underwater vehicle.
[0053] A method for emergency control of a single rudder card of a detachable rudder underwater vehicle, comprising:
[0054] S1: Establish a six-degree-of-freedom motion model of the aircraft;
[0055] S2: Obtaining a vertical plane linear motion equation of the first aircraft by linearizing the six-degree-of-freedom motion model of the aircraft;
[0056] S3: Based on the linear motion equation of the vertical plane of the first aircraft, the controller design for dual horizontal rudder control using the optimal control method;
[0057] S4: Design a rudder card detection algorithm by monitoring the relationship between the rudder angle, rudder angle command and rudder speed;
[0058] S5: when it is determined through the rudder card detection algorithm that no rudder jam occurs, the controller control during dual horizontal rudder control is adopted; when it is determined through the rudder card detection algorithm that a rudder jam occurs, a linear motion equation of the second aircraft in the vertical plane is established;
[0059] S6: Based on the linear motion equation of the second aircraft in the vertical plane, the controller design for single horizontal rudder control is performed using the optimal control method.
[0060] When the rudder is not stuck in the aircraft, the present invention controls the depth of the aircraft through the controller under dual-horizontal rudder control; when the aircraft has only one rudder stuck, firstly a rudder sticking detection algorithm is used to determine whether the rudder is stuck, and if the result of the determination is that the rudder is stuck, the control law is reconstructed, and the reconstructed controller controls the depth of the single-rudder stuck aircraft by manipulating the single-horizontal rudder on the side of the aircraft where the rudder is not stuck; the present invention can effectively avoid the problem of loss of control caused by the single rudder sticking of a separate-rudder aircraft.
[0061] Specifically, S1: establish a six-degree-of-freedom motion model of the aircraft; the six-degree-of-freedom motion model of the aircraft is a six-degree-of-freedom nonlinear model that describes the six-degree-of-freedom motion of the aircraft in the horizontal and vertical planes, and describes the aircraft's forward and backward motion, lateral motion, heave motion, roll motion, pitch motion, and bow turning motion.
[0062] The six-degree-of-freedom motion model of the aircraft is:
[0063]
[0064] in, is the mass of the spacecraft, is the longitudinal velocity of the aircraft, is the lateral velocity, is the vertical speed, is the heel angular velocity, is the pitch angular velocity, is the bow angular velocity, is the longitudinal position of the center of gravity in the spacecraft coordinate system, is the lateral position of the center of gravity in the spacecraft coordinate system, is the vertical position of the center of gravity in the spacecraft coordinate system, is the lateral force of the spacecraft, is the longitudinal force of the vehicle, is the vertical force of the spacecraft, is the moment of the spacecraft's lateral rotation, is the moment of the vehicle's longitudinal rotation, is the moment of the spacecraft's vertical rotation, is the lateral force of the propeller, is the longitudinal force of the propeller, is the vertical force of the thruster, is the moment of the propeller rotating in the lateral direction, is the torque of the propeller rotating along the longitudinal direction, is the torque of the propeller rotating in the vertical direction, is the lateral force of the rudder, is the longitudinal force of the rudder, is the vertical force of the rudder, is the moment of the rudder rotating in the lateral direction, is the moment of the rudder rotating in the longitudinal direction, is the moment of the rudder rotating in the vertical direction, The lateral force caused by external interference, The longitudinal force is caused by the external environment. is the vertical force caused by external interference, is the torque of the lateral rotation caused by the external environment interference, is the torque of the external environment interfering with the longitudinal rotation, is the torque of vertical rotation caused by external environment interference, is the lateral moment of inertia, is the longitudinal moment of inertia, is the vertical moment of inertia, for The derivative of for The derivative of for The derivative of for The derivative of for The derivative of for The derivative of .
[0065] S2: Obtaining a vertical plane linear motion equation of the first aircraft by linearizing the six-degree-of-freedom motion model of the aircraft;
[0066] In some embodiments of the present invention, the specific method of linearization is to expand the six-degree-of-freedom motion equation according to the Taylor series at a specified speed and select the motion state of the vertical plane of the aircraft to obtain the linear motion equation of the vertical plane of the first aircraft. The linear motion equation of the vertical plane of the first aircraft is:
[0067]
[0068] in, is the vertical speed, is the pitch angular velocity, is the pitch angle, For depth, is the right tail horizontal rudder angle, is the left tail horizontal rudder angle, for The derivative of for The derivative of for The derivative of for The derivative of is the rudder angle coefficient, is the aircraft state coefficient.
[0069] In order to meet the full speed control requirements of the aircraft during navigation, it is necessary to linearize the nonlinear model within the full speed range of the aircraft, and fit the linear model coefficients obtained at each speed according to the speed to obtain the linear model coefficients related to the speed.
[0070] In some embodiments of the present invention, linearization is performed using the polyfit function in Matlab.
[0071]
[0072] in, are the polynomial coefficients obtained by fitting, is the degree of the polynomial, is the speed of the aircraft, is the linearization coefficient at a specific speed.
[0073] The state space equation of the vertical motion of the aircraft can be obtained by linear fitting:
[0074]
[0075] in, is the rudder coefficient matrix after fitting, is the state coefficient matrix of the vehicle after fitting.
[0076] S3: Based on the linear motion equation of the vertical plane of the first aircraft, the controller design for dual horizontal rudder control using the optimal control method;
[0077] In some embodiments of the present invention, a quadratic optimal controller is used to design a controller for dual horizontal rudder control. The quadratic optimal controller is:
[0078]
[0079] in, For the right tail horizontal rudder command, For the left tail horizontal rudder command, is the depth instruction, is the vertical speed, is the pitch angular velocity, is the pitch angle, For depth, is the vertical speed control parameter, is the pitch angular velocity control parameter, is the pitch angle control parameter, is the depth control parameter, obtained by solving the Riccati equation , , as well as .
[0080] The Kalman filter is used to estimate the vertical velocity, pitch angular velocity, pitch angle and depth of the vehicle. The estimation equation is:
[0081]
[0082] in, is the estimation matrix, , for The derivative of is the estimated value of vertical velocity, is the estimated value of the pitch angular velocity, is the estimated value of the pitch angle, is the estimated value of depth, is the right tail horizontal rudder angle, is the left tail horizontal rudder angle, is the pitch angle, For depth, is the spacecraft state coefficient matrix, is the rudder angle coefficient matrix,
[0083] is the observer coefficient matrix.
[0084] The unmeasurable state quantities of the vehicle used in the controller design process are estimated through the Kalman filter. The unmeasurable state quantities are the vertical velocity, pitch angular velocity, pitch angle and depth of the vehicle.
[0085] S4: Design a rudder card detection algorithm by monitoring the relationship between the rudder angle, rudder angle command and rudder speed;
[0086] The rudder card detection algorithm is:
[0087]
[0088] in, For the rudder angle, is the rudder angle command, is the rudder speed, It is the threshold value for the rudder card.
[0089] In some embodiments of the present invention, the condition for determining the rudder card is that the rudder angle and the rudder angle command exceed the rudder card determination threshold and the rudder speed is zero.
[0090] S5: When it is determined through the rudder card detection algorithm that no rudder jam has occurred, the controller control during dual horizontal rudder control is adopted; when it is determined through the rudder card detection algorithm that a rudder jam has occurred, a vertical plane linear motion equation for the second aircraft is established; the vertical plane linear motion equation for the second aircraft is the vertical plane linear motion equation behind the left horizontal rudder card or the vertical plane linear motion equation behind the right horizontal rudder card.
[0091] When the left horizontal rudder card is determined by the rudder card detection algorithm, the vertical plane linear motion equation behind the left horizontal rudder card is established. The vertical plane linear motion equation behind the left horizontal rudder card is:
[0092]
[0093] in, is the vertical velocity, is the pitch angular velocity, is the pitch angle, For depth, is the right tail horizontal rudder angle, for The derivative of for The derivative of for The derivative of is the linearization state coefficient of the single rudder card of the aircraft, for The derivative of is the linearized rudder vertical coefficient of the single rudder card of the aircraft, is the linearized rudder longitudinal coefficient of the single rudder card of the aircraft, is the linearized rudder pitch coefficient of the single rudder card of the aircraft, is the linearized rudder depth coefficient of the single rudder card of the aircraft;
[0094] When the rudder card detection algorithm is used to determine the right horizontal rudder card, the vertical plane linear motion equation behind the right horizontal rudder card is established. The vertical plane linear motion equation behind the right horizontal rudder card is:
[0095]
[0096] in, is the left tail horizontal rudder angle.
[0097] In some embodiments of the present invention, when rudder jam does not occur, the controller for dual horizontal rudder control is used. When rudder jam occurs, the aircraft has only available rudder surface on the other side, causing the motion characteristics of the aircraft to change. The linear motion equation of the second aircraft's vertical plane is established to design the controller for single horizontal rudder control.
[0098] S6: Based on the linear motion equation of the second aircraft in the vertical plane, the controller design for single horizontal rudder control is performed using the optimal control method.
[0099] Based on the linear motion equation of the vertical plane behind the left horizontal rudder card, the optimal control method is used to design the controller for single horizontal rudder control. The controller for single horizontal rudder control behind the left horizontal rudder card is:
[0100]
[0101] in, is the right tail horizontal rudder command, is the vertical speed control parameter after the rudder card occurs, is the control parameter of the pitch angle velocity after the rudder card occurs, It is the control parameter of the trim angle after the rudder card occurs. It is the depth control parameter after the rudder card occurs;
[0102] Based on the vertical linear motion equation behind the right horizontal rudder clip, the optimal control method is used to design the controller for single horizontal rudder control. The controller for single horizontal rudder control behind the right horizontal rudder clip is:
[0103]
[0104] in, It is the right tail horizontal rudder command.
[0105] In some embodiments of the present invention, the quadratic optimal control function in MATLAB is used to calculate , , as well as The rudder card detection algorithm is used to monitor the rudder card in real time. When a single horizontal rudder is stuck, the control law is reconstructed immediately. The depth of the vehicle can be effectively controlled by the remaining rudder angle of the other horizontal rudder, reducing the risk of loss of control when a separate rudder vehicle is stuck, and improving the navigation safety of the vehicle.
[0106] In some specific embodiments of the present invention, when the vehicle is sailing for 100 seconds, the left horizontal rudder is stuck, and the rudder angle is 20°. The emergency control method of a single rudder card of a separated rudder underwater vehicle of the present invention is used for emergency control. The simulation results are as follows: Figures 2 to 4 As shown, Figure 2 A digital simulation depth curve for emergency control using a single rudder card emergency control method for a separated rudder underwater vehicle of the present invention, Figure 3 In order to use the single rudder card emergency control method of a separated rudder underwater vehicle of the present invention to perform emergency control of the digital simulation trim curve, Figure 4 A digital simulation horizontal rudder angle curve is provided for emergency control using a single rudder card emergency control method for a detached rudder underwater vehicle of the present invention. The control law is reconstructed when a rudder card is stuck, and the reconstructed controller controls the single horizontal rudder on the side of the vehicle where the rudder card is not stuck, thereby achieving depth control of the single rudder card vehicle; by applying a single rudder card emergency control method for a detached rudder underwater vehicle of the present invention, the out-of-control problem caused by the single rudder card of the detached rudder vehicle can be effectively avoided.
[0107] 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 emergency control of a single rudder card of a detachable rudder underwater vehicle, characterized in that: include: S1: Establish a six-degree-of-freedom motion model of the aircraft; S2: Obtaining a vertical plane linear motion equation of the first aircraft by linearizing the six-degree-of-freedom motion model of the aircraft; By expanding the six-degree-of-freedom motion equation according to the Taylor series and selecting the motion state of the vertical plane of the aircraft, the linear motion equation of the vertical plane of the first aircraft is obtained. The linear motion equation of the vertical plane of the first aircraft is: in, is the vertical speed, is the pitch angular velocity, is the pitch angle, For depth, is the right tail horizontal rudder angle, is the left tail horizontal rudder angle, for The derivative of for The derivative of for The derivative of for The derivative of is the rudder angle coefficient, is the aircraft state coefficient; S3: Based on the linear motion equation of the vertical plane of the first aircraft, the controller design for dual horizontal rudder control using the optimal control method; The controller design when using the quadratic optimal controller for dual horizontal rudder control is: in, is the right tail horizontal rudder command, is the left tail horizontal rudder command, is the depth instruction, is the vertical speed control parameter, is the pitch angular velocity control parameter, is the pitch angle control parameter, is the depth control parameter; The Kalman filter is used to estimate the vertical velocity, pitch angular velocity, pitch angle and depth of the vehicle. The estimation equation is: in, is the estimation matrix, , for The derivative of is the estimated value of vertical velocity, is the estimated value of the pitch angular velocity, is the estimated value of the pitch angle, is the estimated value of depth, is the spacecraft state coefficient matrix, is the rudder angle coefficient matrix, is the observer coefficient matrix; S4: Design a rudder card detection algorithm based on the relationship between the monitored rudder angle, rudder angle command and rudder speed; The rudder card detection algorithm is: in, For the rudder angle, is the rudder angle command, is the rudder speed, It is the rudder card judgment threshold; S5: when it is determined through the rudder card detection algorithm that no rudder jam occurs, the controller control during dual horizontal rudder control is adopted; when it is determined through the rudder card detection algorithm that a rudder jam occurs, a linear motion equation of the second aircraft in the vertical plane is established; The vertical plane linear motion equation of the second aircraft is the vertical plane linear motion equation behind the left horizontal rudder card or the vertical plane linear motion equation behind the right horizontal rudder card; When the left horizontal rudder card is determined by the rudder card detection algorithm, the vertical plane linear motion equation behind the left horizontal rudder card is established. The vertical plane linear motion equation behind the left horizontal rudder card is: in, is the linearization state coefficient of the single rudder card of the aircraft, is the linearized rudder vertical coefficient of the single rudder card of the aircraft, is the linearized rudder longitudinal coefficient of the single rudder card of the aircraft, is the linearized rudder pitch coefficient of the single rudder card of the aircraft, is the linearized rudder depth coefficient of the single rudder card of the aircraft; When the rudder card detection algorithm is used to determine the right horizontal rudder card, the vertical plane linear motion equation behind the right horizontal rudder card is established. The vertical plane linear motion equation behind the right horizontal rudder card is: S6: Based on the linear motion equation of the second aircraft in the vertical plane, the controller design for single horizontal rudder control using the optimal control method; Based on the linear motion equation of the vertical plane behind the left horizontal rudder card, the optimal control method is used to design the controller for single horizontal rudder control. The controller for single horizontal rudder control behind the left horizontal rudder card is: in, is the vertical speed control parameter after the rudder card occurs, is the control parameter of the pitch angle velocity after the rudder card occurs, It is the control parameter of the trim angle after the rudder card occurs. It is the depth control parameter after the rudder card occurs; Based on the vertical linear motion equation behind the right horizontal rudder clip, the optimal control method is used to design the controller for single horizontal rudder control. The controller for single horizontal rudder control behind the right horizontal rudder clip is: 。 2. The single rudder card emergency control method for a separated rudder underwater vehicle according to claim 1 is characterized in that: The six-degree-of-freedom motion model of the aircraft is a six-degree-of-freedom nonlinear model, which describes the forward and backward motion, lateral motion, heave motion, roll motion, pitch motion, and bow turning motion of the aircraft.
3. The single rudder card emergency control method for a separated rudder underwater vehicle according to claim 1 is characterized in that: In the step S1, the six-degree-of-freedom motion model of the aircraft is: in, is the mass of the spacecraft, is the longitudinal velocity of the aircraft, is the lateral velocity, is the heel angular velocity, is the bow angular velocity, is the longitudinal position of the center of gravity in the spacecraft coordinate system, is the lateral position of the center of gravity in the spacecraft coordinate system, is the vertical position of the center of gravity in the spacecraft coordinate system, is the lateral force of the spacecraft, is the longitudinal force of the vehicle, is the vertical force of the spacecraft, is the moment of the spacecraft's lateral rotation, is the moment of the vehicle's longitudinal rotation, is the moment of the spacecraft's vertical rotation, is the lateral force of the propeller, is the longitudinal force of the propeller, is the vertical force of the thruster, is the moment of the propeller rotating in the lateral direction, is the torque of the propeller rotating along the longitudinal direction, is the torque of the propeller rotating in the vertical direction, is the lateral force of the rudder, is the longitudinal force of the rudder, is the vertical force of the rudder, is the moment of the rudder rotating in the lateral direction, is the moment of the rudder rotating in the longitudinal direction, is the moment of the rudder rotating in the vertical direction, The lateral force caused by external interference, The longitudinal force is caused by the external environment. is the vertical force caused by external interference, is the torque of the lateral rotation caused by the external environment interference, is the torque of the external environment interfering with the longitudinal rotation, is the torque of vertical rotation caused by external environment interference, is the lateral moment of inertia, is the longitudinal moment of inertia, is the vertical moment of inertia, for The derivative of for The derivative of for The derivative of for The derivative of .
