Optimal control algorithm for nonlinear systems, feedback control method for surface craft performance-guaranteed dynamic positioning and dynamic positioning control method

Through the optimal control algorithm for nonlinear systems, the feedback control gain is calculated, and the problems of high cost and inaccurate positioning in the deep-sea environment are solved, and stable and reliable surface boat positioning is achieved, which is suitable for surface fixed pointing under different conditions Operation.

CN114460837BActive Publication Date: 2024-12-06HARBIN ENG UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202111049360.7
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2021-09-08
Publication Date
2024-12-06
Estimated Expiration
2041-09-08

AI Technical Summary

Technical Problem

Traditional anchor positioning is complex in deep-sea environments and is difficult to achieve accurate point operations. The existing technology fails to effectively consider the impact of marine wind and wave flow and actuator saturation input, making it difficult for surface boats to maintain specific positions.

Method used

The optimal control algorithm for nonlinear systems is used to convert it into preset performance indicators. By calculating feedback control gains K1 and K2, the performance-saving power positioning feedback control of the surface boat is realized. The specific steps include collecting the state quantity and calculating the difference value. , calculate feedback control gain and distribute thruster power.

Benefits of technology

It realizes small calculation volume, stable and reliable surface boat positioning, reduces the controller performance requirements, takes into account environmental interference, improves the control response speed and positioning accuracy, and is suitable for surface fixed-point operations under different conditions.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114460837B_ABST
    Figure CN114460837B_ABST
Patent Text Reader

Abstract

A method for providing an optimal control algorithm for a nonlinear system, a method for feedback control gain of a surface boat for dynamic positioning, and a method for dynamic positioning control, relate to the technical field of surface boats. In the prior art, in order to keep a surface boat at a specific position in the ocean, anchoring positioning is usually adopted, but due to the influence of ocean waves and the limited saturation input of the actuator, the surface boat will have the problem of difficulty in fixed-point operation. The technical solution adopted in the present application is: input the state quantity of the desired position and heading angle of the surface boat; input the maximum power value of the surface boat propeller; calculate the feedback control gain K1 by the difference between the state quantity of the actual position and heading angle of the surface boat and the state quantity of the desired position and heading angle; calculate the feedback control gain K2 according to the maximum power value of the propeller; obtain the feedback control gain K according to K1 and K2; distribute the power of each propeller according to the feedback control gain calculation result to realize the dynamic positioning control of the surface boat. It is suitable for fixed-point operations on the surface under different conditions.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of surface boats, and in particular to a performance-guaranteed dynamic positioning control method for a surface boat. Background Art

[0002] In the traditional marine field, in order to keep the surface vessel in a specific position in the ocean, anchoring positioning is usually used. Anchoring positioning is a commonly used positioning method with low investment and operating costs and easy use and maintenance, but the system itself has limitations. When the water depth exceeds 600 meters, the cost and feasibility of the anchoring method become more complicated, which can no longer meet the requirements of surface vessel positioning in the modern marine environment. In addition, surface vessels often need to perform fixed-point operations when actually performing marine environmental monitoring, marine mapping and other tasks. However, due to the influence of ocean wind and wave currents and the limited saturation input of actuators, surface vessels will have difficulty in performing accurate positioning operations. Therefore, the complexity of the water surface environment and the urgency of practical needs have made dynamic positioning technology widely concerned by researchers. Summary of the invention

[0003] The prior art method for maintaining a specific position of a surface vessel in the ocean does not take into account the influence of ocean wind and wave currents and the limited input of actuator saturation. The present invention proposes a method with small calculation amount, stable and reliable, and low requirements on controller performance. The specific scheme adopted is:

[0004] An optimal control algorithm for a nonlinear system, the algorithm is: converting the optimal control algorithm into a preset performance index; specifically: the preset performance index is an inequality:

[0005]

[0006] Among them, y is the system output state quantity, T is the transpose of the matrix and vector, γ is a constant and γ>0.

[0007] A device for providing an optimal control algorithm for a nonlinear system, the device comprising:

