Unmanned ship trajectory tracking control method with global fixed time stability
By designing a global fixed-time stable unmanned ship trajectory tracking control method, the problem of tracking and control of unmanned ships in complex maritime tasks is solved, precise tracking and rapid convergence within a predetermined time is achieved, and system robustness is enhanced.
Patent Information
- Application Number
- CN202410983352.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-22
- Publication Date
- 2024-11-12
AI Technical Summary
The existing unmanned ship trajectory tracking control methods are difficult to achieve fast and high-precision tracking when facing complex and emergency maritime tasks, and the convergence time of system state error tends to be infinite, which cannot meet the requirements of efficient tracking.
A global fixed-time stable unmanned ship trajectory tracking control method was designed. By designing a fixed-time speed guidance law based on the position and speed tracking error of unmanned ships, a mathematical model was established, a fixed-time interference observer was designed, and a fixed-time nerve was used. The network minimum parameter method approximates uncertain terms, and a fixed-time assisted dynamic system is designed to realize global fixed-time stable trajectory tracking control.
This method ensures that the unmanned ship accurately tracks the target trajectory within a predetermined time under unknown interference, model uncertainty and input saturation. The convergence time is independent of the initial state, greatly enhancing the robustness of the system and numerical values The simulation verifies its effectiveness.
Smart Images

