Ship fixed time trajectory tracking control method based on variable gain time-varying sliding mode
By adopting variable gain time-varying sliding mode technology in unmanned ship control, combining global terminal sliding mode and integral sliding mode, the double-layer integral variable gain time-varying sliding mode function is designed, which solves the problem of unmanned ships being unable to track stably within a fixed time. The problem of rapid convergence and high-precision tracking are achieved, reducing energy consumption and improving working performance.
Patent Information
- Application Number
- CN202410936301.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-12
- Publication Date
- 2024-11-05
AI Technical Summary
The existing unmanned ship control method cannot be stable within a fixed time, and the constant coefficient gain controller causes excessive control force, which increases energy consumption and economic problems.
The ship fixed time tracking control method based on variable gain time-varying sliding mode is adopted, combined with global terminal sliding mode and integral sliding mode technology, a double-layer integrated variable gain time-varying sliding mode function is designed, and the controller gain changes with error, providing rapid convergence. and high-precision tracking.
The controller is rapidly converged and high-precision tracking, which reduces energy consumption, ensures stability within the expected time, and improves the working performance of the ship.
Smart Images

Figure CN118897548A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of ship intelligent technology, and in particular to a ship fixed-time trajectory tracking control method based on a variable-gain time-varying sliding mode. Background Art
[0002] With the rapid development of modern science and technology, people's demand for ship intelligence is gradually increasing. Ship intelligence covers all areas related to ships. Ship autonomous control can improve the autonomy, flexibility and safety of ships and reduce operating costs. Therefore, it plays a huge role in various application scenarios such as fishery farming, water quality testing, marine geological surveys, maritime patrols, maritime rescue and military operations. Since ship autonomous control needs to complete fixed tasks autonomously without human operation, the external interference in its working environment and its own limited energy reserves will affect its working performance. Therefore, it is necessary to design a more superior control method to reduce the sensitivity of unmanned ships to external interference and improve their efficiency in executing tasks.
[0003] Existing methods can achieve tracking errors that tend to infinity over time and approach zero infinitely, but the convergence time cannot be guaranteed. Some methods can achieve system stability in a finite time, but this finite time cannot be guaranteed to be the shortest convergence time that the controller can achieve, and thus cannot guarantee that the system will be stable within the expected fixed time. In addition, the gain coefficient in the controller has an important influence on the size of the control force. The gain coefficient in the existing controller is mostly a fixed value. In order to achieve faster tracking of the target trajectory, a larger gain is usually selected, which will result in a larger control force, resulting in increased energy consumption of the ship and reduced economic efficiency. Summary of the invention
[0004] In view of this, the purpose of the present invention is to propose a ship fixed time trajectory tracking control method based on variable gain time-varying sliding mode, so as to solve the problem that the controller of the existing unmanned ship control method cannot converge at a fixed time and the control force caused by the constant coefficient gain controller is large. The present invention mainly uses time-varying recursive sliding mode technology, global terminal sliding mode technology and integral sliding mode technology to design a ship fixed time trajectory tracking control method based on variable gain time-varying sliding mode, and at the same time achieves the performance goals of ship fixed time trajectory tracking and high-precision trajectory tracking, providing theoretical support for improving the working performance of ships.
[0005] The technical means adopted by the present invention are as follows:
[0006] A ship fixed time trajectory tracking control method based on variable gain time-varying sliding mode comprises the following steps:
[0007] S1. Establishing a motion mathematical model of the controlled ship, wherein the motion mathematical model includes kinematic equations and dynamic equations;
[0008] S2, designing variable gain time-varying sliding mode function based on global terminal sliding mode and integral sliding mode technology;
[0009] S3. Design a ship fixed-time trajectory tracking controller based on the ship motion mathematical model and variable-gain time-varying sliding mode function;
[0010] S4, completing the ship fixed time trajectory tracking control based on the ship fixed time trajectory tracking controller;
[0011] S41, according to the specific task requirements, set the mathematical expression of the target trajectory to obtain the trajectory coordinate η d ;
[0012] S42, obtain the real-time position η of the ship according to the ship's own positioning system, and then subtract it from the target trajectory coordinates to obtain the real-time tracking error η e ;
[0013] S43, real-time tracking error η e Input the fixed time trajectory tracking controller to obtain the real-time control force τ required on the three degrees of freedom of the ship c ;
[0014] S44. The ship power device provides the required real-time control force to control the controlled ship.
[0015] Furthermore, in S1:
[0016] The kinematic equation is as follows:
[0017]
[0018] The kinetic equation is as follows:
[0019]
[0020] Where η=(x,y,ψ) T is the position vector of the ship in the geodetic coordinate system; is the velocity vector of the ship in the geodetic coordinate system; υ=(u,v,r) T is the velocity vector of the ship in the body coordinate system; τ c =(τ c1 ,τ c2 ,τ c3 ) T is the control input on three degrees of freedom; τ d =(τ d1 ,τ d2 ,τ d3 )T is the unknown disturbance force on three degrees of freedom; J ψ (η) is the transformation matrix from the body coordinate system to the earth coordinate system.
[0021] Furthermore, S2 specifically includes the following steps:
[0022] Define the tracking error as η e =η-η d ; The speed tracking error is Where η and ω are the actual displacement and speed of the unmanned ship, respectively. d ,ω d are the expected displacement and velocity respectively;
[0023] The expression of the variable gain time-varying sliding mode function is:
[0024]
[0025]
[0026] Where, s1=[s 11 ,s 12 ,s 13 ] T is a time-varying sliding mode function with variable gain, s2=[s 21 ,s 22 ,s 23 ] T is a recursive sliding mode function, F(t) is a time-varying function, is the variable gain vector, a and b are positive scalars, K1=diag(k 11 ,k 12 ,k 13 ), K1 is the positive definite coefficient matrix, and F(t) is the time-varying function.
[0027] Furthermore, in S3:
[0028] The expression of the ship fixed-time trajectory tracking controller is as follows:
[0029]
[0030] in,
[0031] Furthermore, the expression of the time-varying function F(t) is as follows:
[0032]
[0033] in, is the coefficient of the function;
[0034] The steps to obtain are as follows:
[0035] Based on the expressions of the variable gain time-varying sliding mode function and the time-varying function, formula 23 is obtained:
[0036]
[0037] It can be obtained that: Q2 = -3Q3T0,
[0038] Take T0<t v , then we have formula 24:
[0039]
[0040] Solving the system of equations composed of Formula 23 and Formula 24 yields the values of Q3 and parameter p.
[0041] The present invention also provides a storage medium, which includes a stored program, wherein when the program is run, any of the above-mentioned ship fixed time trajectory tracking control methods based on variable gain time-varying sliding mode is executed.
[0042] The present invention also provides an electronic device, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes any one of the above-mentioned ship fixed-time trajectory tracking control methods based on variable gain time-varying sliding mode through the computer program.
[0043] Compared with the prior art, the present invention has the following advantages:
[0044] The present invention designs a double-layer integral variable gain time-varying sliding mode function so that the controller has the characteristics of fast convergence and high tracking accuracy. At the same time, by designing a variable gain coefficient, the gain of the controller changes with the change of the tracking error. When the error is large, the gain coefficient is large, and the controller provides a large control force to enable the ship to quickly reach the target trajectory. When the tracking error decreases, the gain of the controller will decrease accordingly, thereby reducing the control force and energy consumption, and improving the work efficiency of the ship.
[0045] In addition, the controller has a fixed-time convergence characteristic, which can achieve trajectory tracking with the expected convergence time according to the requirements of different application scenarios, greatly improving the working performance of the ship in actual application scenarios. BRIEF DESCRIPTION OF THE DRAWINGS
[0046] In order to more clearly illustrate the embodiments of the present invention 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 some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative labor.
[0047] Figure 1 It is a schematic diagram of the process of the present invention.
[0048] Figure 2 It is a schematic diagram of the three-degree-of-freedom model of the ship's horizontal plane motion according to the present invention.
[0049] Figure 3 This is a block diagram of the control system of the present invention.
[0050] Figure 4 This is a diagram showing the ship trajectory tracking effect of the present invention.
[0051] Figure 5 This is a diagram showing the effect of the three-degree-of-freedom position tracking of a ship according to the present invention.
[0052] Figure 6 This is a curve diagram of the three-degree-of-freedom position tracking error of the ship of the present invention. DETAILED DESCRIPTION
[0053] 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.
[0054] 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.
[0055] In the present invention, global sliding mode means that the sliding mode function value is always near 0, rather than far away from 0 at the beginning. The control force is actually composed of two parts, one part is used to make the tracking error converge to zero, and the other part is used to keep the error at zero after the tracking error converges to zero. For non-global sliding mode, the first part is mainly effective at the beginning, and the controller is only responsible for converging the tracking error to zero, and will not care about the influence of external interference. Only after the error converges to zero will the second part be used to offset the influence of external interference and parameter uncertainty. For global sliding mode, both parts will work at the beginning. Integral sliding mode is the characteristic of the structure of the sliding mode function s2.
[0056] like Figure 1-3 As shown, the present invention provides a ship fixed time trajectory tracking control method based on variable gain time-varying sliding mode, comprising the following steps:
[0057] S1. Establish the mathematical model of the controlled ship's motion, including kinematic and dynamic equations
[0058] S2, design a variable gain time-varying sliding mode function;
[0059] S3. Design a ship fixed-time trajectory tracking controller based on a variable gain time-varying sliding mode function.
[0060] In step S1, the mathematical model of the ship's motion is specifically:
[0061]
[0062] The above formula (1) is the ship kinematic equation, and formula (2) is the ship dynamic equation. Where η=(x, y, ψ) T is the position vector of the ship in the geodetic coordinate system; is the velocity vector of the ship in the geodetic coordinate system; υ=(u,v,r) T is the velocity vector of the ship in the body coordinate system; τ c =(τ c1 ,τ c2 ,τ c3 ) T is the control input on three degrees of freedom; τ d =(τ d1 ,τ d2 ,τ d3 ) T is the unknown disturbance force on three degrees of freedom; J ψ (η) is the transformation matrix from the body coordinate system to the earth coordinate system:
[0063]
[0064] M, C(υ), D(υ) represent the inertial force matrix, Coriolis force and centripetal force matrix, and damping matrix, respectively, and their expressions are as follows:
[0065]
[0066] Where m is the target ship mass, is the acceleration coefficient of the longitudinal force about the x-axis direction, is the acceleration coefficient of the lateral force moving along the y-axis, is the acceleration coefficient of the lateral force rotating about the z-axis, is the acceleration coefficient of the yaw moment about the z-axis, X u is the velocity coefficient of the longitudinal force about the x-axis, X uu is the second-order velocity coefficient of the longitudinal force moving along the x-axis, X uuu is the third-order velocity coefficient of the motion in the x-axis direction, Y v is the velocity coefficient of the lateral force moving in the y-axis direction, Y vv is the second-order velocity coefficient of the lateral force moving along the y-axis, Y r is the velocity coefficient of the lateral force rotating about the z-axis, Y rr is the second-order velocity coefficient of the lateral force rotating about the z-axis, Y rv is the coupling coefficient of the lateral force about the rotation in the z-axis direction and the motion in the y-axis direction, Y vr is the coupling coefficient of the lateral force about the motion in the y-axis direction and the rotation in the z-axis direction, N v is the velocity coefficient of the yaw moment about the y-axis direction, N vv is the second-order velocity coefficient of the yaw moment about the y-axis direction, N r is the velocity coefficient of the yaw moment about the z-axis, N rr is the second-order velocity coefficient of the yaw moment about the z-axis, N rv is the coupling coefficient of the yaw moment about the rotation in the z-axis direction and the motion in the y-axis direction, N vr is the coupling coefficient of the yaw moment about the motion in the y-axis direction and the rotation in the z-axis direction, x g is the longitudinal position of the target unmanned surface vehicle’s center of gravity, I z is the moment of inertia of the target ship about the z-axis.
[0067] According to formulas (1) and (2), it is transformed into the geodetic coordinate system and simplified to obtain:
[0068]
[0069] In the formula, is the coefficient matrix of the ship kinematic equation in the geodetic coordinate system; τ c (t), τ d (t) is the control force and interference force.
[0070] In the modeling process, the real hydrodynamic coefficient matrix is often difficult to measure accurately, so there is a deviation between the nominal model used in system modeling and the actual mathematical model, that is, the unknown parameter error. Represents the true parameter matrix, and uses Denote the nominal matrix, and use ΔM(η), ΔC(υ,η), ΔD(υ,η) to denote the uncertain part of the parameter, then we have Therefore, formula (7) can be further rewritten as:
[0071]
[0072] where τ l (t,υ,η)=J ψ (η)τ d +τ u (t,υ,η) is the total uncertainty of the system, which means the overall uncertainty of the system obtained by concentrating the uncertainties of each part of the system. is the equivalent disturbance force generated by the system affected by parameter uncertainty, assuming that the disturbance is bounded and satisfies:
[0073]
[0074] In addition, assuming
[0075] In step S2, the tracking error is first defined as: e =η-η d , the speed tracking error is Where η and ω are the actual displacement and speed of the unmanned ship, respectively. d ,ω d are the desired displacement and velocity respectively. The expression of variable gain time-varying sliding mode function is:
[0076]
[0077]
[0078] Where s1=[s 11 ,s 12 ,s 13 ] T is a time-varying sliding mode function with variable gain, s2=[s 21 ,s 22 ,s 23 ] Tis a recursive sliding mode function, F(t) is a time-varying function, is the variable gain vector, a is a positive scalar, K1=diag(k 11 ,k 12 ,k 13 ), K1 is a positive definite coefficient matrix, F(t) is a time-varying function, and its expression form is:
[0079]
[0080] in is the coefficient of the function, and its specific expression will be solved in S5; T0 is the fixed convergence time. For formula (10), it is necessary to select an appropriate coefficient vector so that f(t) satisfies:
[0081]
[0082] In step S3, in combination with step S1 and step S2, a fixed-time trajectory tracking controller of a fully-driven unmanned ship based on a time-varying sliding mode function is designed, and its specific expression is:
[0083]
[0084] in,
[0085] Also included: S4, designing the Lyapunov function and proving the fixed-time convergence property of the controller based on the Lyapunov stability theory.
[0086] S5. Determine the coefficient expression of the time-varying function containing a fixed time according to the convergence requirement.
[0087] In step S4, the Lyapunov function is assumed to be in the following form:
[0088]
[0089] Substituting formula (9) (12) into formula (13) and taking the derivative of formula (13), we can obtain:
[0090]
[0091] Where ||*||1 represents the first norm of a vector or matrix, ||*|| represents the second norm of a vector or matrix, It means taking the absolute value of each element of the sum vector and raising it to the power of β1-1.
[0092] This proves the finite-time stability of the controller. At the same time, combining (11), (14) and (15), we can know that V1(t) = 0, s2(t) = 0, or: the time when s2(t) converges to the origin is t0 = 0, that is, s2(t) = 0.
[0093] The following proves that the controller converges in constant time:
[0094] The system convergence to 0 includes three stages, namely: s2 converges to 0, s1 converges to 0, and the system tracking error converges to 0. Therefore, the total convergence time of the system can be expressed as T=t0+t1+t2, where t0 is the time when s2 converges to 0, t1 is the time when s1 converges to 0, and t2 is the time when the system tracking error converges to 0.
[0095] Assume that the value of s1 at time t0 is s1(t0), and after a finite time t1 converges to zero, that is, s1(t0+t1)=0, then t1 can be expressed as:
[0096]
[0097] Since s1(0)=0,t0=0, s1(t) = 0. Furthermore, the system convergence time depends only on the convergence time of the system tracking error, that is, T = t2.
[0098] Under the premise of satisfying s1(t)=s2(t)=0, according to formula (10):
[0099]
[0100] Take the Lyapunov function as:
[0101]
[0102] With (η e +F(t)) is the independent variable and the derivative with respect to time can be obtained:
[0103]
[0104] Based on formula (17) and formula (18), formula (19) can be rewritten as:
[0105]
[0106] From this we can get (η e +F(t)) converges to zero in a finite time. Solving the differential equation of formula (17) yields (η e The relationship between +F(t)) and time t is:
[0107]
[0108] Let the time for V2(t) to converge to the origin be t v , then t v It can be obtained by the following formula:
[0109]
[0110] Combined with formula (11), it can be seen that the time for the system tracking error to converge to zero should be: t2 = max(T0,t v ).
[0111] This proves that by properly choosing the fixed time T0, the controller can reach stability within a fixed time.
[0112] In step S5, the method for determining the coefficient expression of the time-varying function containing a fixed time is as follows:
[0113] According to formula (10) and formula (11), we have:
[0114]
[0115] According to the conclusion obtained in S5, without loss of generality, we take T0<t v , then:
[0116]
[0117] From the above formula (23), we can get: Q2 = -3Q3T0, Solving the system of equations composed of formulas (23) and (24) can yield the values of Q3 and parameter p, and their numerical solutions can be obtained directly by computer programming.
[0118] The present invention also provides a storage medium, which includes a stored program, wherein when the program is run, a ship fixed-time trajectory tracking control method based on a variable gain time-varying sliding mode is executed.
[0119] The present invention also provides an electronic device, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes a ship fixed-time trajectory tracking control method based on a variable gain time-varying sliding mode through the computer program.
[0120] Example
[0121] A ship model is selected for numerical simulation to verify the effectiveness of the control method.
[0122] The reference trajectory is set as follows:
[0123] x d =10sin(0.05t)
[0124] y d =10(1-cos(10t))
[0125] ψ d =0.05t
[0126] The unknown interference is assumed to be as follows:
[0127] x disturbance =1.2sin(5t)
[0128] y disturbance =0.8-1.3sin(2t-π / 3)
[0129] ψ disturbance =1.3sin(0.08t)
[0130] The control parameters in the algorithm are set as follows: T0=1.5, K1=diag(1,1,1), β1=1.1, β2=0.8, q0=1.5, q1=1.3, q2=1.01, α=1.1, a=0.1.
[0131] like Figure 4 As shown in the figure, it can be seen that the proposed ship fixed time trajectory tracking control method based on variable gain time-varying sliding mode can reach the target trajectory within a fixed time. The ship position tracking effect is shown in Figure 5 As shown, the tracking error is Figure 6 As shown, it can be seen that the proposed controller is able to track the target trajectory with high accuracy.
[0132] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or replace some or all of the technical features therein with equivalents. However, these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the scope of the technical solutions of the embodiments of the present invention.
Claims
1. A ship fixed time trajectory tracking control method based on variable gain time-varying sliding mode, It is characterized in that The steps include: S1. Establishing a motion mathematical model of the controlled ship, wherein the motion mathematical model includes kinematic equations and dynamic equations; S2, designing variable gain time-varying sliding mode function based on global terminal sliding mode and integral sliding mode technology; S3. Design a ship fixed-time trajectory tracking controller based on the ship motion mathematical model and variable-gain time-varying sliding mode function; S4, completing the ship fixed time trajectory tracking control based on the ship fixed time trajectory tracking controller; S41, according to the specific task requirements, set the mathematical expression of the target trajectory to obtain the trajectory coordinate η d ; S42, obtain the real-time position η of the ship according to the ship's own positioning system, and then subtract it from the target trajectory coordinates to obtain the real-time tracking error η e ; S43, real-time tracking error η e Input the fixed time trajectory tracking controller to obtain the real-time control force τ required on the three degrees of freedom of the ship c ; S44. The ship power device provides the required real-time control force to control the controlled ship.
2. According to the ship fixed time trajectory tracking control method based on variable gain time-varying sliding mode according to claim 1, It is characterized in that In S1: The kinematic equation is as follows: The kinetic equation is as follows: Where η=(x,y,ψ) T is the position vector of the ship in the geodetic coordinate system; is the velocity vector of the ship in the geodetic coordinate system; υ=(u,v,r) T is the velocity vector of the ship in the body coordinate system; τ c =(τ c1 ,τ c2 ,τ c3 ) T is the control input on three degrees of freedom; τ d =(τ d1 ,τ d2 ,τ d3 ) T is the unknown disturbance force on three degrees of freedom; J ψ (η) is the transformation matrix from the body coordinate system to the earth coordinate system.
3. The ship fixed time trajectory tracking control method based on variable gain time-varying sliding mode according to claim 2, It is characterized in that S2 specifically includes the following steps: Define the tracking error as η e =η-η d ; The speed tracking error is Where η and ω are the actual displacement and speed of the unmanned ship, respectively. d ,ω d are the expected displacement and velocity respectively; The expression of the variable gain time-varying sliding mode function is: Among them, s 1 =[s 11 ,s 12 ,s 13 ] T is a time-varying sliding mode function with variable gain, s 2 =[s 21 ,s 22 ,s 23 ] T is a recursive sliding mode function, F(t) is a time-varying function, is the variable gain vector, a and b are positive scalars, K 1 =diag(k 11 ,k 12 ,k 13 ), K 1 is a positive definite coefficient matrix, and F(t) is a time-varying function.
4. The ship fixed time trajectory tracking control method based on variable gain time-varying sliding mode according to claim 3, It is characterized in that In S3: The expression of the ship fixed-time trajectory tracking controller is as follows: in, 5. The ship fixed time trajectory tracking control method based on variable gain time-varying sliding mode according to claim 3, It is characterized in that The expression of the time-varying function F(t) is as follows: in, is the coefficient of the function; The steps to obtain are as follows: Based on the expressions of the variable gain time-varying sliding mode function and the time-varying function, formula 23 is obtained: Get: Q 2 =-3Q 3 T 0 , Take T 0 <t v , then we have formula 24: Solving the equations composed of Formula 23 and Formula 24, we can get Q 3 and the value of the parameter p.
6. A storage medium, It is characterized in that The storage medium includes a stored program, wherein when the program is run, the ship fixed-time trajectory tracking control method based on variable gain time-varying sliding mode described in any one of claims 1 to 5 is executed.
7. An electronic device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, It is characterized in that The processor executes the ship fixed-time trajectory tracking control method based on variable gain time-varying sliding mode as described in any one of claims 1 to 5 through the computer program.
