Ship trajectory tracking control method based on thrust distribution optimization matrix
Through the control method based on the thrust distribution optimization matrix, the transient overshoot and thruster saturation problems of the power positioning ship during special operations are solved, and the precise tracking and safety improvement of the power positioning ship trajectory is achieved, ensuring the stability of the system and efficient.
Patent Information
- Application Number
- CN202311312877.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-10-11
- Publication Date
- 2024-12-03
- Estimated Expiration
- 2043-10-11
AI Technical Summary
When performing special operations, existing power positioning ships reduce operating efficiency due to excessive transient overshoot, which affects safety. The thrusters reach saturation early due to uneven thrust distribution, resulting in a degradation of system performance and unable to achieve real-time accuracy. Track tracking may even cause accidents.
Adopting a ship trajectory tracking control method based on the thrust distribution optimization matrix, by defining the intermediate error variable S, the adaptive controller and thrust distribution optimization matrix A are constructed, and the control signal allocation of the thrust is optimized, ensuring the thrust equalization allocation and reducing the thrust saturation probability. , improve system performance.
It realizes accurate tracking and control of the trajectory in transient and steady state, reduces the probability of thruster saturation, improves the efficiency and safety of ship operations, and enhances the robustness and scope of application of the system.
Smart Images

Figure CN117170383B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of ship motion control. Background Art
[0002] With the continuous development of the world economy, land resources are facing the danger of increasing depletion. Since the ocean contains many biological and mineral resources and is a treasure trove of resources on which human beings depend for survival, marine resources and seabed mineral deposits have gradually become the focus of development. With the increasing demand for marine exploration and marine energy development, it is particularly important to develop marine equipment to better safeguard marine rights and interests, control marine space and develop marine resources. Compared with ships equipped with only traditional mooring systems, dynamic positioning ships have obvious advantages such as strong maneuverability and high positioning accuracy. At the same time, the positioning cost of dynamic positioning ships will not increase with the deepening of water levels, and it can also avoid the destructive impact of anchoring on the seabed. With the increasing types and number of marine engineering operations, dynamic positioning ships have been widely used to complete more complex or large-scale marine operations.
[0003] The performance problems of most existing dynamic positioning vessel trajectory tracking systems are mainly manifested in ensuring that the system's tracking error can converge to a bounded set, that is, ensuring the steady-state performance of the system, but ignoring the impact of transient performance on the system. However, when the dynamic positioning vessel completes certain special operations, excessive transient overshoot will not only reduce the ship's operating efficiency, but may also cause the ship to collide with the platform or other ships, affecting the safety of the ship's operations. In addition, in the actual application of dynamic positioning vessels, without considering complex thrust distribution methods, some thrusters may reach saturation early due to the uneven thrust distribution of the propulsion system. Input saturation may reduce system performance, make it impossible to achieve real-time and accurate tracking of the reference trajectory, and even cause system instability. In severe cases, it may also induce serious accidents. Summary of the invention
[0004] The present invention aims to solve the problems that the transient overshoot of the existing dynamic positioning ship will reduce the operating efficiency of the ship and affect the safety of the ship's operation, and the premature input saturation of the thruster will reduce the system performance. A ship trajectory tracking control method based on the thrust distribution optimization matrix is provided.
[0005] The ship trajectory tracking control method based on the thrust distribution optimization matrix includes the following steps:
[0006] Step 1: Define the intermediate error variable S under the performance boundary constraint of trajectory tracking error:
[0007]
[0008] in, is η e The first derivative ofe is the trajectory tracking error, β is a smooth bounded variable;
[0009] Step 2: Establish an adaptive controller for the thruster based on the intermediate error variable S:
[0010] u c =-r(t)T T R T (ψ)S,
[0011] Among them, u c is the desired control signal of the thruster, T is the configuration matrix of the thruster, R(ψ) is the transformation matrix between the north-east coordinate system and the hull coordinate system,
[0012]
[0013] and are the estimated values of λ and ρ respectively, λ=1 / δ, δ is the matrix TT T The minimum eigenvalue correlation quantity, ρ = λω max ,ω max is the maximum value of the marine environmental disturbance suffered by the ship, is a design parameter greater than zero,
[0014] c1, c2, l2 are all control gains,
[0015] N σ =diag[n σ1 ,n σ2 ,n σ3 ], and s i are η ei The upper and lower bounds are time-varying preset performance functions, and the expressions are as follows:
[0016]
[0017]
[0018] i=1,2,3, and s i0 are the initial values of the upper and lower bounds of the time-varying preset performance function, and s i∞ are the stable values of the upper and lower bounds of the preset performance function, respectively, i is the parameter that determines the convergence speed, t is the convergence time;
[0019] Step 3: Construct the thrust distribution optimization matrix A and the thrust distribution optimization matrix A meets the requirements in represents the jth column of TA, j = 1, 2, ..., Q, A = diag[a1, a2, ..., a Q ] is a positive definite matrix and t j is the j-th column of T;
[0020] Step 4: Use the thrust distribution optimization matrix A to improve the thruster's adaptive controller and obtain the thrust distribution optimization controller:
[0021]
[0022] Among them, u r is the actual control signal of the thruster, u m is the maximum output torque of the thruster;
[0023] Step 5: Use the thrust distribution optimization controller to obtain the actual control signal of each thruster and control each thruster separately to achieve tracking control of the ship's trajectory.
[0024] Furthermore, the above trajectory tracking error η e The expression is:
[0025] η e =η-η d ,
[0026] Where η is the actual trajectory of the ship, and η=[x,y,ψ] T , (x, y) represents the actual position coordinates of the ship, ψ∈[0,2π] is the actual heading angle of the ship, η d is the expected trajectory of the ship.
[0027] Furthermore, the above smooth bounded variable β is expressed as:
[0028] β=l1×I 3×3 -Z σ ,
[0029] Among them, I 3×3 is a 3×3 identity matrix, l1 is a constant greater than 0, Z σ =diag[z σ1 ,z σ2 ,z σ3 ], and z σi The specific expression is:
[0030]
[0031] Furthermore, the configuration matrix T of the above thruster is expressed as:
[0032]
[0033] Among them, θ j represents the thrust output angle of the jth thruster, γ j = l xj sin(θ j )-l yj cos(θ j ), l xj and l yj are the horizontal and vertical coordinates of the j-th thruster respectively. and The following adaptive law is satisfied:
[0034]
[0035]
[0036] in, and They are and The first-order derivative of , χ1 and μ1 are The correction parameters, χ2 and μ2 are Correction parameters.
[0037] Furthermore, the ship's trajectory tracking error system model is:
[0038]
[0039] Among them, M * (η)=R(ψ)MR T (ψ),
[0040]
[0041] and are η e The second and first derivatives of , τ is the control input vector of the ship, ω is the disturbance vector of the marine environment to which the ship is subjected, is the first-order derivative of η, C(υ) is the Coriolis centripetal force matrix, D(υ) is the damping coefficient matrix, M is the inertia matrix, υ=[u,v,r] T is the velocity vector of the ship in the hull coordinate system, u is the longitudinal velocity, v is the transverse velocity, and r is the bow angular velocity.
[0042] Furthermore, the transformation matrix R(ψ) between the north-east coordinate system and the hull coordinate system is:
[0043]
[0044] Furthermore, when the propulsion system of the ship is in normal condition:
[0045] τ=Tu r .
[0046] Furthermore, the values of the control gains c1, c2, and l2 are respectively:
[0047] c1=0.0005, c2=0.01, l2=0.5.
[0048] Furthermore, the above constant l1=0.2.
[0049] The ship trajectory tracking control method based on thrust distribution optimization matrix described in the present invention has the following advantages over the prior art:
[0050] (1) The present invention constructs a performance boundary based on the preset performance concept, and directly uses the performance boundary to design the time-varying barrier Lyapunov function without error conversion, so that the performance boundary can not only be selected more flexibly, but also simplifies the design process and reduces the computational complexity of the system. At the same time, the controller does not rely on the prior information of the system model parameters and the external environment interference, and has the characteristics of wide application range and better fit to the actual environment.
[0051] (2) The present invention constructs TAOM to optimize the distribution of the controller's command signals while relying solely on the thruster configuration matrix, thereby reducing the probability of thruster saturation and improving the utilization efficiency of each thruster, thereby enhancing the ship's operational capacity.
[0052] The present invention can be applied to a ship trajectory tracking control system under the constraint that some thrusters reach saturation early due to uneven thrust distribution during the operation process, thereby affecting the final operation effect. BRIEF DESCRIPTION OF THE DRAWINGS
[0053] Figure 1 It is a flow chart of the ship trajectory tracking control method based on thrust distribution optimization matrix;
[0054] Figure 2 Schematic diagram of the north-east coordinate system and the hull coordinate system. DETAILED DESCRIPTION
[0055] The following will be combined with the accompanying drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, rather than all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work belong to the scope of protection of the present invention. It should be noted that the embodiments of the present invention and the features in the embodiments can be combined with each other without conflict.
[0056] Reference Figure 1 and Figure 2 The present embodiment is specifically described. The ship trajectory tracking control method based on the thrust distribution optimization matrix described in the present embodiment is specifically as follows:
[0057] The first step is to use the center of mass of the earth as the coordinate origin O E , establish the north-east coordinate system X E Y E Z E . Take the ship's center of gravity as the coordinate origin O B Establish the hull coordinate system X B Y B Z B ,like Figure 2 As shown. Based on the above coordinate system, the ship kinematic model and dynamic model are established:
[0058] Kinematic model:
[0059] Kinetic model:
[0060] in, is the first-order derivative of η, is the actual trajectory of the ship in the north-east coordinate system, (x, y) represents the actual position coordinates of the ship, and ψ∈[0,2π] is the actual heading angle of the ship. is the first-order derivative of υ, is the velocity vector of the ship in the hull coordinate system, u is the longitudinal velocity, v is the transverse velocity, and r is the bow angular velocity. is the north-east coordinate system X E Y E Z E and the hull coordinate system X B Y B Z B The transformation matrix between them satisfies R -1 (ψ) = R T (ψ) and ||R(ψ)||=1. is the inertia matrix, is the Coriolis centripetal force matrix, is the damping coefficient matrix, is the marine environment disturbance vector of the ship, is the ship control input vector. Its specific form is:
[0061]
[0062]
[0063]
[0064]
[0065] Assuming that the entire propulsion system works normally and no faults occur, the thrust distribution of the propulsion system of the ship in three degrees of freedom can be expressed as:
[0066] τ=Tu r ,
[0067] Where T is the thruster configuration matrix and Q represents the total number of thrusters in the propulsion system, θ j represents the thrust output angle of the jth thruster, γ j = l xj sin(θ j )-l yj cos(θ j ), l xj and l yj are the horizontal and vertical coordinates of the j-th thruster, j = 1, 2, ..., Q; u r is the actual control signal of the thruster.
[0068] Given the expected trajectory η of a surface ship d and its initial states η0=[0;0;0] and υ0=[0;0;0], then the trajectory tracking error of the ship is defined as η e =η-η d , the trajectory tracking error system model of the dynamic positioning ship can be further deduced as:
[0069]
[0070] is η e The second-order derivative of and are η d The second and first derivatives of
[0071] M * (η)=R(ψ)MR T (ψ),
[0072]
[0073] And satisfy the properties λ=1 / δ, δ is the matrix TT T The minimum eigenvalue correlation quantity.
[0074] The second step is to construct the trajectory tracking error η e The performance boundary constraints are:
[0075]
[0076] in, and s i are η ei The time-varying preset performance function of the upper and lower bounds. This implementation selects a set of continuous and smooth exponential decay functions as the performance function, specifically:
[0077]
[0078]
[0079] i=1,2,3, t is the convergence time, α1=α2=α3=0.05 determines the convergence speed of the performance function,
[0080] and 2 is the initial value of the performance function;
[0081] and is the steady-state value of the performance function.
[0082] and s i It has the following properties:
[0083] 1) and s i >0 and strictly decreasing;
[0084] 2) and
[0085] Define the system intermediate error variable
[0086] Among them, β is a smooth bounded variable, and its specific expression is: β=l1×I 3×3 -Z σ ,
[0087] I 3×3is a 3×3 unit matrix; l1>0 represents an arbitrarily small constant, specifically l1=0.2; define Z σ =diag[z σ1 ,z σ2 ,z σ3 ], and z σi The specific expression is:
[0088]
[0089] Function q(η ei ) is expressed as:
[0090]
[0091] Based on the above expressions of the intermediate error variables S and β, we can obtain:
[0092]
[0093] in
[0094] In the third step, to ensure that the system trajectory tracking error meets the preset performance requirements and tracks the desired trajectory in real time, an adaptive controller is designed based on the trajectory tracking error constraints and intermediate error variables obtained in the second step without considering the physical limitations of the thruster itself:
[0095] u c =-r(t)T T R T (ψ)S,
[0096] in:
[0097]
[0098] is the design parameter and its specific value is c1>0, c2>0, l2>0 are all control gains, and their specific values are: c1=0.0005, c2=0.01, l2=0.5, u c is the desired control signal for the thruster.
[0099] definition and is the estimated value of λ and ρ, ρ = λω max And satisfy ||ω||≤ω max .
[0100] and The following adaptive law is satisfied:
[0101]
[0102]
[0103] Among them, χ1>0, χ2>0, μ1>0, μ2>0 are all correction parameters, and χ1=10 and χ2=10 determine and The convergence rate of μ1=0.1 and μ2=0.1 are used to avoid or and The initial values are and
[0104] N σ =diag[n σ1 ,n σ2 ,n σ3 ] and n σi The specific expression is:
[0105]
[0106] Step 4: Design the thrust allocation optimization matrix (TAOM) A:
[0107] The command signal of individual thrusters calculated by the controller designed in the third step may exceed the rated upper limit value that it can output, which is not allowed by the physical limitations of the thruster itself. In the field of control, this is called input saturation. When the control force exceeds the saturation limit, due to the limitation of the saturated nonlinear function, the thrust provided by the thruster cannot reach the expected calculation, reducing the performance of the control system and failing to meet the expected positioning requirements. However, this phenomenon may be caused by the imbalance of thrust distribution, that is, one or some thrusters have reached the saturation state, while other thrusters working together have not reached saturation, but have not been assigned more control commands. Therefore, it is necessary to further optimize the distribution of the controller's command signal in order to improve the operation effect of the ship.
[0108] because:
[0109]
[0110] u rj is the actual control signal of the j-th thruster, Indicates T T The sum of the absolute values of all elements in the jth row, t j is the j-th column of T, || || ∞ represents the infinite norm of the matrix, || ||1 represents the 1-norm of the matrix, and u m is the maximum output torque of the thruster.
[0111] From this we can see that if When , the thrust of the jth thruster is much smaller than that of other thrusters, so that some thrusters have not reached saturation but have not been assigned more control commands. Therefore, if the thrust is only distributed through the thruster configuration matrix T, the thrust commands of the ship propulsion system cannot be evenly distributed. For high-performance ships with high dynamic positioning requirements, the optimal thrust distribution effect is not achieved, which will reduce the overall performance of the ship and even affect the stability of the ship's operation.
[0112] In order to overcome this problem, the thrust distribution optimization matrix A is constructed in the designed adaptive controller to evenly distribute the thrust instructions of the propulsion system. Always holds, where represents the jth column of the matrix TA, A = diag[a1,a2,...,a Q ] is a positive definite matrix and The structure of TAOM can effectively reduce the probability of propeller saturation while improving the utilization efficiency of each propeller, thereby improving the safety and reliability of ship operations.
[0113] The fifth step is to improve the controller and obtain a new thrust distribution optimization controller based on the TAOM constructed in the fourth step:
[0114]
[0115] In the sixth step, the thrust distribution optimization controller is used to obtain the actual control signal of each thruster and control each thruster separately to achieve tracking control of the ship's trajectory.
[0116] This embodiment obtains a dynamic positioning vessel trajectory tracking preset performance control method based on TAOM optimization allocation through Matlab simulation, which can realize balanced distribution of control instructions for the dynamic positioning vessel propulsion system and maximize the control range under the condition of bounded control torque, and meet the global preset performance constraints of trajectory tracking error.
[0117] In summary, the present invention enables the thruster to fully utilize the available driving power to complete different types of operation requirements by simply adjusting parameters, has better robustness and a wider range of applicability, and can effectively improve the safety and reliability of the dynamic positioning ship operation. And by constructing TAOM, the controller's command signal is optimized and allocated only when relying on the thruster configuration matrix, the probability of the thruster input saturation phenomenon is reduced as much as possible, and the transient performance and steady-state performance constraints of the entire ship operation process are further ensured to be met.
[0118] Although the present invention is described herein with reference to specific embodiments, it should be understood that these embodiments are merely examples of the principles and applications of the present invention. It should therefore be understood that many modifications may be made to the exemplary embodiments and that other arrangements may be devised without departing from the spirit and scope of the present invention as defined by the appended claims. It should be understood that the various dependent claims and features described herein may be combined in a manner different from that described in the original claims. It should also be understood that the features described in conjunction with a single embodiment may be used in other described embodiments.
Claims
1. A ship trajectory tracking control method based on thrust distribution optimization matrix, characterized in that: The following steps are involved: Step 1: Define the intermediate error variable S under the performance boundary constraint of trajectory tracking error: in, is η e The first derivative of e is the trajectory tracking error, β is a smooth bounded variable; Step 2: Establish an adaptive controller for the thruster based on the intermediate error variable S: u c =-r(t)T T R T (ψ)S, Among them, u c is the desired control signal of the thruster, T is the configuration matrix of the thruster, R(ψ) is the transformation matrix between the north-east coordinate system and the hull coordinate system, and are the estimated values of λ and ρ respectively, λ=1 / δ, δ is the matrix TT T The minimum eigenvalue correlation quantity, ρ = λω max ,ω max is the maximum value of the marine environmental disturbance suffered by the ship, is a design parameter greater than zero, c1, c2, l2 are all control gains, η is the actual trajectory of the ship, is the Coriolis centripetal force matrix, M is the inertia matrix, M * (η)=R(ψ)MR T (ψ), D(υ) is the damping coefficient matrix, η d is the expected trajectory of the ship, N σ =diag[n σ1 ,n σ2 ,n σ3 ], and σ i are η ei The upper and lower bounds are time-varying preset performance functions, and the expressions are as follows: i=1,2,3, and σ i0 are the initial values of the upper and lower bounds of the time-varying preset performance function, and σ i∞ are the stable values of the upper and lower bounds of the preset performance function, respectively, i is the parameter that determines the convergence speed, t is the convergence time; Step 3: Construct the thrust distribution optimization matrix A and the thrust distribution optimization matrix A meets the requirements in represents the jth column of TA, j = 1, 2, ..., Q, A = diag[a1, a2, ..., a Q ] is a positive definite matrix and t j is the j-th column of T; Step 4: Use the thrust distribution optimization matrix A to improve the thruster's adaptive controller and obtain the thrust distribution optimization controller: Among them, u r is the actual control signal of the thruster, u m is the maximum output torque of the thruster; Step 5: Use the thrust distribution optimization controller to obtain the actual control signal of each thruster and control each thruster separately to achieve tracking control of the ship's trajectory.
2. The ship trajectory tracking control method based on thrust distribution optimization matrix according to claim 1 is characterized in that: The trajectory tracking error η e The expression is: or e =th-th d , where η = [x, y, ψ] T , (x, y) represents the actual position coordinates of the ship, and ψ∈[0,2π] is the actual heading angle of the ship.
3. The ship trajectory tracking control method based on thrust distribution optimization matrix according to claim 1 or 2, characterized in that: The smooth bounded variable β is expressed as: β=l1×I 3×3 -WITH σ , Among them, I 3×3 is a 3×3 identity matrix, l1 is a constant greater than 0, Z σ =diag[z σ1 ,z σ2 ,z σ3 ], and z σi The specific expression is:
4. The ship trajectory tracking control method based on thrust distribution optimization matrix according to claim 1 is characterized in that: The configuration matrix T of the thruster is expressed as: Among them, θ j represents the thrust output angle of the jth thruster, γ j = l xj sin(θ j )-l yj cos(θ j ), l xj and l yj are the horizontal and vertical coordinates of the j-th thruster respectively.
5. The ship trajectory tracking control method based on thrust distribution optimization matrix according to claim 1 is characterized in that: Said and The following adaptive law is satisfied: in, and They are and The first-order derivative of , χ1 and μ1 are The correction parameters, χ2 and μ2 are Correction parameters.
6. The ship trajectory tracking control method based on thrust distribution optimization matrix according to claim 2 is characterized in that: The ship's trajectory tracking error system model is: in, and are η e The second and first derivatives of , τ is the control input vector of the ship, ω is the disturbance vector of the marine environment to which the ship is subjected, is the first-order derivative of η, υ=[u,v,r] T is the velocity vector of the ship in the hull coordinate system, u is the longitudinal velocity, v is the transverse velocity, and r is the bow angular velocity.
7. The ship trajectory tracking control method based on thrust distribution optimization matrix according to claim 6 is characterized in that: The transformation matrix R(ψ) between the north-east coordinate system and the ship coordinate system is:
8. The ship trajectory tracking control method based on thrust distribution optimization matrix according to claim 6 is characterized in that: When the ship's propulsion system is in normal condition: τ=You r .
9. The ship trajectory tracking control method based on thrust distribution optimization matrix according to claim 1, characterized in that: The values of control gains c1, c2, and l2 are: c1=0.0005, c2=0.01, l2=0.
5.
10. The ship trajectory tracking control method based on thrust distribution optimization matrix according to claim 3, characterized in that: Constant l1=0.2.
