Finite-time input saturation control method for unmanned ship path tracking under random disturbances
By employing a generalized noise model and a finite-time pushback controller, the problems of random interference and input saturation of unmanned surface vessels (USVs) in complex ocean wave environments are solved, enabling efficient path tracking of USVs within a finite time, thus meeting the requirements of rapid response and precise navigation in emergency missions.
Patent Information
- Application Number
- CN202210911006.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-07-29
- Publication Date
- 2024-11-01
- Estimated Expiration
- 2042-07-29
AI Technical Summary
Existing unmanned surface vessel (USV) path tracking control algorithms struggle to achieve high-precision path tracking within a limited timeframe when faced with random disturbances and input saturation in the marine environment. This is especially true in complex wave environments, where traditional controllers cannot meet the rapid response and precise navigation requirements of USVs performing emergency missions.
A generalized noise model is used to simulate non-white noise disturbances, and a finite-time pushback controller is designed. Combined with input saturation constraints, a controller that satisfies the path tracking requirements of an unmanned vessel is designed using the pushback method. The stability and asymptotic gain of the system are proved using Lyapunov functions and stochastic differential equations.
It enables unmanned ships to efficiently and safely reach path tracking targets within a limited time in complex ocean wave environments, reduces computational complexity, avoids problems such as insufficient observer accuracy and input saturation, and ensures the rapid response and high-precision navigation of unmanned ships.
Smart Images

