A method for controlling the orientation of an underwater vehicle in a hovering state
Patent Information
- Application Number
- CN202411097178.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-12
- Publication Date
- 2024-12-03
- Estimated Expiration
- 2044-08-12
AI Technical Summary
Underwater vehicles are difficult to maintain stable heading under hovering state. Due to the influence of ocean current interference, the existing PID control methods cannot accurately control the course of constant interference, and there are constant errors and frequent actions.
By establishing the linear motion equation of the hover horizontal plane of the underwater vehicle, designing the state observer model and heading controller model, considering marine environmental interference, and performing discrete control instructions to reduce energy consumption and achieve high-precision directional control.
It realizes high-precision directional control in hovering state of underwater vehicles, reduces the impact of ocean current interference, reduces the operating frequency of actuator motors, and reduces energy consumption.
Smart Images

Figure CN118625842B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of control of non-electrical variables, and in particular to a method for controlling the orientation of an underwater vehicle in a hovering state. Background Art
[0002] Depending on the mission, underwater vehicles are divided into large-scale sea area cruising submersibles and small-scale fixed-point detection submersibles in a hovering state. Tasks such as seafloor hydrothermal vents, deep-sea mineral resources and marine environment detection all have a huge demand for hovering submersibles. When a hovering submersible detects in a fixed-point detection state and needs to maintain its heading, it is often affected by the interference of ocean currents and cannot maintain a stable heading. At present, the heading control of underwater vehicles mainly relies on the PID control method. Although this method can achieve stable heading in a hovering state, when there is constant interference, it is impossible to estimate the size of the external interference, there will be constant errors and frequent movements, and when maintaining the heading, it is impossible to accurately control the influence of ocean current interference. Summary of the invention
[0003] The technical problem to be solved by the present invention is to provide a method for controlling the orientation of an underwater vehicle in a hovering state, which can accurately control the heading and suppress the influence of ocean current interference to meet the requirements for heading control during the detection process of the underwater vehicle in a hovering state.
[0004] The present invention is achieved through the following technical solutions:
[0005] A method for controlling the orientation of an underwater vehicle in a hovering state comprises the following steps:
[0006] S1: Establish the linear motion equation of the underwater vehicle hovering in the horizontal plane;
[0007] S2: Establish a state observer model for the linear motion equation of the underwater vehicle hovering on the horizontal plane, and extract the motion state signal of the underwater vehicle according to the state observer model;
[0008] S3: Considering the interference of the marine environment, a heading controller model of the underwater vehicle in the hovering state is established;
[0009] S4: Discretize the continuous control instructions of the heading controller of the underwater vehicle in the hovering state, and control the action of the actuator motor according to the discretization result to control the heading of the underwater vehicle.
[0010] Furthermore, the linear motion equation of the underwater vehicle hovering in the horizontal plane established in step S1 is formula (1):
[0011] (1);
[0012] in: is the lateral velocity of the underwater vehicle in the ship coordinate system, is the angular velocity of the underwater vehicle in the ship coordinate system, represents the rotational angular acceleration of the underwater vehicle in the ship coordinate system, represents the lateral acceleration of the underwater vehicle in the ship coordinate system, is the rotational angular velocity of the underwater vehicle in a fixed coordinate system; is the transverse acceleration damping coefficient in the ship coordinate system, is the hydrodynamic coefficient of the influence of the ship coordinate system rotation angular velocity on the lateral velocity, is the hydrodynamic coefficient of the influence of the lateral velocity on the turning angular velocity in the ship coordinate system, is the angular velocity damping coefficient in the ship coordinate system, is the influence coefficient of thrust on lateral velocity in the ship coordinate system, is the influence coefficient of thrust on the angular velocity of rotation in the ship coordinate system, is the influence coefficient of the ocean disturbance torque on the rotation angular velocity in the ship coordinate system; is the ocean disturbance moment; The steering torque generated by the slewing thruster.
[0013] Further, step S2 designs a state observer model for the linear motion equation of the underwater vehicle hovering on the horizontal plane as follows:
[0014] S21: Derivative the linear motion equation of the underwater vehicle hovering on the horizontal plane and ignore the high-order small terms to obtain equation (2):
[0015] (2);
[0016] in: is the known angular acceleration of the underwater vehicle in the fixed coordinate system during the state turning process in the hovering state, is the angular velocity of rotation in a fixed coordinate system, is the absolute value of the angular velocity in the fixed coordinate system, is the angular velocity damping coefficient in the fixed coordinate system, As the dominant water power, is the influence coefficient of thrust on the rotational angular velocity in a fixed coordinate system;
[0017] S22: According to formula (2), the state observer model is established as formula (3):
[0018] (3);
[0019] in: represents the observed rotational angular velocity of the underwater vehicle in a fixed coordinate system, represents the actual heading of the underwater vehicle in a fixed coordinate system, represents the observed heading of the underwater vehicle in a fixed coordinate system, represents the observed rotational angular acceleration in the ship coordinate system, represents the observed rotational angular velocity of the underwater vehicle in the ship coordinate system, represents the observation gain of the observed heading, represents the observation gain of the observed rotation angular velocity, represents the observation gain of the intermediate variable of the observed torque, represents the observation gain of the observation torque, represents the intermediate process variable of the torque, Indicates the observed real-time disturbance torque change speed, represents the observed disturbance torque.
[0020] Furthermore, the heading controller model of the underwater vehicle in the hovering state established in step S3 is formula (4):
[0021] (4);
[0022] in: represents the calculated thrust of the controller during directional control of the underwater vehicle, represents the balance component used to offset the disturbance torque of the ocean current, It represents the thrust used to stabilize the heading of the underwater vehicle during directional control. represents the heading deviation control coefficient, represents the hydrodynamic coefficient of the turning rate, The command heading.
[0023] Furthermore, in step S4, the continuous control command of the heading controller of the underwater vehicle in the hovering state is discretized according to formula (5):
[0024] (5);
[0025] in: Indicates the thrust control switch signal, Indicates thrust dead zone, Indicates the thrust starting value, Indicates the thrust change used to stabilize the heading during the underwater vehicle's directional control at the previous moment.
[0026] Beneficial effects of the invention:
[0027] The present invention provides a method for controlling the orientation of an underwater vehicle in a hovering state. By establishing a heading controller model for the underwater vehicle in the hovering state, the influence of ocean current interference can be compensated, thereby achieving high-precision orientation control of the underwater vehicle in the hovering state. At the same time, by discretizing the continuous control instructions of the heading controller of the underwater vehicle in the hovering state, the frequency of operation is reduced, thereby reducing energy consumption, and the method is more suitable for applications in which the underwater vehicle is precisely oriented in the hovering state. BRIEF DESCRIPTION OF THE DRAWINGS
[0028] Figure 1 It is a schematic diagram of the process of the present invention. DETAILED DESCRIPTION
[0029] A method for controlling the orientation of an underwater vehicle in a hovering state, the flow chart of which is as follows Figure 1 As shown, the specific steps include:
[0030] S1: According to the hovering condition of the underwater vehicle, the linear motion equation of the underwater vehicle hovering in the horizontal plane is established;
[0031] Specifically, the established linear motion equation of the underwater vehicle hovering in the horizontal plane is formula (1):
[0032] (1);
[0033] in: is the lateral velocity of the underwater vehicle in the ship coordinate system, is the angular velocity of the underwater vehicle in the ship coordinate system, represents the rotational angular acceleration of the underwater vehicle in the ship coordinate system, represents the lateral acceleration of the underwater vehicle in the ship coordinate system, is the rotational angular velocity of the underwater vehicle in a fixed coordinate system; is the transverse acceleration damping coefficient in the ship coordinate system, is the hydrodynamic coefficient of the influence of the ship coordinate system rotation angular velocity on the lateral velocity, is the hydrodynamic coefficient of the influence of the lateral velocity on the turning angular velocity in the ship coordinate system, is the angular velocity damping coefficient in the ship coordinate system, is the influence coefficient of thrust on lateral velocity in the ship coordinate system, is the influence coefficient of thrust on the angular velocity of rotation in the ship coordinate system, is the influence coefficient of the ocean disturbance torque on the rotation angular velocity in the ship coordinate system; is the ocean disturbance moment; The steering torque generated by the slewing thruster.
[0034] By expanding the Taylor series for the standard motion model of the underwater vehicle, retaining the linear terms, and establishing the linear state equation, we can obtain equation (1). Since the speed of the underwater vehicle in the hovering state is relatively low, the motion model of the lateral velocity v in the interval of [-0.1, 0.1] m / s is linearized. The linearize function is used in the software MATLAB to obtain the linearized state equation, which can be realized. , , , , , , S2: Establish a state observer model for the linear motion equation of the underwater vehicle hovering on the horizontal plane, and extract the motion state signal of the underwater vehicle according to the state observer model;
[0035] The specific process of designing the state observer model for the linear motion equation of the underwater vehicle hovering on the horizontal plane is as follows:
[0036] S21: Derivative the linear motion equation of the underwater vehicle hovering on the horizontal plane and ignore the high-order small terms to obtain equation (2):
[0037] (2);
[0038] in: is the known angular acceleration of the underwater vehicle in the fixed coordinate system during the state turning process in the hovering state, is the angular velocity of rotation in a fixed coordinate system, is the absolute value of the angular velocity in the fixed coordinate system, is the angular velocity damping coefficient in the fixed coordinate system, As the dominant water power, is the influence coefficient of thrust on the rotational angular velocity in a fixed coordinate system;
[0039] S22: According to formula (2), the state observer model is established as formula (3):
[0040] (3);
[0041] in: represents the observed rotational angular velocity of the underwater vehicle in a fixed coordinate system, represents the actual heading of the underwater vehicle in a fixed coordinate system, represents the observed heading of the underwater vehicle in a fixed coordinate system, represents the observed rotational angular acceleration in the ship coordinate system, represents the observed rotational angular velocity of the underwater vehicle in the ship coordinate system, represents the observation gain of the observed heading, represents the observation gain of the observed rotation angular velocity, represents the observation gain of the intermediate variable of the observed torque, represents the observation gain of the observation torque, represents the intermediate process variable of the torque, Indicates the observed real-time disturbance torque change speed, represents the observed disturbance torque.
[0042] When the observed value deviates from the actual value, the observed value converges at a certain speed, and each observation gain can be determined based on experience.
[0043] Formula (3) includes two aspects: On the one hand, when the turning angular acceleration is observed in the ship coordinate system and When there is a deviation, observe the disturbance torque No convergence, at this time according to the observed interference torque based on the rotational angular acceleration deviation and the observed torque observation gain The multiplication result approaches the convergence direction. On the other hand, observe the real-time disturbance torque change speed Equal to the observed disturbance torque Multiply the observation gain by the observation torque , achieving the effect of first-order linear filtering of the observed disturbance torque.
[0044] S3: Considering the interference of the marine environment, a heading controller model of the underwater vehicle in the hovering state is established;
[0045] Specifically, the established heading controller model of the underwater vehicle in the hovering state is formula (4):
[0046] (4);
[0047] in: represents the calculated thrust of the controller during directional control of the underwater vehicle, represents the balance component used to offset the disturbance torque of the ocean current, It represents the thrust used to stabilize the heading of the underwater vehicle during directional control. represents the heading deviation control coefficient, represents the hydrodynamic coefficient of the turning rate, The command heading.
[0048] When calculating the thrust of the controller for underwater vehicle directional control, two aspects are considered: The balancing component used to offset the ocean current disturbance torque can offset the effect of the ocean current disturbance torque, which can be obtained based on the above-mentioned observation disturbance torque filtering result.
[0049] and The optimal control law for the thrust used to stabilize the heading during the directional control of an underwater vehicle is designed, which can eliminate the influence of high-frequency fluctuation interference on the directional control of the underwater vehicle in the hovering state.
[0050] When an underwater vehicle needs to maintain its heading, it is often affected by ocean currents and cannot maintain a stable heading. The ocean current interference usually includes two parts: low-frequency force and high-frequency wave force. The method provided by the present invention establishes a heading controller model for an underwater vehicle in a hovering state. Low-frequency interference can be To offset the constant control force, high-frequency fluctuation interference can be The feedback control amount is limited, thereby achieving high-precision directional control of the underwater vehicle in the hovering state.
[0051] S4: Discretize the continuous control instructions of the heading controller of the underwater vehicle in the hovering state, and control the action of the actuator motor according to the discretization result to control the heading of the underwater vehicle.
[0052] Considering the requirements of the actuator action, the hysteresis loop function with dead zone can be selected as the discrete function. Specifically, the continuous control command of the heading controller of the underwater vehicle in the hovering state can be discretized according to formula (5):
[0053] (5);
[0054] in: Indicates the thrust control switch signal, Indicates thrust dead zone, Indicates the thrust starting value, Indicates the thrust change used to stabilize the heading during the underwater vehicle's directional control at the previous moment.
[0055] When satisfied When the thrust control switch signal is 1, it can be set to turn left. When the thrust control switch signal is 0, it is set to stop. When the thrust control switch signal is -1, the heading can be set to turn right.
[0056] By adopting the above method, the continuous control instructions of the heading controller of the underwater vehicle in the hovering state are discretized, and the action of the actuator motor is controlled according to the discretization result to control the heading of the underwater vehicle. This can reduce the operation frequency of the actuator motor, thereby reducing energy consumption, and is more suitable for directional applications when the underwater vehicle is in the hovering state.
[0057] In summary, the present invention provides a method for controlling the orientation of an underwater vehicle in a hovering state. A state observer model is established through the linear motion equation of the underwater vehicle in the hovering horizontal plane. Then, the motion state signal of the underwater vehicle is extracted according to the state observer model. Then, a heading controller model of the underwater vehicle in the hovering state is established. Then, the continuous control instructions of the heading controller in the hovering state of the underwater vehicle are discretized. According to the discretization result, the motor action of the actuator is controlled to control the heading of the underwater vehicle. This can compensate for the influence of ocean current interference, realize high-precision directional control of the underwater vehicle in the hovering state, and reduce the operation frequency of the actuator, thereby reducing energy consumption.
[0058] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. For those skilled in the art, the present invention may have various modifications and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.
Claims
1. A method for controlling the orientation of an underwater vehicle in a hovering state, characterized in that: The steps include: S1: Establish the linear motion equation of the underwater vehicle hovering in the horizontal plane; S2: Establish a state observer model for the linear motion equation of the underwater vehicle hovering on the horizontal plane, and extract the motion state signal of the underwater vehicle according to the state observer model; The process of designing a state observer model for the linear motion equation of an underwater vehicle hovering on a horizontal plane is as follows: S21: Derivative the linear motion equation of the underwater vehicle hovering on the horizontal plane and ignore the high-order small terms to obtain equation (2): (2); in: is the known angular acceleration of the underwater vehicle in the fixed coordinate system during the state turning process in the hovering state, is the angular velocity of rotation in a fixed coordinate system, is the absolute value of the angular velocity in the fixed coordinate system, is the angular velocity damping coefficient in the fixed coordinate system, As the dominant water power, is the influence coefficient of thrust on the rotational angular velocity in a fixed coordinate system, The steering torque generated by the slewing thruster; S22: According to formula (2), the state observer model is established as formula (3): (3); in: represents the observed rotational angular velocity of the underwater vehicle in a fixed coordinate system, represents the actual heading of the underwater vehicle in a fixed coordinate system, represents the observed heading of the underwater vehicle in a fixed coordinate system, represents the observed rotational angular acceleration in the ship coordinate system, represents the observed rotational angular velocity of the underwater vehicle in the ship coordinate system, represents the observation gain of the observed heading, represents the observation gain of the observed rotation angular velocity, represents the observation gain of the intermediate variable of the observed torque, represents the observation gain of the observation torque, represents the intermediate process variable of the torque, Indicates the observed real-time disturbance torque change speed, represents the observed disturbance torque; S3: Considering the interference of the marine environment, a heading controller model of the underwater vehicle in the hovering state is established; The established heading controller model of the underwater vehicle in the hovering state is formula (4): (4); in: represents the calculated thrust of the controller during directional control of the underwater vehicle, represents the balance component used to offset the disturbance torque of the ocean current, It represents the thrust used to stabilize the heading of the underwater vehicle during directional control. represents the heading deviation control coefficient, represents the hydrodynamic coefficient of the turning rate, is the command heading, is the influence coefficient of thrust on the angular velocity of rotation in the ship coordinate system, is the influence coefficient of the ocean disturbance torque on the rotation angular velocity in the ship coordinate system; S4: discretize the continuous control command of the heading controller of the underwater vehicle in the hovering state according to formula (5), and control the action of the actuator motor to control the heading of the underwater vehicle according to the discretization result; (5); in: Indicates the thrust control switch signal, Indicates thrust dead zone, Indicates the thrust starting value, Indicates the thrust change used to stabilize the heading during the underwater vehicle's directional control at the previous moment; When satisfied When the thrust control switch signal is 1, it can be set to turn left. When the thrust control switch signal is 0, it is set to stop. When the thrust control switch signal is -1, the heading can be set to turn right.
2. The method for controlling the orientation of an underwater vehicle in a hovering state according to claim 1, characterized in that: The linear motion equation of the underwater vehicle hovering in the horizontal plane established in step S1 is formula (1): (1); in: is the lateral velocity of the underwater vehicle in the ship coordinate system, is the angular velocity of the underwater vehicle in the ship coordinate system, represents the rotational angular acceleration of the underwater vehicle in the ship coordinate system, represents the lateral acceleration of the underwater vehicle in the ship coordinate system, is the rotational angular velocity of the underwater vehicle in a fixed coordinate system; is the transverse acceleration damping coefficient in the ship coordinate system, is the hydrodynamic coefficient of the influence of the ship coordinate system rotation angular velocity on the lateral velocity, is the hydrodynamic coefficient of the influence of the lateral velocity on the turning angular velocity in the ship coordinate system, is the angular velocity damping coefficient in the ship coordinate system, is the influence coefficient of thrust on lateral velocity in the ship coordinate system, is the influence coefficient of thrust on the angular velocity of rotation in the ship coordinate system, is the influence coefficient of the ocean disturbance torque on the rotation angular velocity in the ship coordinate system; is the ocean disturbance moment; The steering torque generated by the slewing thruster.
Citation Information
Patent Citations
Non-cable self-control underwater navigation body hovering and controlling method
CN103064422A
Ship course control method based on adaptive angular rate solution
CN118331284A
