Full-drive water surface ship preset time trajectory tracking control method based on time-varying recursive sliding mode
By using time-varying recursive sliding mode technology and Liyapunov function on all-drive surface ships, the double-layer sliding mode function is solved, and the lack of tracking accuracy and convergence time of the unmanned ship controller is achieved, and rapid convergence and high Accurate trajectory tracking enhances resistance to external interference and improves the working performance of unmanned ships.
Patent Information
- Application Number
- CN202410936299.5
- 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 fully-driven surface unmanned ship controllers have shortcomings in target trajectory tracking accuracy and convergence time, and cannot effectively resist external interference and achieve stability within the preset time.
The preset time trajectory tracking control method of all-drive surface ships based on time-varying recursive sliding mode is adopted. By designing the double-layer time-varying sliding mode function and the Liyapunov function, the system is ensured to be stable within a limited time and the tracking accuracy is improved.
It realizes fast convergence and high-precision trajectory tracking, and can stably reach the target trajectory within the preset time, enhances resistance to external interference, and improves the working performance of the unmanned ship.
Smart Images

Figure CN118897547A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of ship intelligent technology, and in particular to a preset time trajectory tracking control method for a full-drive surface ship based on a time-varying recursive sliding mode. Background Art
[0002] With the increasing degree of automation in today's society, people's demand for unmanned ships is gradually increasing. Fully driven surface unmanned ships have the advantages of strong autonomy and flexibility, low cost, high safety, good concealment, etc., and are therefore widely used in fishery farming, water quality testing, marine geological surveys, maritime patrols, maritime rescue and military operations. Since unmanned ships need to complete preset tasks autonomously without human operation, the external interference in their working environment and their own limited energy reserves will affect their working performance. Therefore, it is necessary to design a more superior control algorithm 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 preset time. In addition, the current controller still has room for optimization of the tracking accuracy of the target trajectory. In summary, the existing all-drive ship trajectory tracking control method still has a lot of room for improvement. Summary of the invention
[0004] In view of this, the purpose of the present invention is to propose a preset time trajectory tracking control method for a fully-driven surface vessel based on a time-varying recursive sliding mode, so as to solve the technical problem that the existing unmanned ship controller has insufficient tracking accuracy for the target trajectory.
[0005] The technical means adopted by the present invention are as follows:
[0006] A preset time trajectory tracking control method for a fully driven surface ship based on a time-varying recursive sliding mode comprises the following steps:
[0007] S1. Select a point on the sea surface as the origin of the inertial reference system, take the due north direction as the positive direction of the longitudinal axis, take the due east direction as the positive direction of the horizontal axis, and establish the geodetic coordinate system; then take the center of gravity of the ship as the origin of the body coordinate system, take the starboard side as the positive direction, and take the bow as the positive direction to establish the body coordinate system; establish the relationship between the ship's motion and force, that is, the dynamic equation, in the body coordinate system, and then use the transformation matrix J ψ (η) Convert the motion in the body coordinate system to the earth coordinate system, i.e., the kinematic equation;
[0008] S2. Select a piecewise function, which makes the system state quantity converge to zero or a neighborhood of zero at a preset time and maintain the state; design a time-varying sliding mode function based on the piecewise function and the tracking error;
[0009] S3. Design a double-layer time-varying sliding mode function with a recursive structure based on the time-varying sliding mode function;
[0010] S4. According to the dynamic equation, kinematic equation and double-layer time-varying sliding mode function, a preset time trajectory tracking controller of the all-drive unmanned ship based on the time-varying sliding mode function is designed;
[0011] S5, using Lyapunov function to verify the stability of the preset time trajectory tracking controller of the all-drive unmanned ship; when stable, execute S6;
[0012] S6, completing the fixed time trajectory tracking control of the ship based on the preset time trajectory tracking controller of the full-drive unmanned ship;
[0013] S61, set the navigation path ηd of the ship, including the position coordinates and heading angle in the geodetic coordinate system, and give the corresponding speed at each point on the path Given the preset time T0 required for the ship to reach the target trajectory;
[0014] S62: After the control system is turned on, the current time is recorded and the current time is used as the initial time of the control system. The real-time position η of the ship is obtained according to the ship's own positioning system, and then the real-time tracking error η is obtained by subtracting the target trajectory coordinates. e ;
[0015] S63, 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 ;
[0016] S64. The ship power device provides the required real-time control force to control the controlled ship.
[0017] Furthermore, in S1:
[0018] The kinematic equation is as follows:
[0019]
[0020] The kinetic equation is as follows:
[0021]
[0022] 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.
[0023] Furthermore, S2 specifically includes the following steps:
[0024] 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;
[0025] The expression of the double-layer sliding mode function based on the recursive structure is:
[0026]
[0027]
[0028] Where s1 = [s 11 ,s 12 ,s 13 ] T is the inner sliding mode function, s2=[s 21 ,s 22 ,s 23 ] T is the outer sliding mode function, F(t) is the time-varying function, K1=diag(k 11 ,k 12 ,k 13 )、K2=diag(k 21 ,k 22 ,k 23 ), K1 and K2 are both positive definite coefficient matrices.
[0029] Furthermore, the piecewise function in S2 is as follows:
[0030]
[0031] in, is the coefficient of the function; T0 is the preset convergence time.
[0032] Furthermore, in S4, the expression of the preset time trajectory tracking controller of the full-drive unmanned ship is as follows:
[0033]
[0034] in, K3=diag(k 31 ,k 32 ,k 33 ) is a positive definite matrix, δ is the upper bound of the system lumped uncertainty, and ρ is a small value greater than zero.
[0035] Furthermore, in S5, the Lyapunov function is as follows:
[0036]
[0037] Substituting formula (9) (12) into formula (13) and taking the derivative of formula (13), we can obtain:
[0038]
[0039] in, ||s2||1 represents the one-norm of s2, ||s2 T || represents the second norm of s2, It means taking the absolute value of each element of the sum vector and then raising it to the power of β1-1;
[0040] When s2 satisfies formula (14), the controller is stable. At the same time, combining formulas (11), (13), and (14), 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;
[0041] To verify that the controller has converged within the preset time, follow these steps:
[0042] The system converges to 0 in 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;
[0043] 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:
[0044]
[0045] 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;
[0046] Under the premise of satisfying s1(t)=s2(t)=0, according to formula (9):
[0047]
[0048] Take the Lyapunov function as:
[0049]
[0050] Taking the derivative with respect to time, we get:
[0051]
[0052] Based on formula (16) and formula (17), formula (18) can be rewritten as:
[0053]
[0054] From this we can get (η e +F(t)) converges to zero in a finite time, 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:
[0055]
[0056] If the time-varying function F(t) satisfies formula (10), then the time for the system tracking error to converge to zero satisfies: t2 = max(T0,t v ).
[0057] Further, The steps to obtain are as follows:
[0058] According to formula (9) and formula (11), we have:
[0059]
[0060] When S5 is verified to be stable, take T0<t v , then:
[0061] By transforming T, we can get
[0062] From formula (22), we can get: Q2 = -3Q3T0, Substituting the expressions of K1, Q2, Q1, and Q0 into formula (22), we can obtain
[0063] The present invention also provides a storage medium, which includes a stored program, wherein when the program is run, any of the above-mentioned preset time trajectory tracking control methods for a full-drive surface ship based on a time-varying recursive sliding mode is executed.
[0064] 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 preset time trajectory tracking control methods for a fully-driven surface vessel based on a time-varying recursive sliding mode through the computer program.
[0065] Compared with the prior art, the present invention has the following advantages:
[0066] The present invention combines the global terminal sliding mode with the integral sliding mode by designing a time-varying recursive sliding mode function, so that the controller has both the characteristics of fast convergence and high tracking accuracy. At the same time, by designing a time-varying sliding mode function, the system state quantity is located on the sliding mode surface at the initial moment, so that the controller has a full-process response characteristic to external interference. In addition, the controller has a preset time convergence characteristic, and can achieve trajectory tracking with a preset convergence time according to the requirements of different application scenarios, greatly improving the working performance of the full-drive surface ship in actual application scenarios.
[0067] The present invention mainly utilizes time-varying recursive sliding mode technology, global terminal sliding mode technology and integral sliding mode technology to design a preset time trajectory tracking control method for a fully-driven surface ship based on time-varying recursive sliding mode, and at the same time achieves the performance goals of preset time trajectory tracking and high-precision trajectory tracking of the fully-driven unmanned ship, providing theoretical support for improving the working performance of the fully-driven ship. BRIEF DESCRIPTION OF THE DRAWINGS
[0068] 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.
[0069] Figure 1 It is a schematic diagram of the process of the present invention.
[0070] Figure 2 It is a schematic diagram of the motion model of the fully driven surface ship of the present invention.
[0071] Figure 3 It is a block diagram of the control system of the present invention.
[0072] Figure 4This is a trajectory tracking effect diagram of the full-drive surface ship of the present invention.
[0073] Figure 5 This is a three-degree-of-freedom position tracking effect diagram of the fully driven surface ship of the present invention.
[0074] Figure 6 This is a three-degree-of-freedom position tracking error curve of the fully driven surface ship of the present invention. DETAILED DESCRIPTION
[0075] 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.
[0076] 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.
[0077] like Figure 1-3 As shown, the present invention provides a preset time trajectory tracking control method for a full-drive surface ship based on a time-varying recursive sliding mode, comprising the following steps:
[0078] S1. Establish a mathematical model of a fully driven surface ship, including kinematic and dynamic equations;
[0079] Select a point on the sea surface as the origin of the inertial reference system, take the due north direction as the positive direction of the longitudinal axis, take the due east direction as the positive direction of the horizontal axis, and establish the geodetic coordinate system. Then take the center of gravity of the ship as the origin of the body coordinate system, take the starboard side as the positive direction, and take the bow as the positive direction to establish the body coordinate system. In the body coordinate system, establish the relationship between the ship's motion and the force, that is, the dynamic equation, and then use the transformation matrix J ψ (η) Convert the motion in the body coordinate system to the earth coordinate system, i.e., the kinematic equation;
[0080] S2. To achieve convergence within a preset time, a piecewise function is selected, which can force the system state quantity (tracking error) to converge to zero or a small neighborhood of zero at a preset time and maintain the state; based on the piecewise function and the tracking error, a time-varying sliding mode function is designed. Since the piecewise function is included, the value of the time-varying sliding mode function will also converge to zero or a small neighborhood of zero at a preset time;
[0081] S3. Based on the time-varying sliding mode function, a double-layer time-varying sliding mode function with a recursive structure is designed; the time-varying sliding mode function can ensure that the system state quantity is located on the sliding mode surface at the initial moment, so that the system has a global sliding mode characteristic;
[0082] S4. According to the dynamic equation, kinematic equation and double-layer time-varying sliding mode function, a preset time trajectory tracking controller of a fully driven unmanned ship based on a time-varying sliding mode function is designed.
[0083] Furthermore, in step S1, the mathematical model of the fully driven surface ship is specifically:
[0084]
[0085] The above formula (1) is the kinematic equation of a surface ship, and formula (2) is the dynamic equation of a surface ship. 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:
[0086]
[0087] M, C(υ), D(υ) represent the inertial force matrix, Coriolis force and centripetal force matrix, and damping matrix respectively under actual conditions, and their expressions are as follows:
[0088]
[0089] Among them, M RB is the inertia matrix of the rigid body dynamics system; C RB(υ) is the Coriolis force and centripetal force matrix under the rigid body dynamics system; M A is the additional mass force matrix considering the hydrodynamic effect; C A (υ) is the additional Coriolis force and centripetal force matrix considering the influence of hydrodynamic force; D L is the damping matrix under the linear assumption; D NL (υ) is the damping term obtained by Taylor expansion under the nonlinear assumption.
[0090] According to formulas (1) and (2), it is transformed into the geodetic coordinate system and simplified to obtain:
[0091]
[0092] 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.
[0093] 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:
[0094]
[0095] Among them, τ 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. It is the equivalent disturbance force caused by the uncertainty of parameters in the system.
[0096] 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 double-layer sliding mode function expression based on the recursive structure is:
[0097]
[0098] Where, s1=[s 11 ,s 12 ,s 13 ] T is the inner sliding mode function, s2=[s 21 ,s 22 ,s 23 ] T is the outer sliding mode function, F(t) is the time-varying function, K1=diag(k 11 ,k 12 ,k 13 )、K2=diag(k 21 ,k 22 ,k 23 ), K1 and K2 are both positive definite coefficient matrices.
[0099] In step S3, the time-varying function is in the form of:
[0100]
[0101] in, is the coefficient of the function, and its specific expression will be solved in S6; T0 is the preset convergence time. For formula (10), it is necessary to select an appropriate coefficient vector so that f(t) satisfies:
[0102]
[0103] In step S4, in combination with step S1 and step S2, a preset time trajectory tracking controller of the all-drive unmanned ship based on a time-varying sliding mode function is designed, and its specific expression is:
[0104]
[0105] in, K3=diag(k 31 ,k 32 ,k 33 ) is a positive definite matrix, δ is the upper bound of the system lumped uncertainty, and ρ is a small value greater than zero.
[0106] Furthermore, the step S4 is followed by the following steps:
[0107] S5. Use the Lyapunov function to verify the stability of the preset time trajectory tracking controller of the all-drive unmanned ship; when stable, execute S6; when unstable, check the controller model or redesign the controller;
[0108] In step S5, the Lyapunov function is assumed to be in the following form:
[0109]
[0110] Substituting formula (9) (12) into formula (13) and taking the derivative of formula (13), we can obtain:
[0111]
[0112] in, ||s2||1 represents the one-norm of s2, ||s2 T || represents the second norm of s2, It means taking the absolute value of each element of the sum vector and raising it to the power of β1-1.
[0113] This proves the finite-time stability of the controller. At the same time, combining (11), (13) and (14), 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.
[0114] The following proves that the controller converges within the preset time:
[0115] 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.
[0116] 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:
[0117]
[0118] 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.
[0119] Under the premise of satisfying s1(t)=s2(t)=0, according to formula (9):
[0120]
[0121] Take the Lyapunov function as:
[0122]
[0123] Taking the derivative with respect to time, we get:
[0124]
[0125] Based on formula (16) and formula (17), formula (18) can be rewritten as:
[0126]
[0127] From this we can get (η e +F(t)) converges to zero in a finite time, 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:
[0128]
[0129] Based on formula (16) and (19), formula (20) can be rewritten as:
[0130]
[0131] Combined with formula (10), it can be seen that the time for the system tracking error to converge to zero should be: t2 = max(T0,t v ).
[0132] This proves that by reasonably selecting the preset time T0, the controller can reach stability within the preset time.
[0133] In step S6, the method for determining the time-varying function coefficient expression containing the preset time is as follows:
[0134] According to formula (9) and formula (11), we have:
[0135]
[0136] According to the conclusion obtained in S5, without loss of generality, we take T0<t v , then By transforming it, we can get From the above formula (22), we can get: Q2 = -3Q3T0, Substituting the expressions of K1, Q2, Q1, and Q0 into formula (22), we can obtain
[0137] S6, completing the fixed time trajectory tracking control of the ship based on the preset time trajectory tracking controller of the full-drive unmanned ship;
[0138] S61, setting the navigation path η of the ship d , including the position coordinates and heading angle in the geodetic coordinate system, giving the corresponding speed at each point on the path Given the preset time T0 required for the ship to reach the target trajectory;
[0139] S62: After the control system is turned on, the current time is recorded and the current time is used as the initial time of the control system. The real-time position η of the ship is obtained according to the ship's own positioning system, and then the real-time tracking error η is obtained by subtracting the target trajectory coordinates. e ;
[0140] S63, 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 ;
[0141] S64. The ship power device provides the required real-time control force to control the controlled ship.
[0142] Example
[0143] A full-drive ship model was selected for numerical simulation to verify the effectiveness of this control method.
[0144] The reference trajectory is set as follows:
[0145]
[0146] The unknown interference is assumed to be as follows:
[0147]
[0148] The control parameters in the algorithm are set as: T0 = 1, K1 = [60, 60, 60] T ,K2=[1,1,1] T ,K3=[30,30,30] T ,β1=1.1,β2=0.8.
[0149] like Figure 4 As shown in the figure, it can be seen that the proposed preset time trajectory tracking control method for the fully driven surface ship based on time-varying recursive sliding mode can reach the target trajectory within the preset time. The position tracking effect of the fully driven unmanned ship 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.
[0150] 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 preset time trajectory tracking control method for a fully driven surface ship based on a time-varying recursive sliding mode, characterized in that: The steps include: S1. Select a point on the sea surface as the origin of the inertial reference system, take the due north direction as the positive direction of the longitudinal axis, take the due east direction as the positive direction of the horizontal axis, and establish the geodetic coordinate system; then take the center of gravity of the ship as the origin of the body coordinate system, take the starboard side as the positive direction, and take the bow as the positive direction to establish the body coordinate system; establish the relationship between the ship's motion and force, that is, the dynamic equation, in the body coordinate system, and then use the transformation matrix J ψ (η) Convert the motion in the body coordinate system to the earth coordinate system, i.e., the kinematic equation; S2. Select a piecewise function, which makes the system state quantity converge to zero or a neighborhood of zero at a preset time and maintain the state; design a time-varying sliding mode function based on the piecewise function and the tracking error; S3. Design a double-layer time-varying sliding mode function with a recursive structure based on the time-varying sliding mode function; S4. According to the dynamic equation, kinematic equation and double-layer time-varying sliding mode function, a preset time trajectory tracking controller of the all-drive unmanned ship based on the time-varying sliding mode function is designed; S5. Use Lyapunov function to verify the stability of the preset time trajectory tracking controller of the all-drive unmanned ship; When stable, execute S6; S6, completing the fixed time trajectory tracking control of the ship based on the preset time trajectory tracking controller of the full-drive unmanned ship; S61, setting the navigation path η of the ship d , including the position coordinates and heading angle in the geodetic coordinate system, giving the corresponding speed at each point on the path Given the preset time T0 required for the ship to reach the target trajectory; S62: After the control system is turned on, the current time is recorded and the current time is used as the initial time of the control system. The real-time position η of the ship is obtained according to the ship's own positioning system, and then the real-time tracking error η is obtained by subtracting the target trajectory coordinates. e ; S63, 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 ; S64. The ship power device provides the required real-time control force to control the controlled ship.
2. The preset time trajectory tracking control method of a fully driven surface ship based on a time-varying recursive sliding mode according to claim 1 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 preset time trajectory tracking control method of a fully driven surface ship based on a time-varying recursive sliding mode according to claim 2 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 double-layer sliding mode function based on the recursive structure is: Where, s1=[s 11 ,s 12 ,s 13 ] T is the inner sliding mode function, s2=[s 21 ,s 22 ,s 23 ] T is the outer sliding mode function, F(t) is the time-varying function, K1=diag(k 11 ,k 12 ,k 13 )、K2=diag(k 21 ,k 22 ,k 23 ), K1 and K2 are both positive definite coefficient matrices.
4. The preset time trajectory tracking control method of a fully driven surface ship based on a time-varying recursive sliding mode according to claim 3 is characterized in that: The piecewise function in S2 is as follows: in, is the coefficient of the function; T0 is the preset convergence time.
5. The preset time trajectory tracking control method of a fully driven surface ship based on a time-varying recursive sliding mode according to claim 4 is characterized in that: In S4, the preset time trajectory tracking controller expression of the full-drive unmanned ship is as follows: in, K3=diag(k 31 ,k 32 ,k 33 ) is a positive definite matrix, δ is the upper bound of the system lumped uncertainty, and ρ is a small value greater than zero.
6. The preset time trajectory tracking control method of a fully driven surface ship based on a time-varying recursive sliding mode according to claim 5 is characterized in that: In S5, the Lyapunov function is as follows: Substituting formula (9) (12) into formula (13) and taking the derivative of formula (13), we can obtain: in, ||s2||1 represents the one-norm of s2, ||s2 T || represents the second norm of s2, It means taking the absolute value of each element of the sum vector and then raising it to the power of β1-1; When s2 satisfies formula (14), the controller is stable. At the same time, combining formulas (11), (13), and (14), 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; To verify that the controller has converged within the preset time, follow these steps: The system converges to 0 in 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; 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: 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; Under the premise of satisfying s1(t)=s2(t)=0, according to formula (9): Take the Lyapunov function as: Taking the derivative with respect to time, we get: Based on formula (16) and formula (17), formula (18) can be rewritten as: From this we can get (η e +F(t)) converges to zero in a finite time, 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: If the time-varying function F(t) satisfies formula (10), then the time for the system tracking error to converge to zero satisfies: t2 = max(T0,t v ).
7. The preset time trajectory tracking control method of a fully driven surface ship based on a time-varying recursive sliding mode according to claim 4 is characterized in that: The steps to obtain are as follows: According to formula (9) and formula (11), we have: When S5 is verified to be stable, take T0<t v , then: By transforming T, we can get From formula (22), we can get: Q2 = -3Q3T0, Substituting the expressions of K1, Q2, Q1, and Q0 into formula (22), we can obtain 8. A storage medium, characterized in that: The storage medium includes a stored program, wherein when the program is run, the preset time trajectory tracking control method for a full-drive surface ship based on a time-varying recursive sliding mode as described in any one of claims 1 to 7 is executed.
9. 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 the preset time trajectory tracking control method for a full-drive surface vessel based on a time-varying recursive sliding mode as described in any one of claims 1 to 7 through the computer program.