[0008] A preset index module, used to convert the optimal control algorithm into a preset performance index;

[0009] The preset indicator module includes the following inequality:

[0010]

[0011] A surface vessel performance-guaranteed dynamic positioning feedback control method implemented based on the above algorithm comprises:

[0012] The step of collecting the state quantities of the actual position and the actual heading angle of the surface vessel;

[0013] The step of respectively obtaining the state quantity of the actual position and the expected position and the difference between the state quantity of the actual heading angle and the expected heading angle;

[0014] A step of calculating and obtaining a feedback control gain K1 according to the two differences;

[0015] The step of calculating the feedback control gain K2 according to the maximum power value of the surface craft propeller;

[0016] The step of obtaining the feedback control gain K is based on the crossover range of K1 and K2.

[0017] Furthermore, the method for calculating and obtaining the feedback control gain K1 is: according to the two differences, the feedback control gain K1 is calculated and obtained by using the method of the optimal control algorithm of a nonlinear system.

[0018] Further, the method for calculating the feedback control gain K2 is:

[0019] By formula:

[0020] τ(t)=K2x(t)

[0021] Where τ(t) is the real-time thrust at time t, and x(t) is the difference between the actual position and heading angle of the surface craft at time t and the expected position and heading angle.

[0022] A surface vessel performance-maintaining dynamic positioning feedback control device, the device comprising:

[0023] The state quantity acquisition module is used to acquire the state quantity of the actual position and actual heading angle of the surface vessel;

[0024] A difference calculation module is used to calculate the difference between the actual position collected by the state quantity collection module and the expected position and the difference between the heading angle collected by the state quantity collection module and the expected heading angle;

[0025] The preset indicator module includes:

[0026] A difference feedback calculation submodule, used for calculating and obtaining a feedback control gain K1 according to the calculation results of the two difference calculation modules;

[0027] A power feedback calculation submodule is used to calculate a feedback control gain K2 according to the maximum power value input by the thrust input module;

[0028] The feedback control gain solving submodule is used to obtain the feedback control gain K according to the crossover range of K1 and K2.

[0029] Furthermore, the difference feedback calculation submodule also includes: a device for providing an optimal control algorithm for a nonlinear system; and the interpolation feedback calculation submodule calculates K1 based on the two differences using the device for providing an optimal control algorithm for a nonlinear system.

[0030] Furthermore, the power feedback calculation submodule includes the formula:

[0031] τ(t)=K2x(t)

[0032] Where τ(t) is the real-time thrust at time t, and x(t) is the difference between the actual position and heading angle of the surface craft at time t and the expected position and heading angle.

[0033] A surface vessel performance-guaranteed dynamic positioning control method based on the above two methods is as follows:

[0034] The power of each propeller is distributed according to the calculation result of the feedback control gain of the surface boat's performance-maintaining dynamic positioning;

[0035] The method for calculating the gain of the surface craft performance-maintaining dynamic positioning feedback control is a surface craft performance-maintaining dynamic positioning feedback control method.

[0036] A computer device, characterized in that it includes a memory and a processor, wherein a computer program is stored in the memory, and when the processor runs the computer program stored in the memory, the processor executes an optimal control algorithm for a nonlinear system.

[0037] The present invention is beneficial in that:

[0038] 1. Only the interpolation of input information and feedback information is calculated, which reduces the amount of calculation, solves the storage space problem, and improves the control response speed.

[0039] 2. The feedback control gain result is calculated by the maximum thrust of the surface boat propeller, and the performance requirements of the surface boat controller are low.

[0040] 3. The interference of environmental factors on surface vessels is taken into consideration, and repeated calculations are performed to make the interpolation of the feedback state quantity and the input state quantity smaller and smaller.

[0041] 4. The method of converting the optimal control algorithm into a preset performance index solves the problem of providing the optimal control algorithm for a nonlinear system in the prior art.

[0042] This application is suitable for fixed-point operations on the water surface under different conditions. BRIEF DESCRIPTION OF THE DRAWINGS