Figure CN115220456B_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of unmanned ship automatic control, and in particular relates to a finite time input saturation control method for unmanned ship path tracking under random interference. Background Art
[0002] The gradual deepening of the development and utilization of marine resources, as well as the widespread attention paid to marine safety and marine environmental protection, have led to revolutionary changes in marine equipment. As an unmanned marine observation platform, unmanned ships have outstanding advantages such as high speed, small size, high economy, good concealment and long endurance. They can be widely used in long-term, autonomous and flexible operations in the ocean, such as marine mapping and resource exploration, and the execution of maritime emergency tasks. With the continuous deepening of the research and development of unmanned ships, unmanned ships will play a huge role in military and civilian use. In civilian use, unmanned ships can replace ordinary ships to perform marine mapping tasks, conduct meteorological monitoring, etc., greatly improving economic efficiency; in national defense construction, unmanned ships are used for coordinated operations, surface surveillance, personnel search and rescue and other critical tasks, avoiding the risk of injury and improving safety.
[0003] At present, there are three main ways to control unmanned ships: remote control, autonomous navigation, and a combination of remote control and autonomous navigation. Among these three methods, the second and third methods are currently hot topics in the research of unmanned ships. Remote control mainly relies on remote communication technology to achieve information exchange between unmanned ships and shore control centers, which has problems such as range limitations and information delays. Autonomous unmanned ships have complete automatic control systems, collision avoidance and fault diagnosis systems, etc., and require autonomous unmanned ships to comply with corresponding traffic rules, which requires high control accuracy.
[0004] Unmanned ships are often disturbed by the marine environment (wind, waves, etc.) when performing tasks. Due to the accuracy and safety requirements of the tasks, unmanned ships are required to have fast response capabilities and accurate navigation capabilities. How to design a safe and efficient controller has become a key issue for the successful execution of the tasks. In the past few decades, with the continuous improvement and development of computer technology and modern control theory, the traditional unmanned ship path tracking control algorithm has changed from traditional PID control and adaptive control to more complex and more complete control algorithms. For example, model reference adaptive control, neural network, fuzzy control, fuzzy neural network control, model predictive control, sliding mode control, etc. These new algorithms have been verified in the path tracking control of unmanned ships and achieved good control effects. In these studies, most of them consider the norm bounded terms and uncertainty terms of disturbances, without considering the randomness of wave disturbances. However, in actual processes, the state of the marine environment is constantly changing. The motion of unmanned ships must have serious uncertainty. The disturbances caused by waves have random characteristics. It is inaccurate to study the motion of unmanned ships without random disturbances.
[0005] On the other hand, the irregular changes of ocean waves make it very difficult to accurately grasp the ocean wave model. Actual ocean waves have a limited spectral width and a given spectral density function, which is called non-white noise. The wave external load history is a non-white noise sequence that satisfies a certain spectrum. Although there are still some differences in the low-frequency part, it can reflect the spectral characteristics of actual ocean waves. Many literatures study the impact of white noise on the motion of unmanned ships when it is used as an external excitation. White noise can actually be considered to represent a wave spectrum, but it is an ideal wave spectrum that does not exist in reality. This is mainly because the actual ocean waves are non-white noise sequences that satisfy a certain spectral distribution rather than white noise sequences. Not all forms of spectra can be expressed as the output of white noise after passing through a shape filter. When the spectral energy of white noise and non-white noise is close, there is a significant difference in the probability distribution results of the two. The result of white noise calculation shows that the probability peak is much lower than that of non-white noise. According to the result of white noise, even when the roll amplitude reaches 1rad, there is still a high probability, which is very different from the actual test results. Therefore, it is more important to use non-white noise to characterize waves than white noise to study the motion control of unmanned ships.
[0006] All of the above control algorithms can achieve the specified expected value. However, almost all control algorithms are asymptotic convergence algorithms, which means that the optimal control speed of the tracking system cannot be achieved within a finite time, and can only reach the so-called expected value when time tends to infinity. The existence of maritime search and rescue missions requires unmanned ships to have sensitive response capabilities and high-precision motion control, which means that the control system of the unmanned ship needs to meet the mission requirements and mission accuracy within the specified time. In the past few decades, a large number of scholars have proposed various control technologies to solve the finite time control problem: terminal sliding mode control technology, finite time pushback control, finite time Lyapunov method, etc.
[0007] On the other hand, the propeller provides force and torque to the unmanned ship during navigation. However, due to various limitations in mechanical design or physical characteristics, the input characteristics of the actuator cannot be ignored. Among them, the nonlinear problem of input saturation has the greatest impact on the working performance of the actuator. In the actual ocean navigation process, the energy provided by the host to the propeller is often limited, which generally cannot meet the requirements of the ideal controller. When the expected input value of the unmanned ship is greater than the maximum value of the propeller, there is an input saturation limitation problem, which affects the performance of the system, such as excessive overshoot. Therefore, in the past few decades, many control schemes have been proposed to solve the system problems containing saturated nonlinearity, and great results have been achieved. However, few consider the input saturation problem in finite time control under random interference.
[0008] Although the present invention uses generalized noise to describe the uncertainty of the unmanned ship path tracking control, according to our experiments, when the colored noise sequence is generated by the filter, the higher the order of the colored noise, the better the approximation of the standard spectrum (not only the PM spectrum), and there will be another problem, which will increase the complexity of the subsequent calculation of the ship motion response and make the calculation time longer. Therefore, when selecting the filter model, the fitting accuracy and calculation complexity should be considered comprehensively. In addition, the complexity of the finite time virtual control rate needs to be considered to avoid the occurrence of the calculation explosion problem. Summary of the invention
[0009] In order to solve the problem that the noise interference generated by the marine environment is non-white noise rather than white noise, considering the randomness of waves, finite time and input saturation restrictions are added according to actual task requirements, and a finite time input saturation control method for unmanned ship path tracking under random interference is proposed, which includes the following steps:
[0010] The finite time input saturation control method for unmanned ship path tracking under random disturbance includes the following steps:
[0011] Establish a dynamic model of an unmanned ship with random noise;
[0012] Based on the wave modeling concept, the fitting of non-white noise and white noise to PM wave spectrum is simulated;
[0013] The pushback method is used to design a finite-time pushback controller that satisfies the input saturation limit of the unmanned ship's path tracking system to track the expected position and heading within a finite time.
[0014] In the theoretical framework of stochastic differential equations, it is proved that the unmanned ship path tracking system is stable from probabilistic noise to state, and the state of the unmanned ship path tracking system is asymptotic gain according to probability.
[0015] Further: The expression of the dynamic model of the unmanned ship with random noise is as follows:
[0016]
[0017]
[0018] τ d It is a random process. It has the following properties:
[0019]
[0020]
[0021]
[0022] Further: the expression of the input saturation restriction condition is as follows:
[0023]
[0024] Among them, τ max and τ min represents the maximum and minimum values that the thruster can provide, satisfying τ max >0 and τ min <0; let p(τ)=gτ, g>0 is a constant; sat(τ)=p(τ)+q(τ)→|q(τ)|=|sat(τ)-p(τ)|≤T.
[0025] Furthermore: the finite time pushback controller satisfies the following conditions:
[0026]
[0027] Limited time satisfaction
[0028] Further: The process of using the pushback method to design a finite-time pushback controller that satisfies the input saturation limit of the unmanned ship's path tracking system to track the expected position and heading within a finite time is as follows:
[0029] First design an error vector z1∈R about the position 3 ;
[0030] z1=η-η d (20)
[0031] η d is the expected value;
[0032] The virtual control rate is designed as:
[0033]
[0034] K1 is a positive definite diagonal matrix; s1 is a positive constant;
[0035] The first Lyapunov function is:
[0036]
[0037] Taking the derivative of the Lyapunov function, we get:
[0038]
[0039] The error vector z2∈R of the design speed 3 for:
[0040] z2=v-α (24)
[0041] Transform the error vector and substitute it into the derivative of the Lyapunov function:
[0042]
[0043] Substituting the virtual control rate into the above formula, we get:
[0044]
[0045] According to the unmanned ship's dynamic model and velocity error vector, we can find:
[0046]
[0047] Design the second Lyapunov function V2 to get:
[0048]
[0049] Taking the derivative of the second Lyapunov function, we get:
[0050]
[0051] According to Young's inequality To process:
[0052]
[0053]
[0054] Substituting the above formula into the second Lyapunov derivative, we get:
[0055]
[0056] The finite time pushback controller is as follows:
[0057]
[0058] K2 is a positive definite matrix, s2 is a normal number; s2|z2| γ sign(z2) is the same as that in the virtual control rate α.
[0059] Furthermore: Under the theoretical framework of stochastic differential equations, it is proved that the unmanned ship path tracking system is stable according to the probability noise, and the state of the unmanned ship path tracking system is a process of probabilistic asymptotic gain as follows:
[0060] Definition 1: Under the constraints of Assumptions 1 and 2, there exists a parameter d>0, a function V∈C 1 and a K∞ function α , And a K-type function α satisfies the following inequality:
[0061]
[0062]
[0063] The unmanned ship path tracking system has a unique global solution if is a convex function, then the unmanned ship path tracking system is a probability noise to state stable NSS-P, and the state of the system is a probability asymptotic gain;
[0064] Definition 2: If for any ε>0, there is a K-type function γ(·), for any satisfying:
[0065] P{lim t→∞ |x(t)|≤γ(K)}>1-ε (17)
[0066] The state of the unmanned ship path tracking system is a probability-based asymptotic gain AG-P;
[0067] For the proof of the unmanned ship path tracking system, the following lemma is also required:
[0068] Lemma 2: Allow the function s(t) to be absolutely continuous for t ≥ t0, and allow its derivative to be an inequality:
[0069]
[0070] For all t ≥ t0, where r(t) and c(t) are functions that are continuously integrable everywhere on every finite interval, when t ≥ t0, we have
[0071]
[0072] According to Definition 1 and Definition 2, if V(x) satisfies the above conditions, the unmanned ship path tracking system under the RDEs framework is stable and the state of the unmanned ship path tracking system is asymptotically gaining according to probability.
[0073] A computer-readable storage medium stores a computer program, wherein when the computer program is run, a finite-time input saturation control method for unmanned ship path tracking under random interference is executed.
[0074] A finite-time input saturation control device for unmanned ship path tracking under random disturbances, comprising:
[0075] Building module: used to build the dynamic model of unmanned ship with random noise;
[0076] Fitting module: used to simulate the fitting of non-white noise and white noise to PM wave spectrum based on wave modeling ideas;
[0077] Design module: used to design a finite-time pushback controller using the pushback method to meet the input saturation limit of the unmanned ship's path tracking system to achieve the tracking expected position and heading within a finite time;
[0078] Proof module: Under the theoretical framework of stochastic differential equations, it is proved that the unmanned ship path tracking system is stable according to the probability noise to the state, and the state of the unmanned ship path tracking system is asymptotically gain according to probability.
[0079] The present invention proposes a finite-time input saturation control method for unmanned ship path tracking under random interference; it mainly studies the influence of generalized noise disturbance on the motion control of unmanned ships under complex wave environments. When an unmanned ship is sailing, it is affected by waves, and the motion control of the unmanned ship will be difficult. The present invention uses generalized noise to simulate the disturbance caused by waves to design a controller to resist such disturbance, while considering the unmanned ship path tracking control problem under input saturation constraints and finite-time tracking.
[0080] A disturbance observer is used to estimate the disturbance. In this case, it is assumed that the disturbance has an upper bound, which is somewhat different from the actual situation. Unlike the disturbance observer usually used in path tracking control, this application does not need to construct a high-precision disturbance observer for wave interference. Non-white noise is used to accurately describe the wave interference, which not only avoids the complexity of calculation, but also solves the problem of insufficient observer accuracy.
[0081] Secondly, in the path tracking control process of the unmanned ship, the output force or torque of the finite time pushback controller is limited and it is impossible to meet the requirements of the ideal controller at all times. Considering input saturation is more in line with the controller working conditions in actual navigation;
[0082] Then, a finite-time pushback controller under input saturation limit is designed to ensure that the path tracking system of the unmanned ship can achieve the requirements of tracking the expected position and heading within a finite time. Then, under the theoretical framework of stochastic differential equations, it is proved that the path tracking system of the unmanned ship is stable according to the probability noise, and the state of the path tracking system of the unmanned ship is asymptotically gain according to probability.
[0083] In the framework of RDEs, it is proved that the path tracking system of unmanned ship under non-white noise interference can be stably changed from noise to state.
[0084] Since the energy of the unmanned ship propulsion system is limited, the ideal control rate sometimes cannot meet the requirements. Considering input saturation to meet the actual navigation conditions is in line with the actual conditions;
[0085] Based on the above reasons, the present invention can be widely promoted in the field of unmanned ship motion control;
[0086] Finally, the finite-time pushback controller is simulated and verified, which confirms the effectiveness of the designed finite-time pushback controller for the unmanned ship path tracking system under input saturation limitation. BRIEF DESCRIPTION OF THE DRAWINGS
[0087] 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.
[0088] Figure 1 is the coordinate system transformation diagram;
[0089] Figure 2 is the PM spectral density function diagram;
[0090] Figure 3 is the spectral density function graph of non-white noise;
[0091] Figure 4 is the white noise spectral density function;
[0092] Figure 5 is the controller flow chart;
[0093] Figure 6 is the circular trajectory tracking error diagram;
[0094] Figure 7 (a) is the finite time path tracking error diagram of the unmanned ship under the input saturation limit in the X direction;
[0095] (b) is the finite time path tracking error diagram of the unmanned ship under the input saturation limit in the Y direction;
[0096] (c) is the finite time path tracking error diagram of the unmanned ship under the input saturation limit in the Ψ direction;
[0097] Figure 8 (a) is a comparison diagram of the error between the unmanned ship's finite-time path tracking and traditional pushback control under the input saturation limit in the X direction;
[0098] (b) is the error comparison diagram between the unmanned ship finite time path tracking and traditional pushback control under the input saturation limit in the Y direction;
[0099] (c) is the error comparison diagram between the unmanned ship finite time path tracking and traditional pushback control under the input saturation limit in the Ψ direction;
[0100] Fig. 9(a) is the input limit torque diagram of the unmanned ship in the X direction; (b) is the input limit torque diagram of the unmanned ship in the Y direction; (c) is the input limit torque diagram of the unmanned ship in the Ψ direction;
[0101] Fig.10 (a) is a tracking error diagram in the X direction under noise-free conditions; (b) is a tracking error diagram in the X direction under noise-free conditions; (c) is a tracking error diagram in the Ψ direction under noise-free conditions. DETAILED DESCRIPTION
[0102] It should be noted that, in the absence of conflict, the embodiments of the present invention and the features in the embodiments may be combined with each other. The present invention will be described in detail below with reference to the accompanying drawings and in combination with the embodiments.
[0103] In order to make the purpose, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions 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. The following description of at least one exemplary embodiment is actually only illustrative and is by no means intended to limit the present invention and its application or use. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0104] It should be noted that the terms used herein are only for describing specific embodiments and are not intended to limit exemplary embodiments according to the present invention. As used herein, unless the context clearly indicates otherwise, the singular form is also intended to include the plural form. In addition, it should be understood that when the terms "comprising" and / or "including" are used in this specification, it indicates the presence of features, steps, operations, devices, components and / or combinations thereof.
[0105] Unless otherwise specifically stated, the relative arrangement of the parts and steps described in these embodiments, the numerical expressions and numerical values do not limit the scope of the present invention. At the same time, it should be clear that, for ease of description, the sizes of the various parts shown in the drawings are not drawn according to the actual proportional relationship. The technology, methods and equipment known to ordinary technicians in the relevant field may not be discussed in detail, but in appropriate cases, the technology, methods and equipment should be regarded as part of the authorization specification. In all examples shown and discussed here, any specific value should be interpreted as merely exemplary, rather than as a limitation. Therefore, other examples of exemplary embodiments may have different values. It should be noted that similar numbers and letters represent similar items in the following drawings, so once an item is defined in one drawing, it does not need to be further discussed in subsequent drawings.
[0106] In the description of the present invention, it is necessary to understand that the directions or positional relationships indicated by directional words such as "front, back, up, down, left, right", "lateral, vertical, perpendicular, horizontal" and "top, bottom" are usually based on the directions or positional relationships shown in the drawings. They are only for the convenience of describing the present invention and simplifying the description. Unless otherwise specified, these directional words do not indicate or imply that the device or element referred to must have a specific direction or be constructed and operated in a specific direction. Therefore, they cannot be understood as limiting the scope of protection of the present invention: the directional words "inside and outside" refer to the inside and outside relative to the contours of each component itself.
[0107] For ease of description, spatially relative terms such as "above", "above", "on the upper surface of", "above", etc. may be used here to describe the spatial positional relationship between a device or feature and other devices or features as shown in the figure. It should be understood that spatially relative terms are intended to include different orientations of the device in use or operation in addition to the orientation described in the figure. For example, if the device in the accompanying drawings is inverted, the device described as "above other devices or structures" or "above other devices or structures" will be positioned as "below other devices or structures" or "below their position devices or structures". Thus, the exemplary term "above" can include both "above" and "below". The device can also be positioned in other different ways (rotated 90 degrees or in other orientations), and the spatially relative descriptions used here are interpreted accordingly.
[0108] In addition, it should be noted that the use of terms such as "first" and "second" to limit components is only for the convenience of distinguishing the corresponding components. If not otherwise stated, the above terms have no special meaning and therefore cannot be understood as limiting the scope of protection of the present invention.
[0109] The present invention provides a finite time input saturation control method for unmanned ship path tracking under random interference, the characteristics of which include:
[0110] S1: In view of noise disturbance, a dynamic model of an unmanned ship with random noise is established, wherein the dynamic model of an unmanned ship with random noise is used to track three-degree-of-freedom motions of surge, sway and pitch;
[0111] S2: Considering the influence of complex waves on the motion control of unmanned ships during the path tracking process of unmanned ships, based on the wave modeling idea, the fitting of non-white noise and white noise to PM wave spectrum is simulated;
[0112] S3: The pushback method is used to design a finite-time pushback controller that satisfies the input saturation limit of the unmanned ship's path tracking system to achieve the desired position and heading within a finite time.
[0113] During navigation, the output force or torque of the controller is limited and cannot always meet the requirements of an ideal controller. Considering the input saturation limit to limit the force or torque output by the controller, it meets the actual engineering needs.
[0114] Unmanned ships need efficient and safe controllers when performing emergency tasks. Although previous controllers can ensure that the path tracking control error of the unmanned ship is eventually in a convergence state, they do not meet some requirements in terms of timeliness.
[0115] The limited time pushback controller meets the above requirements;
[0116] S4: Under the theoretical framework of stochastic differential equations, it is proved that the unmanned ship path tracking system is stable according to the probability noise, and the state of the unmanned ship path tracking system is asymptotically gain according to probability.
[0117] The steps S1 / S2 / S3 / S4 are performed sequentially;
[0118] Figure 1 is the coordinate system transformation diagram;
[0119] Specifically, in step S1, a path tracking model of an unmanned ship with random noise is proposed for noise disturbance, and the specific process of analyzing the three-degree-of-freedom motion of surge, sway and pitch is as follows:
[0120] Firstly, the unmanned ship path tracking model without noise is established as follows:
[0121]
[0122]
[0123] In formulas (1)-(2), is the position of the ship, which is composed of the unmanned ship's spatial position X, Y and heading angle Composition, v = [uvr] T is the speed of the three degrees of freedom motion of surge, sway and pitch, is the conversion matrix, M represents the inertial dynamic parameter matrix (composed of the additional hydrodynamic inertia and the weight inertia of the unmanned ship), D is the damping matrix, and τ is the design control force.
[0124] Adding noise disturbance to this noise-free unmanned ship path tracking model yields:
[0125]
[0126]
[0127] τ d It is a random process. It has the following properties:
[0128]
[0129]
[0130]
[0131]
[0132] in is the derivative of the transformation matrix.
[0133] Step S2: Considering the complex waves in the path tracking process, the idea of constructing non-white noise that conforms to the actual wave conditions is proposed, and the fitting of non-white noise and white noise to the PM wave spectrum is simulated as follows:
[0134] The actual wave is considered to be a random process. According to wave theory, the long-crest wave can be regarded as the superposition of many cosine waves with different amplitudes and wavelengths. The long-crest wave ξ can be expressed by the following formula:
[0135]
[0136] a i , k i ,ω i ,θ i They are the amplitude, number of waves, angular frequency and initial phase of the i-th wave, N is the number of waves of the regular wave, and t is time.
[0137] Under different wave conditions, the spectral density function is different. This application uses the PM spectrum, and the spectral density function S of the wave is ξ (w) is expressed as:
[0138]
[0139] A=8.1×10 -3 g 2 , is the significant wave height corresponding to different wave conditions; A and B are parameters, and ω represents the wave angular frequency.
[0140] In order to illustrate that non-white noise is more suitable for describing waves than white noise, we simulate the disturbance of the unmanned ship and fit the non-white noise spectrum density we simulated with the standard PM spectrum. The non-white noise spectrum density is:
[0141]
[0142] Spectral density functions of non-white noise, white noise and PM spectrum,
[0143] Figure 2is the PM spectral density function diagram;
[0144] Figure 3 is the spectral density function graph of non-white noise;
[0145] Figure 4 is the white noise spectral density function.
[0146] The input saturation limit condition is as follows:
[0147]
[0148] Among them, τ max and τ min Represent the maximum and minimum values that the thruster can provide, respectively, satisfying τ max >0 and τ min <0; where: the propeller refers to the power source that provides power to the ship, and the controller controls this power source. Let p(τ)=gτ, g>0 is a constant. sat(τ)=p(τ)+q(τ)→|q(τ)|=|sat(τ)-p(τ)|≤T.
[0149] The above formula can be rewritten as:
[0150] sat(τ)=gτ+T
[0151] Where T is the difference between the ideal output and the actual output of the thruster.
[0152] Referring to the finite time law, the finite time law is needed in the subsequent stability proof to prove that the controller meets the above conditions:
[0153]
[0154] αV(x), finite time T satisfies:
[0155]
[0156] Referring to some assumptions and lemmas in the framework of stochastic differential equations (RDEs), in order to meet the proof requirements of the subsequent finite-time pushback controller design, the above-mentioned unmanned ship path tracking control system needs to be converted into the required state space model. The state space equation is transformed as follows:
[0157]
[0158] at this time
[0159]
[0160] According to the dynamic model of the unmanned ship, it can be transformed into:
[0161]
[0162]
[0163] To analyze the intensity of disturbances caused by wind, waves, and currents, we need to make some assumptions other than white noise and bounded norm.
[0164] Assumption 1: Process τ d Yes t Adaptive and piecewise continuous, so there exists a constant K>0, t0 is a moment greater than 0.
[0165] In order to analyze the existence and uniqueness of the solution of the unmanned ship path tracking system, the following assumptions are required:
[0166] Assumption 2: The functions f(x, t) and h(x, t) are indirectly continuous on t and satisfy the Lipsitz condition on x. For any x1, x2∈U l , x1≠x2, there exists a constant l that depends on q q and k0>0 satisfy the following:
[0167] |f(0,t)|+||h(0,t)||<k0 (13)
[0168] |f(x2,t)-f(x1,t)|+||h(x2,t)-h(x1,t)||≤l q |x2-x1| (14)
[0169] Different from the state judgment conditions of the unmanned ship path tracking system under stochastic differential equations, the following gives the definitions of the unmanned ship path tracking system from probability noise to state stability and the unmanned ship path tracking system state from probability asymptotic gain under the RDEs framework to determine whether the unmanned ship path tracking system is stable and the state of the unmanned ship path tracking system.
[0170] Definition 1: Under the constraints of Assumptions 1 and 2, there exists a parameter d>0, a function V∈C 1 and a K∞ function α , And a K-type function α satisfies the following inequality:
[0171]
[0172]
[0173] The unmanned ship path tracking system has a unique global solution if Is a convex function, then the unmanned ship path tracking system is a probability noise to state stable NSS-P, and the state of the unmanned ship path tracking system is a probability asymptotic gain.
[0174] Definition 2: If for any ε>0, there is a K-type function γ(·), for any satisfying:
[0175] P{lim t→∞ |x(t)|≤γ(K)}>1-ε (17)
[0176] The state of the unmanned ship path tracking system is a probability-based asymptotic gain AG-P;
[0177] For the proof of the unmanned ship path tracking system, we also need the following lemma:
[0178] Lemma 1: For all x i ∈R(i=1,2...n) and 0<p≤1, then
[0179]
[0180] Lemma 2: Allow the function s(t) to be absolutely continuous for t ≥ t0, and allow its derivative to be an inequality:
[0181]
[0182] For all t ≥ t0, where r(t) and c(t) are functions that are continuously integrable everywhere on every finite interval, when t ≥ t0, we have
[0183]
[0184] According to Definition 1 and Definition 2, if V(x) satisfies the above conditions, the unmanned ship path tracking system under the RDEs framework is stable and the state of the unmanned ship path tracking system is asymptotically gaining according to probability.
[0185] The finite-time controller of the unmanned ship path tracking system under input saturation constraint is derived using the backstepping method. Figure 5 is the controller flow chart;
[0186] And prove the stability of the unmanned ship path tracking system; control the unmanned ship path tracking system.
[0187] We designed a finite-time pushback controller under random disturbances. The advantage of pushback control is that the final control rate of the controller is obtained by recursion, and the method is simple and efficient.
[0188] Then, under the theoretical framework of RDEs, Lyapunov stability theory is used to prove that the unmanned ship path tracking system is stable.
[0189] Step 1: First design an error vector z1∈R about the position 3 ;
[0190] z1=η-η d (20)
[0191] η d is the expected value.
[0192] The virtual control rate is designed as:
[0193]
[0194] K1 is a positive definite diagonal matrix; s1 is a positive constant.
[0195] The Lyapunov function is:
[0196]
[0197] Taking the derivative of the Lyapunov function, we get:
[0198]
[0199] The error vector z2∈R of the design speed 3 for:
[0200] z2=v-α (24)
[0201] Transform the error vector and substitute it into the derivative of the first Lyapunov function:
[0202]
[0203] Substituting the virtual control rate into the above formula, we get:
[0204]
[0205] According to the unmanned ship's dynamic model and velocity error vector, we can find:
[0206]
[0207] Design the second Lyapunov function V2 to get:
[0208]
[0209] Taking the derivative of the second Lyapunov function, we get:
[0210]
[0211] According to Young's inequality To process:
[0212]
[0213]
[0214] Substituting the above formula into the second Lyapunov derivative, we get:
[0215]
[0216] The control rate of the finite-time pushback controller is designed as follows:
[0217]
[0218] K2 is a positive definite matrix, s2 is a normal number; s2|z2| γ sign(z2) is the same as that in the virtual control rate α.
[0219] Substituting the control rate into the above formula:
[0220]
[0221] According to Lemma 1, we have:
[0222]
[0223]
[0224] at this time;
[0225] u0=min{λ min (2K1), λ min (2K2)}, (37)
[0226] u1=min{s1,s2} (38)
[0227] The function of u1 is to simplify the above formula;
[0228] The above formula is transformed into:
[0229]
[0230]
[0231] According to the above conditions, we can get:
[0232]
[0233] From Definition 1, we can get:
[0234]
[0235] Let v(t)=EV(x(t));
[0236]
[0237] According to Jensen's inequality, And there exists a KL function and K infinite functions Satisfy the following formula:
[0238]
[0239] According to Chebyshev's inequality:
[0240]
[0241]
[0242] By making and We can get:
[0243]
[0244] By t→∞, we can assume that
[0245] P{lim t→∞ |x(t)|≤γ(K)}>1-ε (47)
[0246] According to Lemma 2, it satisfies:
[0247]
[0248] Substituting into the Lyapunov function we get:
[0249]
[0250] It can be concluded that the entire unmanned ship path tracking system is stable from noise to state according to probability, and the state of the unmanned ship path tracking system is asymptotically gained according to probability. Therefore, all signals are bounded according to probability in the entire closed-loop system; and the tracking error can be controlled to be arbitrarily small by making d arbitrarily large; the entire closed-loop system is the unmanned ship path tracking system, because the unmanned ship path tracking system needs to meet the closed-loop conditions when designing the controller, it is also called a closed-loop system. The ultimate goal of the unmanned ship path tracking system design is to design a finite-time pushback controller to meet the various requirements we have mentioned above.
[0251]
[0252] make c is a number greater than zero.
[0253]
[0254] Because c>0, the above formula can be rewritten as:
[0255]
[0256] The above formula meets the finite time requirement and the stable time is:
[0257]
[0258] A computer-readable storage medium stores a computer program, wherein when the computer program is run, a finite-time input saturation control method for unmanned ship path tracking under random interference is executed.
[0259] A finite-time input saturation control device for unmanned ship path tracking under random disturbances, comprising:
[0260] Building module: used to build the dynamic model of unmanned ship with random noise;
[0261] Fitting module: used to simulate the fitting of non-white noise and white noise to PM wave spectrum based on wave modeling ideas;
[0262] Design module: used to design a finite-time pushback controller using the pushback method to meet the input saturation limit of the unmanned ship's path tracking system to achieve the tracking expected position and heading within a finite time;
[0263] Proof module: Under the theoretical framework of stochastic differential equations, it is proved that the unmanned ship path tracking system is stable according to the probability noise to the state, and the state of the unmanned ship path tracking system is asymptotically gain according to probability.
[0264] The scheme and effect of the present invention are further described below through specific application examples.
[0265] Known: Parameters of mathematical model of a nonlinear system for motion control of an unmanned ship
[0266] The initial position of the unmanned ship is η = [0m 0m 10deg] T Two reference signals are selected: one is a circular trajectory; the other is η d =[15m 10m 5deg] T , the sampling time is 400s. The reference signal model is selected according to the actual situation:
[0267]
[0268] η ris the vector of the unmanned ship's berthing position, the natural frequency ρ is specified as 0.05, and the damping ratio σ is specified as 0.9. Non-white noise sequence:
[0269]
[0270] N(t) is a white noise sequence with a power spectral density of 1, and the parameter values are α=0.4, β=0.4474, γ=0.1964
[0271] Figure 6 is the circular trajectory tracking error diagram;
[0272] Figure 7 (a) is the finite time path tracking error diagram of the unmanned ship under the input saturation limit in the X direction;
[0273] (b) is the finite time path tracking error diagram of the unmanned ship under the input saturation limit in the Y direction;
[0274] (c) is the finite time path tracking error diagram of the unmanned ship under the input saturation limit in the Ψ direction;
[0275] Figure 8 (a) is a comparison diagram of the error between the unmanned ship's finite-time path tracking and traditional pushback control under the input saturation limit in the X direction;
[0276] (b) is the error comparison diagram between the unmanned ship finite time path tracking and traditional pushback control under the input saturation limit in the Y direction;
[0277] (c) is the error comparison diagram between the unmanned ship finite time path tracking and traditional pushback control under the input saturation limit in the Ψ direction;
[0278] Fig. 9 (a) is the input limit torque diagram of the unmanned ship in the X direction; (b) is the input limit torque diagram of the unmanned ship in the Y direction; (c) is the input limit torque diagram of the unmanned ship in the Ψ direction;
[0279] Fig.10 (a) is a tracking error diagram in the X direction under noise-free conditions; (b) is a tracking error diagram in the X direction under noise-free conditions; (c) is a tracking error diagram in the Ψ direction under noise-free conditions.
[0280] It can be seen that the finite-time pushback controller based on input saturation limit has a good control effect.
[0281] 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 finite-time input saturation control method for unmanned ship path tracking under random disturbances, characterized by: The following steps are involved: Establish a dynamic model of an unmanned ship with random noise; Based on the wave modeling concept, the fitting of non-white noise and white noise to PM wave spectrum is simulated; The pushback method is used to design a finite-time pushback controller that satisfies the input saturation limit of the unmanned ship's path tracking system to track the expected position and heading within a finite time. In the theoretical framework of stochastic differential equations, it is proved that the unmanned ship path tracking system is stable according to the probability noise, and the state of the unmanned ship path tracking system is asymptotic gain according to probability; The process of using the pushback method to design a finite-time pushback controller that satisfies the input saturation limit of the unmanned ship's path tracking system to achieve the tracking expected value position and heading within a finite time is as follows: First design an error vector z1∈R about the position 3 ; z1=η-η d (20)η d is the expected value; The virtual control rate is designed as: K1 is a positive definite diagonal matrix; s1 is a positive constant; The first Lyapunov function is: Taking the derivative of the Lyapunov function, we get: The error vector z2∈R of the design speed 3 for: z2=v-α (24) Transform the error vector and substitute it into the derivative of the Lyapunov function: Substituting the virtual control rate into the above formula, we get: According to the unmanned ship's dynamic model and velocity error vector, we can find: Design the second Lyapunov function V2 to get: Taking the derivative of the second Lyapunov function, we get: According to Young's inequality To process: Substituting the above formula into the second Lyapunov derivative, we get: The finite time pushback controller is as follows: K2 is a positive definite matrix, s2 is a normal number; s2|z2| γ sign(z2) is the same as that in the virtual control rate α.
2. The finite-time input saturation control method for unmanned ship path tracking under random interference according to claim 1 is characterized in that: The expression of the dynamic model of the unmanned ship with random noise is as follows: τ d It is a random process; It has the following properties:
3. The finite time input saturation control method for unmanned ship path tracking under random interference according to claim 1 is characterized in that: The expression of the input saturation restriction condition is as follows: Among them, τ max and τ min represents the maximum and minimum values that the thruster can provide, satisfying τ max >0 and τ min <0; let p(τ)=gτ, g>0 is a constant; sat(τ)=p(τ)+q(τ)→|q(τ)|=|sat(τ)-p(τ)|≤T.
4. The finite time input saturation control method for unmanned ship path tracking under random interference according to claim 1 is characterized in that: The finite time pushback controller satisfies the following conditions: Limited time satisfaction 5. The finite time input saturation control method for unmanned ship path tracking under random interference according to claim 1 is characterized in that: In the theoretical framework of stochastic differential equations, it is proved that the unmanned ship path tracking system is stable according to the probability noise, and the state of the unmanned ship path tracking system is a process of probabilistic asymptotic gain as follows: Definition 1: Under the constraints of Assumption 1 and Assumption 2, there exists a parameter d>0, a function V∈C 1 and a K∞ function α , And a K-type function α satisfies the following inequality: The unmanned ship path tracking system has a unique global solution if is a convex function, then the unmanned ship path tracking system is a probability noise to state stable NSS-P, and the state of the system is a probability asymptotic gain; Definition 2: If for any ε>0, there is a K-type function γ(·), for any satisfying: The state of the unmanned ship path tracking system is a probability-based asymptotic gain AG-P; For the proof of the unmanned ship path tracking system, the following lemma is also required: Lemma 2: Allow the function s(t) to be absolutely continuous for t ≥ t0, and allow its derivative to be an inequality: For all t ≥ t0, where r(t) and c(t) are functions that are continuously integrable everywhere on every finite interval, when t ≥ t0, we have According to Definition 1 and Definition 2, if V(x) satisfies the above conditions, the unmanned ship path tracking system under the RDEs framework is stable and the state of the unmanned ship path tracking system is asymptotically gaining according to probability.
6. A computer-readable storage medium, wherein the computer-readable storage medium stores a computer program, wherein: When the computer program is running, the unmanned ship path tracking finite time input saturation control method under random interference described in any one of claims 1 to 5 is executed.
7. A finite time input saturation control device for unmanned ship path tracking under random interference, characterized in that: include Building module: used to build the dynamic model of unmanned ship with random noise; Fitting module: used to simulate the fitting of non-white noise and white noise to PM wave spectrum based on wave modeling ideas; Design module: used to design a finite-time pushback controller using the pushback method to meet the input saturation limit of the unmanned ship's path tracking system to achieve the tracking expected position and heading within a finite time; The process of using the pushback method to design a finite-time pushback controller that satisfies the input saturation limit of the unmanned ship's path tracking system to achieve the tracking expected value position and heading within a finite time is as follows: First design an error vector z1∈R about the position 3 ; z1=η-η d (20)η d is the expected value; The virtual control rate is designed as: K1 is a positive definite diagonal matrix; s1 is a positive constant; The first Lyapunov function is: Taking the derivative of the Lyapunov function, we get: The error vector z2∈R of the design speed 3 for: z2=v-α (24) Transform the error vector and substitute it into the derivative of the Lyapunov function to obtain: Substituting the virtual control rate into the above formula, we get: According to the unmanned ship's dynamic model and velocity error vector, we can find: Design the second Lyapunov function V2 to get: Taking the derivative of the second Lyapunov function, we get: According to Young's inequality To process: Substituting the above formula into the second Lyapunov derivative, we get: The finite time pushback controller is as follows: K2 is a positive definite matrix, s2 is a normal number; s2|z2| γ sign(z2) is the same as in the virtual control rate α; Proof module: Under the theoretical framework of stochastic differential equations, it is proved that the unmanned ship path tracking system is stable according to the probability noise to the state, and the state of the unmanned ship path tracking system is asymptotically gain according to probability.