Figure CN118938663A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the field of unmanned ship motion control, and in particular to a global fixed-time stable unmanned ship trajectory tracking control method. Background Art
[0002] In recent years, unmanned ships have been widely used in scientific research, environmental monitoring, marine resource exploration, and military applications due to their high cost-effectiveness, strong maneuverability, and high degree of autonomous intelligence, and have gradually become the focus of marine research. The tracking problem of unmanned ships mainly includes track tracking, path tracking, and trajectory tracking. Track tracking is the basis for studying tracking problems. Path tracking is the unmanned ship tracking a time-independent path, while trajectory tracking is tracking a parameterized path subject to time constraints. Because the latter is real-time tracking, it can better play its advantages in some special scenarios (such as emergency rescue at sea). For underactuated unmanned ships, the key to achieving trajectory tracking lies in a stable and reliable control system.
[0003] At present, the main methods of trajectory tracking include backstepping control, sliding mode control, model predictive control, etc. It is worth noting that the system state error of such methods is asymptotically stable when performing tracking control, that is, the system convergence time tends to infinity. With the improvement of tracking requirements, the above control methods cannot meet the requirements of fast and high-precision tracking, and fixed-time control technology can make up for this drawback.
[0004] The emergence of fixed-time control technology provides a new solution for unmanned ship trajectory tracking. This technology can ensure that the system state converges within a predetermined fixed time. Compared with finite-time control technology, fixed-time control has a faster convergence speed, and its convergence time is not affected by the initial conditions of the system, which is particularly important for unmanned ship trajectory tracking.
[0005] In summary, the unmanned ship trajectory tracking control system designed based on fixed-time control technology not only addresses the limitations of traditional methods, but also provides an efficient solution strategy for complex and urgent maritime missions, becoming a research hotspot and urgent need in the current field of ship tracking control. Summary of the invention
[0006] In view of the problems existing in the prior art, the present invention discloses a global fixed-time stable unmanned ship trajectory tracking control method, which specifically comprises the following steps:
[0007] Based on the position and speed tracking error of the unmanned ship, a fixed-time unmanned ship speed guidance law is designed, a mathematical model of the unmanned ship is established, and a fixed-time interference observer is designed under the condition that the external unknown interference is bounded;
[0008] The fixed-time neural network minimum parameter method is used to approximate the uncertainties of the mathematical model of the unmanned ship;
[0009] Design fixed-time auxiliary dynamic systems;
[0010] Design a global fixed-time stable trajectory tracking control strategy and perform tracking control on the unmanned ship.
[0011] Furthermore, when designing the fixed-time unmanned ship speed guidance law:
[0012] Define position and velocity tracking errors:
[0013]
[0014] Among them, x d and d is the desired position coordinate, u d and v d is the expected longitudinal and transverse speed of the ship. By deriving equations (4) and (5), we get the following formula:
[0015]
[0016] According to the fixed time theory, the following expected longitudinal and lateral speeds are designed:
[0017]
[0018] where k 1 ,k 2 ,l x1 ,l x2 ,l y1 ,l y2 are all design parameters greater than zero, 0<k 1 <1,1<k 2 , c is a constant greater than zero.
[0019] Furthermore, when designing a fixed-time disturbance observer:
[0020] The mathematical model of the unmanned ship is designed as:
[0021]
[0022] Introducing auxiliary variables in
[0023]
[0024] Where μ 1 ,μ 2 ,μ 3 ,μ 4 is the design parameter greater than zero in the disturbance observer, μ 2 >τw,max , a, b are normal numbers, satisfying: 0<a<1, b>1;
[0025] Under the condition that the external unknown disturbance is bounded, the following fixed-time disturbance observer is designed:
[0026]
[0027] Furthermore, when the fixed-time neural network minimum parameter method is used to approximate the model uncertainty:
[0028] Using the universal approximation ability of neural networks, the uncertainty term Δ u ,Δ v The definition is as follows:
[0029]
[0030] Among them, W i is the ideal network weight, h i is the output of the Gaussian function, i = u, v, ε is the approximation error of the neural network, and |ε|≤ε N ,ε N >0
[0031] The neural network minimum parameter method takes the upper bound estimate of the neural network weight as the estimated value of the neural network weight, and replaces the adjustment of the neural network weight by designing the parameter estimation adaptive law, so that φ=||W|| 2 , φ is a positive constant, is the estimated value of φ, and we define
[0032] The adaptive law of the minimum parameter learning method is designed as:
[0033]
[0034] Among them, b 1 =m 22 v d -m 11 u,γ u ,γ v ,δ u ,δ v ,ι u1 ,ι u2 ,ι v1 ,ι v2 >0 means with design parameters, κ u1 =1 / γ u ,κ u2 =1 / δ u , κ v1 =1 / γ v ,κ v2 =1 / δv .
[0035] Furthermore, the following fixed-time auxiliary dynamic system is designed:
[0036]
[0037] Where i = u, r, Δτ i =τ ic -τ i represents the difference between the ideal control input and the actual control input after the saturation of the system, n 1 ,n 2 are all positive numbers, and satisfy 0<n 1 <1,n 2 >1, Φ gi is a positive constant tending to zero.
[0038] Furthermore, when designing a global fixed-time stable trajectory tracking control strategy:
[0039] Design the following fixed-time sliding mode longitudinal propulsion controller
[0040] τ cu = τ ueq +τ uvss (15)
[0041] in,
[0042]
[0043] Design the following fixed-time sliding mode bow controller:
[0044] τ cr =τ req +τ rvss (16)
[0045] in,
[0046]
[0047] In the formula, α 1 ,α 2 ,α 3 is a design parameter greater than zero, 0<n 1 <1,n 2 >1, S u and S v is the sliding surface, which is defined as follows:
[0048]
[0049] In the formula, λ 1 ,λ 2 ,λ3 >0 is the design parameter;
[0050] Taking into account the input saturation problem, the final global fixed-time stable trajectory tracking control strategy is:
[0051]
[0052] Among them, i=u,r.
[0053] Due to the adoption of the above technical solution, the present invention provides a globally fixed-time stable unmanned ship trajectory tracking control method, which has the following beneficial effects: the method can ensure that the unmanned ship can accurately track the target trajectory within a predetermined time even in complex situations such as unknown ocean interference, model uncertainty and input saturation. In addition, the convergence time of this method is independent of the initial state of the unmanned ship, which greatly enhances the robustness of the system. In addition, the effectiveness of the method of the present invention is verified through numerical simulation experiments. The method of the present invention not only ensures the unmanned ship's ability to accurately track the trajectory when facing various challenges, but also demonstrates faster convergence speed and excellent robustness. BRIEF DESCRIPTION OF THE DRAWINGS
[0054] In order to more clearly illustrate the embodiments of the present application or the technical solutions in 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 only some embodiments recorded in the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.
[0055] Figure 1 This is a flow chart of the global fixed time stable trajectory tracking control method of the present invention.
[0056] Figure 2 The unmanned ship tracking trajectory diagram provided by the embodiment of the present invention is
[0057] Figure 3 is a position error curve diagram provided by an embodiment of the present invention
[0058] Figure 4 This is a real-time speed curve diagram provided by an embodiment of the present invention.
[0059] Figure 5 This is a control input curve diagram under saturation provided by an embodiment of the present invention.
[0060] Figure 6 is an unknown disturbance observation curve diagram provided by an embodiment of the present invention
[0061] Figure 7 is a response curve diagram of the neural network adaptive control law provided by the embodiment of the present invention
[0062] Figure 8 The tracking trajectory diagrams under different initial positions provided by the embodiment of the present invention are
[0063] Fig. 9 The position trajectory diagrams under different initial positions provided by the embodiment of the present invention are DETAILED DESCRIPTION
[0064] In order to make the technical solutions and advantages of the present invention more clear, the technical solutions in the embodiments of the present invention are clearly and completely described below in conjunction with the accompanying drawings in the embodiments of the present invention:
[0065] In order to enable those skilled in the art to better understand the scheme of the present invention, the technical scheme in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not 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 should fall within the scope of protection of the present invention.
[0066] It should be noted that the terms "first", "second", etc. in the specification and claims of the present invention and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchanged where appropriate, so that the embodiments of the present invention described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units that are clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.
[0067] like Figure 1 A global fixed-time stable unmanned ship trajectory tracking control method is shown, which specifically includes the following steps:
[0068] S1: Design the speed guidance law of the unmanned ship with fixed time;
[0069] S2: Design a fixed-time disturbance observer;
[0070] S3: Introduce the fixed-time neural network minimum parameter method to approximate the model uncertainty;
[0071] S4: Design fixed-time auxiliary dynamic systems;
[0072] S5: Based on the designed fixed-time observer, the fixed-time neural network minimum parameter method and the auxiliary dynamic system, a global fixed-time stable trajectory tracking control strategy is designed.
[0073] In the specific implementation, the three-degree-of-freedom kinematics and dynamics equations of the unmanned ship are first established considering the external unknown disturbance and the system dynamic uncertainty:
[0074]
[0075] where η = [x, y, ψ] T represents the coordinate position and heading angle of USV in the inertial coordinate system; ν = [u, v, r] T represents the velocity vector of USV in the attached coordinate system; τ w =[τ wu ,τ wv ,τ wr ] T is an external unknown time-varying unknown bounded disturbance; Δ=[Δ u ,Δ v ,Δ r ] T is the unmodeled dynamic uncertainty; R(ψ) is the rotation matrix; M = M T >0 indicates the inertia matrix, which is the superposition of the rigid body inertia matrix of the unmanned ship and the inertia matrix of the attached body; C(ν)=-C(ν) T represents the Coriolis force matrix, which contains the fluid dynamic derivative parameters obtained by sea trials; D(ν) is the damping matrix, which consists of the linear and nonlinear damping effects on the unmanned ship. The matrix is specifically expressed as follows:
[0076]
[0077] In addition, τ=[τ u ,0,τ r ] T The forces and torques provided by the underactuated USV propulsion system in the forward and turning degrees of freedom.
[0078]
[0079] Among them, i = u, r represents the two degrees of freedom of USV sway and pitch, τ i,max ,τ i,min Indicates the maximum and minimum values of the forces and moments that can be provided on the corresponding degrees of freedom.
[0080] In order to facilitate the design of the controller, the formula can be expanded as:
[0081]
[0082] in, Δu, Δv, Δr are unmodeled dynamic uncertainties, expressed as:
[0083] S1. Design the speed guidance law of the unmanned ship with fixed time:
[0084] Define position and velocity tracking errors:
[0085]
[0086] Among them, x d and d is the desired position coordinate, u d and v d is the desired longitudinal and transverse speed of the ship. By deriving equations (4) and (5), we obtain the following formula:
[0087]
[0088] According to the fixed time theory, the following expected longitudinal and lateral speeds are designed:
[0089]
[0090] Among them, k 1 ,k 2 ,l x1 ,l x2 ,l y1 ,l y2 are all design parameters greater than zero, 0<k 1 <1,1<k 2 .
[0091] c is a constant greater than zero.
[0092] S2. Design a fixed-time interference observer:
[0093] The mathematical model of the unmanned ship is written as follows:
[0094]
[0095] Introducing auxiliary variables in
[0096]
[0097] Where μ 1 ,μ 2 ,μ 3 ,μ 4 is the design parameter greater than zero in the disturbance observer, μ 2 >τ w,max, a, b are normal numbers, satisfying: 0<a<1, b>1.
[0098] Under the condition that the external unknown disturbance is bounded, the following fixed-time disturbance observer is designed:
[0099]
[0100] S3. Introduce the fixed-time neural network minimum parameter method to approximate the model uncertainty:
[0101] Using the universal approximation ability of neural networks, the uncertainty term Δ u ,Δ v The definition is as follows:
[0102]
[0103] Among them, W i is the ideal network weight, h i is the output of the Gaussian function, i = u, v, ε is the approximation error of the neural network, and |ε|≤ε N ,ε N >0.
[0104] Compared with the general RBF neural network: the neural network minimum parameter learning method takes the upper bound estimate of the neural network weight as the estimate of the neural network weight, and replaces the adjustment of the neural network weight by designing the parameter estimation adaptive law. The adaptive algorithm is simple and easy to implement in engineering. Let φ = ||W|| 2 , φ is a positive constant, is the estimated value of φ, and we define
[0105] The adaptive law of the minimum parameter learning method is designed as:
[0106]
[0107] Among them, b 1 =m 22 v d -m 11 u,γ u ,γ v ,δ u ,δ v ,ι u1 ,ι u2 ,ι v1 ,ι v2 >0 means with design parameters, κ u1 =1 / γ u ,κ u2 =1 / δ u , κ v1 =1 / γ v ,κv2 =1 / δ v .
[0108] S4. Design of fixed-time auxiliary dynamic system:
[0109] Design the following fixed-time auxiliary dynamic system:
[0110]
[0111] Where i = u, r, Δτ i =τ ic -τ i represents the difference between the ideal control input and the actual control input after the saturation of the system, n 1 ,n 2 are all positive numbers, and satisfy 0<n 1 <1,n 2 >1, Φ gi is a positive constant tending to zero.
[0112] S5. Based on the designed fixed-time observer, the fixed-time neural network minimum parameter method and the auxiliary dynamic system, a global fixed-time stable trajectory tracking control strategy is designed:
[0113] S51, the fixed time sliding mode longitudinal propulsion controller is designed as:
[0114] τ cu = τ ueq +τ uvss (15)
[0115] in,
[0116]
[0117] S52, fixed time sliding mode bow controller is designed as:
[0118] τ cr =τ req +τ rvss (16)
[0119] in,
[0120]
[0121] In the above formula, α 1 ,α 2 ,α 3 is a design parameter greater than zero, 0<n 1 <1,n 2 >1, S u and S v is the sliding surface, which is defined as follows:
[0122]
[0123] In the formula, λ 1 ,λ 2 ,λ 3 >0 is the design parameter.
[0124] Considering the input saturation problem, the final control law is:
[0125]
[0126] Among them, i=u,r.
[0127] In summary, the fixed-time interference observer and neural network minimum parameter learning method designed in the present invention have the ability to accurately estimate and effectively compensate for unknown ocean interference and model uncertainties within a preset time. The global fixed-time stable underactuated unmanned ship trajectory tracking control method designed in the present invention ensures that the unmanned ship can accurately track the predetermined trajectory within a fixed time when facing complex conditions such as unknown ocean interference, model uncertainty and input saturation. The convergence time of this method is not affected by the initial state of the unmanned ship, thereby enhancing the robustness of the system. The effectiveness of the method of the present invention was verified through numerical simulation experiments, and the results are as follows. Figure 2-9 As shown, the method of the present invention not only ensures the accurate trajectory tracking capability of the unmanned ship when facing various challenges, but also demonstrates faster convergence speed and excellent robustness.
[0128] The above description is only a preferred specific implementation manner of the present invention, but the protection scope of the present invention is not limited thereto. Any technician familiar with the technical field can make equivalent replacements or changes according to the technical scheme and inventive concept of the present invention within the technical scope disclosed by the present invention, which should be covered by the protection scope of the present invention.
Claims
1. A global fixed-time stable unmanned ship trajectory tracking control method, characterized in that include: Based on the position and speed tracking error of the unmanned ship, a fixed-time unmanned ship speed guidance law is designed, a mathematical model of the unmanned ship is established, and a fixed-time interference observer is designed under the condition that the external unknown interference is bounded; The fixed-time neural network minimum parameter method is used to approximate the uncertainties of the mathematical model of the unmanned ship; Design fixed-time auxiliary dynamic systems; Design a global fixed-time stable trajectory tracking control strategy and perform tracking control on the unmanned ship.
2. The global fixed-time stable unmanned ship trajectory tracking control method according to claim 1 is characterized by: When designing a fixed-time unmanned ship speed guidance law: Define position and velocity tracking errors: Among them, x d and d is the desired position coordinate, u d and v d is the expected longitudinal and transverse speed of the ship. By deriving equations (4) and (5), we get the following formula: According to the fixed time theory, the following expected longitudinal and lateral speeds are designed: where k1, k2, l x1 ,l x2 ,l y1 ,l y2 are all design parameters greater than zero, 0<k1<1,1<k2, c is a constant greater than zero.
3. The global fixed-time stable unmanned ship trajectory tracking control method according to claim 1 is characterized by: When designing a fixed-time disturbance observer: The mathematical model of the unmanned ship is designed as: Introducing auxiliary variables in Where μ1, μ2, μ3, and μ4 are the design parameters greater than zero in the disturbance observer, and μ2>τ w,max , a, b are normal numbers, satisfying: 0<a<1, b>1; Under the condition that the external unknown disturbance is bounded, the following fixed-time disturbance observer is designed:
4. The global fixed-time stable unmanned ship trajectory tracking control method according to claim 1 is characterized by: When the fixed-time neural network minimum parameter method is introduced to approximate the model uncertainty: Using the universal approximation ability of neural networks, the uncertainty term Δ u ,Δ v The definition is as follows: Among them, W i is the ideal network weight, h i is the output of the Gaussian function, i = u, v, ε is the approximation error of the neural network, and |ε|≤ε N ,ε N >0 The neural network minimum parameter method takes the upper bound estimate of the neural network weight as the estimated value of the neural network weight, and replaces the adjustment of the neural network weight by designing the parameter estimation adaptive law, so that φ=||W|| 2 , φ is a positive constant, is the estimated value of φ, and we define The adaptive law of the minimum parameter learning method is designed as: where b1 = m 22 v d -m 11 u, γ u , γ v , δ u , δ v , ι u1 , ι u2 , ι v1 , ι v2 > 0 are design parameters, κ u1 = 1 / γ u , κ u2 = 1 / δ u , κ v1 = 1 / γ v , κ v2 = 1 / δ v .
5. The global fixed-time stable unmanned ship trajectory tracking control method according to claim 1 is characterized by: Design the following fixed-time auxiliary dynamic system: Where i = u, r, Δτ i =τ ic -τ i It represents the difference between the ideal control input and the actual control input after the saturation system. Both n1 and n2 are positive numbers and satisfy Φ gi is a positive constant tending to zero.
6. The global fixed-time stable unmanned ship trajectory tracking control method according to claim 1 is characterized by: When designing a global fixed-time stable trajectory tracking control strategy: Design the following fixed-time sliding mode longitudinal propulsion controller t cu =t ueq +t uvss (15) in, Design the following fixed-time sliding mode bow controller: t cr =t req +t rvss (16) in, In the formula, α1, α2, α3 are the design parameters greater than zero, 0<n1<1, n2>1, S u and S v is the sliding surface, which is defined as follows: Where, λ1,λ2,λ3>0 are design parameters; Taking into account the input saturation problem, the final global fixed-time stable trajectory tracking control strategy is: Among them, i=u,r.
Citation Information
Cited By
Multi-unmanned ship cooperative target tracking game control method
CN120103871A
A game control method for cooperative target tracking of multiple unmanned vehicles
CN120103871B