[0043] Figure 1This is a flow chart of a performance-guaranteed dynamic positioning control method for a surface vessel proposed in this application.

[0044] Figure 2 This is a schematic diagram of a performance-guaranteed dynamic positioning control method for a surface vessel proposed in this application.

[0045] Figure 3 It is the horizontal motion curve of the surface craft in the eleventh embodiment of the present invention.

[0046] Among them, the horizontal axis is the x-coordinate position, the vertical axis is the y-coordinate position, and the coordinate position represents the real-time position of the two-dimensional plane.

[0047] Figure 4 This is the position and heading angle response curve of the surface craft in the eleventh embodiment of the present invention.

[0048] Among them, the vertical coordinates from top to bottom are x, y and heading angle respectively.

[0049] Figure 5 This is the response curve of the longitudinal speed, transverse drift speed and bow angular velocity of the surface craft in the eleventh embodiment of the present invention.

[0050] Among them, the vertical coordinates from top to bottom are u, v and r, and the horizontal coordinate is time.

[0051] Figure 6 This is the control torque response curve in the eleventh embodiment of the present invention.

[0052] Among them, the ordinates from top to bottom are the control inputs in the x, y and heading angle directions, and the abscissa is time. DETAILED DESCRIPTION

[0053] The present application is further explained below in conjunction with the accompanying drawings.

[0054] Implementation method 1: This implementation method provides an optimal control algorithm for a nonlinear system. The algorithm is: converting the optimal control algorithm into a preset performance index; specifically: the preset performance index is an inequality:

[0055]

[0056] Among them, y is the system output state quantity, T is the transpose of the matrix and vector, γ is a constant and γ>0.

[0057] The above formula can be expressed as:

[0058]

[0059] It is then expressed as:

[0060]

[0061] Furthermore, the above formula is transformed into:

[0062]

[0063] The value of K is solved by the above formula and is recorded as K2.

[0064] The benefit of this implementation is that it converts the difficult-to-achieve optimal controller design into a preset performance index, makes the closed-loop system stable, and satisfies a lower-bounded quadratic index.

[0065] Embodiment 2: This embodiment provides a device for an optimal control algorithm for a nonlinear system, the device comprising:

[0066] A preset index module, used to convert the optimal control algorithm into a preset performance index;

[0067] The preset indicator module includes the following inequality:

[0068]

[0069] Among them, y is the system output state quantity, T is the transpose of the matrix and vector, γ is a constant and γ>0.

[0070] Embodiment 3: This embodiment provides a method for maintaining performance of a surface vessel dynamic positioning feedback control, the method comprising:

[0071] The step of collecting the state quantities of the actual position and the actual heading angle of the surface vessel;

[0072] The step of respectively obtaining the state quantity of the actual position and the expected position and the difference between the state quantity of the actual heading angle and the expected heading angle;

[0073] A step of calculating and obtaining a feedback control gain K1 according to the two differences;

[0074] The step of calculating the feedback control gain K2 according to the maximum power value of the surface craft propeller;

[0075] The step of obtaining the feedback control gain K is based on the crossover range of K1 and K2.

[0076] The benefit of this embodiment is that the actual feedback control gain K is obtained by calculating the control feedback gain K1 of the state quantity difference of the surface ship and the control feedback gain K2 of the propeller.

[0077] Implementation method 4. This implementation method is a further limitation of the surface vessel performance-maintaining dynamic positioning feedback control method provided in implementation method 3. The method for calculating the feedback control gain K1 is: based on the two differences, it is calculated using the method of the optimal control algorithm for a nonlinear system provided in implementation method 1.

[0078] The benefit of this embodiment is that the feedback control gain can be accurately calculated according to the state quantities input and received by the surface vessel.

[0079] Embodiment 5: This embodiment further limits the surface vessel performance-maintaining dynamic positioning feedback control method provided in Embodiment 3. The method for calculating the feedback control gain K2 is:

[0080] By formula:

[0081] τ(t)=K2x(t)

[0082] Where τ(t) is the real-time thrust at time t, and x(t) is the difference between the actual position and heading angle of the surface craft at time t and the expected position and heading angle.

[0083] The above formula can be further expressed as:

[0084] ||τ|| 2 =[Kx(t)] T Kx(t)=x(t) T K T Kx(t)

[0085] By choosing the auxiliary linear matrix inequality And the Lyapunov stability theory is introduced to transform the calculation, so the matrix inequality required for the design can be obtained:

[0086]

[0087] ||τ||≤τ max

[0088] Among them, τ max is the maximum thrust value of the thruster input.

[0089] The present embodiment is advantageous in that the feedback control gain can be calculated according to the real-time thrust.

[0090] Embodiment 6: This embodiment provides a surface vessel performance-maintaining dynamic positioning feedback control device, the device comprising:

[0091] The state quantity acquisition module is used to acquire the state quantity of the actual position and actual heading angle of the surface vessel;

[0092] A difference calculation module is used to calculate the difference between the actual position collected by the state quantity collection module and the expected position and the difference between the heading angle collected by the state quantity collection module and the expected heading angle;

[0093] The preset indicator module includes:

[0094] A difference feedback calculation submodule, used for calculating and obtaining a feedback control gain K1 according to the calculation results of the two difference calculation modules;

[0095] A power feedback calculation submodule is used to calculate a feedback control gain K2 according to the maximum power value input by the thrust input module;

[0096] The feedback control gain solving submodule is used to obtain the feedback control gain K according to the crossover range of K1 and K2.

[0097] The benefit of this embodiment is that the feedback gain can be obtained according to the input module, the receiving module and the power feedback calculation submodule of the device.

[0098] Embodiment 7. This embodiment is a further limitation of a surface vessel performance-maintaining dynamic positioning feedback control device provided in embodiment 6. The difference feedback calculation submodule also includes: a device for an optimal control algorithm for a nonlinear system provided in embodiment 2; the interpolation feedback calculation submodule calculates K1 based on the two differences using the device for an optimal control algorithm for a nonlinear system.

[0099] The advantage of this embodiment is that the difference of the state quantity can be obtained by using the input module and the receiving module.

[0100] Embodiment 8: This embodiment further limits the surface vessel performance-maintaining dynamic positioning feedback control device provided in Embodiment 6. The power feedback calculation submodule includes the formula:

[0101] τ(t)=K2x(t)

[0102] Where τ(t) is the real-time thrust at time t, and x(t) is the difference between the actual position and heading angle of the surface craft at time t and the expected position and heading angle.

[0103] The benefit of this embodiment lies in that the power feedback calculation submodule can be used to calculate the feedback control gain.

[0104] Embodiment 9: This embodiment provides a method for controlling performance-guaranteed dynamic positioning of a surface vessel, the method comprising:

[0105] The power of each propeller is distributed according to the calculation result of the feedback control gain of the surface boat's performance-maintaining dynamic positioning;

[0106] The method for calculating the gain of the surface vessel performance-maintaining dynamic positioning feedback control is a surface vessel performance-maintaining dynamic positioning feedback control method provided in the third implementation mode.

[0107] The present embodiment is advantageous in that control input can be distributed according to the obtained feedback control gain.

[0108] Implementation method ten: This implementation method provides a computer device, which includes a memory and a processor. The memory stores a computer program. When the processor runs the computer program stored in the memory, the processor executes an optimal control algorithm for a nonlinear system provided in implementation method one.

[0109] Real-time mode 11, see attached Figure 2-6 This embodiment is described. This embodiment is a simulation based on a surface vessel dynamic positioning control method provided in Embodiment 9, specifically:

[0110] The feasibility and effectiveness of the method provided by this application are demonstrated for a system with external marine environment interference. Figure 2 , is a schematic diagram of this implementation, which specifically includes the following steps:

[0111] Step 1: Establish the kinematic and dynamic equations of surface craft dynamic positioning as follows:

[0112]

[0113]

[0114] where η = [x, y, ψ] T ; (x, y), ψ are the position coordinates and heading angle in the inertial coordinate system, respectively, the initial position η(0) = [20m, 20m, (10° / 180°×πrad)] T , the expected reference point η d =[0m,0m,0rad] T ; v = [u, v, r] T ; (u, v), r are the longitudinal velocity, drift velocity and yaw angular velocity respectively, initial velocity v(0) = [0m / s, 0m / s, 0rad / s] T ; h(τ) is the control torque; is the external ocean environment interference signal; J(ψ) is the rotation matrix, and its expression is:

[0115]

[0116] When the heading angle ψ of the surface vessel is very small, within 5°, for the sake of simplicity in calculation, it is approximately regarded that the heading angle ψ of the surface vessel at this time is ψ≈0°. Then at this time When ψ≈0°.

[0117] M0∈R 3×3 ,D0∈R 3×3 They are respectively part of the inertia matrix and the damping matrix, and their expressions are as follows:

[0118]

[0119]

[0120] Step 2: Design the saturation function:

[0121]

[0122] Among them, |h i |≤h imax is the maximum allowable value, and it satisfies |h i |≤h imax .

[0123] Step 3: Design the guaranteed cost controller:

[0124] τ(t)=Kx(t)

[0125] Among them, K is the feedback control gain.

[0126] Step 4: Preset the performance index:

[0127]

[0128] Among them, γ is a constant and γ>0.

[0129] Define the following functions to prove that the control algorithm can achieve the preset steady-state performance index:

[0130]

[0131] Next, define I<P and X=P -1 To simplify the calculation, the above formula can be simplified as:

[0132]

[0133] Step 5: Prove the stability of the closed-loop system through the Lyapunov stability theory. Then the Lyapunov function V is designed as:

[0134] V(x(t))=x T (t)Px(t)

[0135] According to the above formula, the linear matrix inequality required for reasonable design is derived, and we get:

[0136]

[0137]

[0138] Step 6: Solve input saturation limitation:

[0139] In actual operation, surface craft controllers are always subject to saturated control inputs and in view of this fact, precautions must be taken to deal with this limitation.

[0140] According to the formula

[0141] τ(t)=Kx(t)

[0142] The control input torque can be further written as:

[0143] ||τ|| 2 =[Kx(t)] T Kx(t)=x(t) T K T Kx(t)

[0144] By choosing the auxiliary linear matrix inequality And bring it into formula (11) to transform the calculation, so we can get the matrix inequality we need to design:

[0145]

[0146] ||τ||≤τ max

[0147] Among them, the parameter τ max =max{[1×10 5 kN,1×10 5 kN,1×10 3 kN·m] T};

[0148] The control parameters are set as before, and the system simulation is performed. Figure 3 , it can be determined that the guaranteed performance dynamic positioning control scheme accurately adjusts the position and heading of the surface vessel to the reference point. Figure 4 , respectively showing the positioning performance of the position and heading angle of the surface ship, and finally reaching the expected stable state. From the figure, it can be seen that x, y and ψ all tend to be stable at 40s. ∞ Compared with the control, the convergence speed is improved by 50s, and the transient performance is guaranteed. The boundedness and stability of the longitudinal speed, drift speed and bow angular velocity of the surface ship can be found in Figure 5As shown in the figure, it can be seen from these results that the speed response also converges quickly to a small area near zero, which is consistent with H ∞ Compared with control, the convergence state is more stable and the convergence speed is faster. Figure 6 , it can be judged that the design of the control force and torque is reasonable and bounded, according to τ max =max{[1×10 5 kN,1×10 5 kN,1×10 3 kN·m] T}, we can see that the actuator saturation constraint is not violated. ∞ Compared with the traditional H control, the proposed guaranteed cost algorithm has better chattering suppression performance and overcomes the chattering phenomenon. It can be observed intuitively from the simulation curve that the controller can still achieve balanced control of nonlinear systems even under the condition of input saturation limitation. The state variables can converge to zero quickly within 40s, and the transient performance and steady-state performance of all closed-loop signals are guaranteed. ∞ Compared with the control, the convergence speed of all closed-loop signals is increased by 50s, achieving fast and stable guaranteed cost control, and being able to overcome the influence of external marine environmental interference signals and chattering. Therefore, the control algorithm proposed in the present invention has good robustness and reliability.

Claims

1. An optimal control algorithm for a nonlinear system, characterized in that: The algorithm is: converting the optimal control algorithm into a preset performance index; specifically: the preset performance index is an inequality: Where y is the system output state quantity, T is the transpose of the matrix and vector, γ is a constant and γ>0; The above formula can be expressed as: It is then expressed as: Furthermore, the above formula is transformed into: The value of K is solved by the above formula and recorded as K2.

2. A device for providing optimal control for a nonlinear system, characterized in that: The device comprises: A preset index module, used to convert the optimal control algorithm into a preset performance index; The preset indicator module includes the following inequality: Among them, y is the system output state quantity, T is the transpose of the matrix and vector, γ is a constant and γ>0 The above formula can be expressed as: It is then expressed as: Furthermore, the above formula is transformed into: The value of K is solved by the above formula and recorded as K2.

3. A method for calculating the feedback control gain of a surface vessel's performance-guaranteed dynamic positioning, characterized in that: The method comprises: The step of collecting the state quantities of the actual position and the actual heading angle of the surface vessel; The step of respectively obtaining the state quantity of the actual position and the expected position and the difference between the state quantity of the actual heading angle and the expected heading angle; A step of calculating and obtaining a feedback control gain K1 according to the two differences; The step of calculating the feedback control gain K2 according to the maximum power value of the surface craft propeller; The step of obtaining the feedback control gain K according to the crossover range of K1 and K2; the method of calculating the feedback control gain K1 is: according to the two differences, using a nonlinear system given optimal control algorithm as described in claim 1 to calculate; the method of calculating the feedback control gain K2 is: By formula: τ(t)=K2x(t) Where τ(t) is the real-time thrust at time t, and x(t) is the difference between the actual position and heading angle of the surface craft at time t and the expected position and heading angle.

4. A surface vessel performance-maintaining dynamic positioning feedback control gain calculation device, characterized in that: The device comprises: The state quantity acquisition module is used to acquire the state quantity of the actual position and actual heading angle of the surface vessel; A difference calculation module is used to calculate the difference between the actual position collected by the state quantity collection module and the expected position and the difference between the heading angle collected by the state quantity collection module and the expected heading angle; The preset indicator module includes: A difference feedback calculation submodule, used for calculating and obtaining a feedback control gain K1 according to the calculation results of the two difference calculation modules; A power feedback calculation submodule is used to calculate the feedback control gain K2 according to the maximum power value input by the thrust input module; a feedback control gain solving submodule is used to obtain the feedback control gain K according to the crossover range of K1 and K2; the difference feedback calculation submodule also includes: a device for giving an optimal control algorithm to a nonlinear system as described in claim 2; the device for giving an optimal control algorithm to a nonlinear system calculates K1 according to the two differences using the device for giving an optimal control algorithm to a nonlinear system; the power feedback calculation submodule includes the formula: τ(t)=K2x(t) Where τ(t) is the real-time thrust at time t, and x(t) is the difference between the actual position and heading angle of the surface craft at time t and the expected position and heading angle.

5. A surface vessel dynamic positioning control method, characterized in that: The method is: The power of each propeller is distributed according to the calculation result of the feedback control gain of the surface boat's performance-maintaining dynamic positioning; The method for calculating the feedback control gain of the surface vessel's performance-maintaining dynamic positioning is the method for calculating the feedback control gain of the surface vessel's performance-maintaining dynamic positioning as described in claim 3.

6. A computer device, characterized in that: The system comprises a memory and a processor, wherein a computer program is stored in the memory, and when the processor runs the computer program stored in the memory, the processor executes an optimal control algorithm for a nonlinear system according to claim 1.