Unmanned ship multi-mode expansion state observer
Through a multimodal expansion state observer, the state and parameters of the unmanned ship are estimated in real time, which solves the control problems under parameter uncertainty and marine environmental disturbance, improves the stability and immunity of the unmanned ship, and simplifies the design and Improves robustness and real-timeness.
Patent Information
- Application Number
- CN202410952593.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-16
- Publication Date
- 2024-11-08
AI Technical Summary
The dynamic model of unmanned ships has parameter uncertainty and unknown marine environmental disturbances, resulting in complex control problems. It is difficult for the prior art to estimate internal models and external disturbances in real time, affecting stability and immunity.
Using a multimodal expansion state observer, the state and parameters of the unmanned ship are estimated in real time through the supervision framework structure, and a multimodal expansion observer combination of longitudinal sway velocity and bow angular velocity direction is designed. The selector selects appropriate observations based on the monitoring signal. The device provides state and parameter estimates and controls unmanned ship action through a dynamic controller output signal.
It realizes the stability and immunity of unmanned ships in complex marine environments, simplifies design and parameter adjustment, avoids dependence on precise control of gain parameters, and improves robustness and real-timeness.
Smart Images

Figure CN118915728A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of multi-unmanned ship control, and mainly proposes a multi-modal extended state observer for unmanned ships, aiming at unmanned ship dynamics models under parameter uncertainty and unknown ocean environment disturbances. Background Art
[0002] In recent years, with the increasing scarcity of land resources, the world's maritime powers have attached great importance to the use of the ocean. Unmanned ships, as a kind of intelligent marine equipment, have been widely used in marine scientific research, marine resource exploration, marine environment monitoring, marine rescue and other fields.
[0003] The dynamic model of unmanned ships has the characteristics of nonlinearity, uncertainty, strong disturbance, under-actuation, and multiple constraints. Therefore, the stability control problem of unmanned ship dynamics is one of the key issues in realizing the coordinated path tracking control of multiple unmanned ships. In recent years, researchers at home and abroad have done a lot of work on the dynamic control of unmanned ships. Common control methods include PID control, model predictive control (MPC), adaptive control, and self-disturbance rejection control based on extended state observer (ESO). The traditional PID control method is simple and easy to implement, with good stability, and is suitable for linear systems and some simple nonlinear systems. However, for complex nonlinear systems and when the system parameters change greatly, the control performance may not be ideal. The computational complexity of MPC is high, and it is necessary to solve the optimization problem in real time, so it may be difficult in applications with high real-time requirements. The design and parameter adjustment of adaptive control are relatively complex, and the requirements for system models and identification algorithms are high. The extended state observer can be used to estimate the state and total disturbance of unmanned ships and improve the accuracy of unmanned ship control, but generally requires accurate control input gain parameters. Summary of the invention
[0004] In view of the shortcomings of the prior art, the present invention provides a multimodal extended state observer for unmanned ships. Aiming at the unmanned ship dynamics model under parameter uncertainty and unknown marine environment disturbance, the present invention adopts the architecture of the supervision framework to study the state and parameter estimation of the deterministic nonlinear continuous-time system, that is, the parameter set of the control gain is sampled to form a finite set of nominal values, and a state observer is designed for each nominal value, and then a selector selects an observer according to the monitoring signal of each state observer to provide state and parameter estimation.
[0005] The technical means adopted by the present invention are as follows:
[0006] A multi-modal extended state observer for an unmanned ship, comprising: a multi-modal extended observer group for the unmanned ship's longitudinal swell velocity direction, a multi-modal extended observer group for the unmanned ship's bow roll angular velocity direction, and a dynamic controller;
[0007] The unmanned ship swell speed direction multimodal expansion observer group comprises a plurality of parallel swell speed direction expansion observer paths and a swell speed direction expansion observer selector, any of the swell speed direction expansion observer paths comprises a swell speed direction expansion observer module, a swell speed direction error signal extraction module and a swell speed direction monitoring signal module arranged in sequence, and the output end of each swell speed direction monitoring signal module is connected in parallel to the swell speed direction expansion observer selector;
[0008] The unmanned ship bow angular velocity direction multimodal expansion observer group includes a plurality of parallel bow angular velocity direction expansion observer paths and a bow angular velocity direction expansion observer selector, any of the bow angular velocity direction expansion observer paths includes a bow angular velocity direction expansion observer module, a bow angular velocity direction error signal extraction module and a bow angular velocity direction monitoring signal module arranged in sequence, and the output end of each bow angular velocity direction monitoring signal module is connected in parallel to the bow angular velocity direction expansion observer selector;
[0009] The output ends of the surge velocity direction expansion observer selector and the bow angular velocity direction expansion observer selector are connected in parallel to the dynamics controller, and the motion of the unmanned ship is controlled by the output signal of the dynamics controller.
[0010] Furthermore, the surge velocity direction expansion observer module is set to:
[0011]
[0012] in, represents the estimated value of the surge velocity on the ith path, is the estimated value of the disturbance caused by the internal uncertainty and external disturbance in the surge velocity direction on the i-th path, b ui ∈Θ, represents the unknown control gain, Θ is the known set, represents the first gain of the surge velocity observer, represents the second gain of the surge velocity observer, M is the number of channels of the surge velocity direction expansion observer, τ u represents the unmanned ship's longitudinal swing speed control torque, and u represents the unmanned ship's longitudinal swing speed.
[0013] Furthermore, the surging velocity direction error signal extraction module is configured as follows:
[0014]
[0015] in, represents the error signal of the ith path in the surge velocity direction, represents the estimation error of the surge velocity of the ith path in the surge velocity direction, σ uIt represents the actual value of the disturbance caused by internal uncertainty and external disturbance in the direction of the surge velocity.
[0016] Furthermore, the surge speed direction monitoring signal module is configured as follows:
[0017]
[0018] In the formula, λ u >0 is the monitoring parameter, for (i=1,...,M),
[0019]
[0020] μ ui (0) = 0
[0021] Among them, μ ui (t) represents the monitoring signal of the ith path in the direction of the longitudinal surge velocity, and t represents time.
[0022] Further, the surging velocity direction expansion observer selector is set to:
[0023]
[0024] Among them, ρ u (t) represents the surge velocity direction expansion observer selected at each moment according to the monitoring signal,
[0025] The most appropriate output and control gain are selected at each moment through the surge velocity direction expansion observer selector selection mechanism.
[0026]
[0027] In the formula, The control gain of the selected surge velocity direction expansion observer is The selected surge velocity direction expands the observer's surge velocity estimate, The disturbance estimate of the observer is expanded in the selected surge velocity direction and is expressed as The output is in the form of , which respectively represent the final surge velocity direction control gain, surge velocity estimation value and surge velocity direction disturbance estimation value.
[0028] Furthermore, the yaw angular velocity direction expansion observer module is set to:
[0029]
[0030] Among them, r represents the angular velocity of the unmanned ship bow, τ r It represents the unmanned ship bow angular velocity control torque, represents the first gain of the heading angular velocity observer, represents the second gain of the heading angular velocity observer, represents the estimated value of the yaw angular velocity on the jth passage, represents the estimated value of the disturbance caused by internal uncertainty and external disturbance in the direction of the yaw angular velocity on the jth path, b rj ∈Θ, represents the unknown control gain, Θ is the known set, and O is the number of expanded observer channels in the direction of the yaw angular velocity.
[0031] Furthermore, the yaw angular velocity direction error signal extraction module is configured as follows:
[0032]
[0033] in, represents the error signal of the jth path in the direction of the yaw angular velocity, represents the estimation error of the yaw angular velocity of the jth path in the yaw angular velocity direction, σ r It represents the actual value of the disturbance caused by internal uncertainty and external disturbance in the heading angular velocity direction.
[0034] Furthermore, the yaw angular velocity direction monitoring signal module is configured as follows:
[0035]
[0036] In the formula, λ r >0 is the monitoring parameter, for (j=1,...,O)
[0037]
[0038] μ rj (0) = 0
[0039] Among them, μ rj (t) represents the monitoring signal of the jth channel in the direction of the yaw angular velocity, and t represents time.
[0040] Further, the yaw angular velocity direction expansion observer selector is set to:
[0041]
[0042] Among them, ρ r (t) represents the yaw angular velocity direction expansion observer selected at each moment according to the monitoring signal,
[0043] The most appropriate output and control gain are selected at each moment through the selection mechanism of the yaw angular velocity direction expansion observer selector.
[0044]
[0045] In the formula, The control gain of the selected heading angular velocity direction expansion observer is The selected heading angular velocity direction expansion observer's heading angular velocity estimate, is the disturbance estimate of the selected yaw angular velocity direction expansion observer, and is expressed as They are output in the form of, respectively representing the final yaw angular velocity direction control gain, yaw angular velocity estimation value and yaw angular velocity direction disturbance estimation value.
[0046] Furthermore, the dynamic controller is set to:
[0047]
[0048] Among them, τ u represents the surge speed control input torque, k u represents the control coefficient of the surge velocity torque, u d represents the expected sway speed, represents the final selected surge velocity estimate, represents the estimated value of the disturbance caused by internal uncertainty and external disturbance in the final selected surge velocity direction, represents the final selected surge velocity direction control gain, τ r represents the yaw angular velocity control input torque, k r represents the control coefficient of the yaw angular velocity torque, r d represents the desired yaw angular velocity, represents the final selected estimated value of the yaw rate, represents the estimated value of the disturbance caused by internal uncertainty and external disturbance in the final selected heading angular velocity direction, Indicates the final selected yaw angular velocity direction control gain.
[0049] Compared with the prior art, the present invention has the following advantages:
[0050] First, compared with the PID-based unmanned ship dynamics controller, the multimodal extended state observer proposed in the present invention can estimate the internal model uncertainty and external ocean environment disturbance in real time, and perform real-time compensation in the control loop to improve the stability and anti-disturbance in complex ocean environments.
[0051] Second, compared with the unmanned ship neural network control method, the multimodal extended state observer proposed in the present invention is simple to design and implement, the design and parameter adjustment are not complicated, does not require a large amount of data and a complex training process, and has good robustness and real-time performance.
[0052] Third, compared with the traditional unmanned ship extended state observer, the multimodal extended state observer proposed in the present invention does not require precise control gain parameters, and can achieve accurate estimation of the unknown state of the system, model uncertainty, and external disturbances under the change of control gain. BRIEF DESCRIPTION OF THE DRAWINGS
[0053] 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.
[0054] Figure 1 This is a schematic diagram of the structure of a multimodal extended state observer for an unmanned ship of the present invention.
[0055] Figure 2 FIG. 4 is a control gain selection diagram of multi-mode ESOs in an embodiment of the present invention.
[0056] Figure 3 This is a forward speed tracking diagram of the unmanned ship in an embodiment of the present invention.
[0057] Figure 4 This is a diagram of the bow angular velocity tracking of the unmanned ship in an embodiment of the present invention.
[0058] Figure 5 This is a disturbance estimation diagram of the forward speed direction of the unmanned ship in an embodiment of the present invention.
[0059] Figure 6 This is a diagram for estimating the directional disturbance of the bow angular velocity of the unmanned ship in an embodiment of the present invention.
[0060] Figure 7 Graph showing changes in surge control thrust and bow pitch moment of an unmanned ship in an embodiment of the present invention. DETAILED DESCRIPTION
[0061] 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.
[0062] like Figure 1As shown, the present invention provides a multimodal extended state observer for an unmanned ship, comprising: a multimodal extended observer group for the longitudinal velocity direction of an unmanned ship (multimodal ESOu module), a multimodal extended observer group for the bow angular velocity direction of an unmanned ship (multimodal ESOr module) and a dynamic controller.
[0063] The unmanned ship swell speed direction multimodal expansion observer group includes a plurality of parallel swell speed direction expansion observer paths and a swell speed direction expansion observer selector. Any swell speed direction expansion observer path includes a swell speed direction expansion observer module, a swell speed direction error signal extraction module and a swell speed direction monitoring signal module arranged in sequence, and the output end of each swell speed direction monitoring signal module is connected in parallel to the swell speed direction expansion observer selector;
[0064] The unmanned ship bow angular velocity direction multimodal expansion observer group includes a plurality of parallel bow angular velocity direction expansion observer paths and a bow angular velocity direction expansion observer selector, any of the bow angular velocity direction expansion observer paths includes a bow angular velocity direction expansion observer module (multimodal ESOr module), a bow angular velocity direction error signal extraction module and a bow angular velocity direction monitoring signal module arranged in sequence, and the output end of each bow angular velocity direction monitoring signal module is connected in parallel to the bow angular velocity direction expansion observer selector.
[0065] The output ends of the surge velocity direction expansion observer selector and the bow angular velocity direction expansion observer selector are connected in parallel to the dynamics controller, and the motion of the unmanned ship is controlled by the output signal of the dynamics controller.
[0066] In this embodiment, the multimodal ESOu module is composed of M swell velocity direction expansion observer modules (ESO in u direction), M swell velocity direction error signal extraction modules (used to extract the error signal in u direction), M swell velocity direction monitoring signal modules (used to extract the monitoring signal in u direction) and 1 swell velocity direction expansion observer selector (i.e., ESO selector in u direction); the multimodal ESOr module is composed of O bow angular velocity direction expansion observer modules (ESO in r direction), O bow angular velocity direction error signal extraction modules (used to extract the error signal in r direction), O bow angular velocity direction monitoring signal modules (used to extract the monitoring signal in r direction) and 1 O bow angular velocity direction expansion observer selector (i.e., ESO selector in r direction).
[0067] The input signal of the unmanned ship is the output signal of the dynamic controller, which controls the input torque τ u , τ rThe unmanned ship outputs its own sway velocity u to M u-direction ESOs and M u-direction error signals, and outputs its bow angular velocity r to O r-direction ESOs and O r-direction error signals; the input end of the dynamic controller is connected to the output end of the u-direction ESO selector and the r-direction ESO selector, and the input signals are The output end of the dynamic controller is connected to the input end of the unmanned ship, M ESOs in the u direction, and O ESOs in the r direction, respectively. The output signal is τ u , τ r .
[0068] The output terminal of ESO1 (the first ESO in the u direction) in the u direction (the output signal is b u1 ) is connected to the input end of the u direction error signal 1, and the output end of the u direction error signal 1 (the output signal is e% u1 、b u1 ) is connected to the input end of the u direction monitoring signal 1, and the output end of the u direction monitoring signal 1 (the output signal is μ u1 ) is connected to the input end of the u direction ESO selector; i The output terminal (output signal is b ui ) is connected to the input end of the u direction error signal i, and the output end of the u direction error signal i (the output signal is e% ui 、b ui ) is connected to the input end of the u direction monitoring signal i, and the output end of the u direction monitoring signal i (the output signal is μ ui ) is connected to the input of the ESO selector in the u direction.
[0069] The output terminal of ESO1 (the first ESO in the r direction) in the r direction (the output signal is b r1 ) is connected to the input end of the r direction error signal 1, and the output end of the r direction error signal 1 (the output signal is e% r1 、b r1 ) is connected to the input end of the r direction monitoring signal 1, and the output end of the r direction monitoring signal 1 (the output signal is μ r1 ) is connected to the input of the ESO selector in the r direction; j The output terminal of the jth ESO in the r direction (the output signal is ) is connected to the input end of the r direction error signal j, and the output end of the r direction error signal j (the output signal is e% rj 、b rj ) is connected to the input end of the r direction monitoring signal j, and the output end of the r direction monitoring signal j (the output signal is μ rj) is connected to the input of the ESO selector in the r direction; the output of the ESO selector in the r direction (the output signal is ) is connected to the input of the dynamics controller.
[0070] The dynamic model of the unmanned ship can be expressed as:
[0071]
[0072] In the formula, m u 、m v and m r They represent the inertial mass of the underactuated unmanned ship in the surge direction, roll direction and bow angular velocity direction respectively; f u (·),f v (·) and f r (·) represents the unknowns including the Coriolis force term, unmodeled dynamics, and damping terms; τ wu , τ wv and τ wr Respectively represent the unknown disturbances in three directions caused by wind, waves and currents; τ u , τ r They represent the control force and torque of the under-actuated unmanned ship respectively.
[0073] The following is a detailed description of the design of each functional module:
[0074] AU Direction ESO i
[0075] Design M ESOs, ESO in u direction i is the i-th ESO (i=1,...,M) in the u direction, and its input terminals are connected to the output terminals of the unmanned ship and the output terminals of the dynamic controller, respectively. The input signals are u and τ u ,get b ui ,
[0076]
[0077] In the formula, represents the estimated value of the surge velocity on the ith path, is the estimated value of the disturbance caused by the internal uncertainty and external disturbance in the surge velocity direction on the i-th path, b ui ∈Θ, represents the unknown control gain, Θ is the known set, represents the first gain of the surge velocity observer, represents the second gain of the surge velocity observer, M is the number of channels of the surge velocity direction expansion observer, τ u represents the unmanned ship sway speed control torque, and u represents the unmanned ship sway speed. The observer gains are all preset values.
[0078] u Direction ESO i The output end of is connected to the input end of the u direction error signal i, and the output signal is b ui .
[0079] Bu direction error signal i
[0080] Each ESO generates an error signal. The error signal i in the u direction is the i-th error signal in the multi-modal ESOu module. The input ends are connected to the u direction ESO i Connected to the output end of the unmanned ship, the input signals are b ui and u, we get the error signal
[0081]
[0082] represents the error signal of the ith path in the surge velocity direction, represents the estimation error of the surge velocity of the ith path in the surge velocity direction, σ u It represents the actual value of the disturbance caused by internal uncertainty and external disturbance in the direction of the surge velocity.
[0083] Cu direction monitoring signal i
[0084] Each ESO will generate an error signal, and a corresponding monitoring signal is designed for each error signal. The u-direction monitoring signal i is the i-th monitoring signal in the multimodal ESOu module. The input end is connected to the output end of the u-direction error signal i. The input signal is b ui , and obtain the monitoring signal μ ui ,
[0085]
[0086] In the formula, λ u >0 is the monitoring parameter, for (i=1,...,M),
[0087]
[0088] μ ui (0) = 0
[0089] Among them, μ ui (t) represents the monitoring signal of the ith path in the direction of the longitudinal surge velocity, and t represents time.
[0090] The output end of the u direction monitoring signal i is connected to the input end of the u direction ESO selector, and the output signal is μui 、b ui .
[0091] Du direction ESO selector
[0092] The input end of the u-direction ESO selector is connected to the output end of the M u-direction monitoring signals in the multi-modal ESOu module. The input signal is μ u1 ~μ uM , according to the designed selection mechanism, select ESO1~ESO in the u direction M The most suitable ESO,
[0093]
[0094] The most appropriate output and control gain are selected at each moment through the above selection mechanism.
[0095]
[0096] In the formula, The control gain of the selected surge velocity direction expansion observer is The selected surge velocity direction expands the observer's surge velocity estimate, The disturbance estimate of the observer is expanded in the selected surge velocity direction and is expressed as The output is in the form of , which respectively represent the final surge velocity direction control gain, surge velocity estimation value and surge velocity direction disturbance estimation value.
[0097] The output of the u-direction ESO selector is connected to the input of the dynamics controller, and the output signal is
[0098] Er direction ESOj
[0099] Design O ESOs, R direction ESO j is the jth ESO (j=1,...,O) in the r direction, and its input terminals are connected to the output terminals of the unmanned ship and the output terminals of the dynamic controller, respectively. The input signals are r and τ r ,get b rj ,
[0100]
[0101] Among them, r represents the bow angular velocity of the unmanned ship, τ r It represents the unmanned ship bow angular velocity control torque, represents the first gain of the heading angular velocity observer, represents the second gain of the heading angular velocity observer, represents the estimated value of the yaw angular velocity on the jth passage, represents the estimated value of the disturbance caused by internal uncertainty and external disturbance in the direction of the yaw angular velocity on the jth path, b rj ∈Θ, represents the unknown control gain, Θ is a known set, and O is the number of extended observer channels in the yaw angular velocity direction. The output of ESOj in the r direction is connected to the input of the error signal j in the r direction, and the output signal is b rj .
[0102] Fr direction error signal j
[0103] Each ESO generates an error signal. The error signal j in the r direction is the jth error signal in the multi-modal ESOr module. The input ends are connected to the ESO in the r direction respectively. j Connected to the output end of the unmanned ship, the input signals are b rj and r, we get the error signal e rj ,
[0104]
[0105] in, represents the error signal of the jth path in the direction of the yaw angular velocity, represents the estimation error of the yaw angular velocity of the jth path in the yaw angular velocity direction, σ r It represents the actual value of the disturbance caused by internal uncertainty and external disturbance in the heading angular velocity direction.
[0106] Gr direction monitoring signal j
[0107] Each ESO will generate an error signal, and a corresponding monitoring signal is designed for each error signal. The r-direction monitoring signal j is the jth monitoring signal in the multimodal ESOr module. The input end is connected to the output end of the r-direction error signal j. The input signal is b rj , and obtain the monitoring signal μ rj ,
[0108]
[0109] In the formula, λ r >0 is the monitoring parameter, for (j=1,...,O)
[0110]
[0111] μ rj (0) = 0
[0112] Among them, μ rj(t) represents the monitoring signal of the jth channel in the direction of the yaw angular velocity, and t represents time.
[0113] The output end of the r direction monitoring signal j is connected to the input end of the r direction ESO selector, and the output signal is μ rj 、b rj .
[0114] HR direction ESO selector
[0115] The input end of the r-direction ESO selector is connected to the output end of the O r-direction monitoring signals in the multi-modal ESOr module. The input signal is μ r1 ~μ rO , according to the designed selection mechanism, select the r direction ESO1~ESO O The most suitable ESO,
[0116]
[0117] Among them, ρ r (t) represents the yaw angular velocity direction expansion observer selected at each moment according to the monitoring signal.
[0118] The most appropriate output and control gain are selected at each moment through the above selection mechanism.
[0119]
[0120] In the formula, The control gain of the selected heading angular velocity direction expansion observer is The selected heading angular velocity direction expansion observer's heading angular velocity estimate, is the disturbance estimate of the selected yaw angular velocity direction expansion observer, and is expressed as They are output in the form of, respectively representing the final yaw angular velocity direction control gain, yaw angular velocity estimation value and yaw angular velocity direction disturbance estimation value.
[0121] The output of the ESO selector in the r direction is connected to the input of the dynamics controller, and the output signal is
[0122] I. Dynamics Controller
[0123] The input of the dynamic controller is connected to the output of the u-direction ESO selector and the r-direction ESO selector. The input signal is and According to the dynamic control law, the surge speed control input torque τ is obtained u and the yaw angular velocity control input torque τ r ,
[0124]
[0125] Among them, τ u represents the surge speed control input torque, k u represents the control coefficient of the surge velocity torque, u d represents the expected sway speed, represents the final selected surge velocity estimate, represents the estimated value of the disturbance caused by internal uncertainty and external disturbance in the final selected surge velocity direction, represents the final selected surge velocity direction control gain, τ r represents the yaw angular velocity control input torque, k r represents the control coefficient of the yaw angular velocity torque, r d represents the desired yaw angular velocity, represents the final selected estimated value of the yaw rate, represents the estimated value of the disturbance caused by internal uncertainty and external disturbance in the final selected heading angular velocity direction, Indicates the final selected yaw angular velocity direction control gain.
[0126] The output end of the dynamic controller is connected to the input end of the unmanned ship, M ESOs in the u direction, and O ESOs in the r direction, respectively. The output signal is τ u , τ r .
[0127] The present invention is further described below by taking an underactuated unmanned ship as an example. The unmanned ships all satisfy the dynamic model in equation (1), and the control goal of the ship is to track the desired direction during the moving process.
[0128] The control system structure of the unmanned ship is as follows: Figure 1 The simulation results are shown in Figure 2-7 shown. Figure 2 The control gain selection diagram of the proposed multi-modal extended state observer (ESOs) shows that during the driving process, the multi-modal ESOs corresponding to the forward speed direction and the yaw angular velocity direction are constantly selecting a suitable ESO. u 、b r The actual values of are 1 / 25.8 and 1 / 2.76, and the range selected in the simulation is 0 to 10, which shows that by using the proposed monitoring mechanism, the nominal control input similar to the true value can be selected. Figure 3 The estimated forward velocity, actual forward velocity and expected forward velocity are displayed. It can be seen that the proposed multimodal ESOs can better estimate the actual velocity of the unmanned ship and better track the expected forward velocity. Figure 4The estimated angular velocity, actual angular velocity and expected angular velocity are displayed. It can be seen that the proposed multimodal ESOs can better estimate the actual angular velocity of the unmanned ship and better track the expected angular velocity. Figure 5 The figure shows the estimation of the unknown disturbance in the forward velocity direction by the multimodal ESO. The solid line is the actual disturbance, and the dotted line is the disturbance estimated by the multimodal ESOs. It can be seen that the multimodal ESOs can well estimate the unknown disturbance in the forward velocity direction of the unmanned ship. Figure 6 The figure shows the estimation of the unknown disturbance in the direction of the bow angular velocity by the multimodal ESO. The solid line is the actual disturbance, and the dotted line is the disturbance estimated by the multimodal ESOs. It can be seen that the multimodal ESOs can well estimate the unknown disturbance in the direction of the bow angular velocity of the unmanned ship. Figure 7 The actual changes of forward control thrust and bow pitch moment are shown respectively.
[0129] 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 multimodal extended state observer for an unmanned ship, characterized in that: include: An unmanned ship longitudinal swell velocity direction multi-modal expansion observer group, an unmanned ship bow sway angular velocity direction multi-modal expansion observer group and a dynamic controller; The unmanned ship swell speed direction multimodal expansion observer group comprises a plurality of parallel swell speed direction expansion observer paths and a swell speed direction expansion observer selector, any of the swell speed direction expansion observer paths comprises a swell speed direction expansion observer module, a swell speed direction error signal extraction module and a swell speed direction monitoring signal module arranged in sequence, and the output end of each swell speed direction monitoring signal module is connected in parallel to the swell speed direction expansion observer selector; The unmanned ship bow angular velocity direction multimodal expansion observer group includes a plurality of parallel bow angular velocity direction expansion observer paths and a bow angular velocity direction expansion observer selector, any of the bow angular velocity direction expansion observer paths includes a bow angular velocity direction expansion observer module, a bow angular velocity direction error signal extraction module and a bow angular velocity direction monitoring signal module arranged in sequence, and the output end of each bow angular velocity direction monitoring signal module is connected in parallel to the bow angular velocity direction expansion observer selector; The output ends of the surge velocity direction expansion observer selector and the bow angular velocity direction expansion observer selector are connected in parallel to the dynamics controller, and the motion of the unmanned ship is controlled by the output signal of the dynamics controller.
2. The multimodal extended state observer for an unmanned ship according to claim 1, characterized in that: The surge velocity direction expansion observer module is set as: in, represents the estimated value of the surge velocity on the ith path, is the estimated value of the disturbance caused by the internal uncertainty and external disturbance in the surge velocity direction on the i-th path, b ui ∈Θ, represents the unknown control gain, Θ is the known set, represents the first gain of the surge velocity observer, represents the second gain of the surge velocity observer, M is the number of channels of the surge velocity direction expansion observer, τ u represents the unmanned ship's longitudinal swing speed control torque, and u represents the unmanned ship's longitudinal swing speed.
3. The multimodal extended state observer for an unmanned ship according to claim 2, characterized in that: The surge velocity direction error signal extraction module is configured as follows: in, represents the error signal of the ith path in the surge velocity direction, represents the estimation error of the surge velocity of the ith path in the surge velocity direction, σ u It represents the actual value of the disturbance caused by internal uncertainty and external disturbance in the direction of the surge velocity.
4. The multimodal extended state observer for an unmanned ship according to claim 3, characterized in that: The surge speed direction monitoring signal module is configured as follows: In the formula, λ u >0 is the monitoring parameter, for (i=1,...,M), m ui (0)=0 Among them, μ ui (t) represents the monitoring signal of the ith path in the direction of the longitudinal surge velocity, and t represents time.
5. The multimodal extended state observer for an unmanned ship according to claim 4, characterized in that: The surge velocity direction expansion observer selector is set to: Among them, ρ u (t) represents the surge velocity direction expansion observer selected at each moment according to the monitoring signal, The most appropriate output and control gain are selected at each moment through the surge velocity direction expansion observer selector selection mechanism. In the formula, The control gain of the selected surge velocity direction expansion observer is The selected surge velocity direction expands the observer's surge velocity estimate, The disturbance estimate of the observer is expanded in the selected surge velocity direction and is expressed as The output is in the form of , which respectively represent the final surge velocity direction control gain, surge velocity estimation value and surge velocity direction disturbance estimation value.
6. The multimodal extended state observer for an unmanned ship according to claim 1, characterized in that: The yaw angular velocity direction expansion observer module is set as: Among them, r represents the bow angular velocity of the unmanned ship, τ r represents the unmanned ship bow angular velocity control torque, represents the first gain of the heading angular velocity observer, represents the second gain of the heading angular velocity observer, represents the estimated value of the yaw angular velocity on the jth passage, represents the estimated value of the disturbance caused by internal uncertainty and external disturbance in the direction of the yaw angular velocity on the jth path, b rj ∈Θ, represents the unknown control gain, Θ is the known set, and O is the number of expanded observer channels in the direction of the yaw angular velocity.
7. The multimodal extended state observer for an unmanned ship according to claim 6, characterized in that: The yaw angular velocity direction error signal extraction module is set as: in, represents the error signal of the jth path in the direction of the yaw angular velocity, represents the estimation error of the yaw angular velocity of the jth path in the yaw angular velocity direction, σ r It represents the actual value of the disturbance caused by internal uncertainty and external disturbance in the heading angular velocity direction.
8. The multi-modal extended state observer for an unmanned ship according to claim 7, characterized in that: The yaw angular velocity direction monitoring signal module is configured as follows: In the formula, λ r >0 is the monitoring parameter, for (j=1,...,O) m rj (0)=0 Among them, μ rj (t) represents the monitoring signal of the jth channel in the direction of the yaw angular velocity, and t represents time.
9. The multimodal extended state observer of an unmanned ship according to claim 8, characterized in that: The yaw rate direction expansion observer selector is set to: Among them, ρ r (t) represents the yaw angular velocity direction expansion observer selected at each moment according to the monitoring signal, The most appropriate output and control gain are selected at each moment through the selection mechanism of the yaw angular velocity direction expansion observer selector. In the formula, The control gain of the selected heading angular velocity direction expansion observer is The selected heading angular velocity direction expansion observer's heading angular velocity estimate, is the disturbance estimate of the selected yaw angular velocity direction expansion observer, and is expressed as They are output in the form of, respectively representing the final yaw angular velocity direction control gain, yaw angular velocity estimation value and yaw angular velocity direction disturbance estimation value.
10. The multimodal extended state observer of an unmanned ship according to claim 1, characterized in that: The dynamics controller is set up as: Among them, τ u represents the surge speed control input torque, k u represents the control coefficient of the surge velocity torque, u d represents the expected sway speed, represents the final selected surge velocity estimate, represents the estimated value of the disturbance caused by internal uncertainty and external disturbance in the final selected surge velocity direction, represents the final selected surge velocity direction control gain, τ r represents the yaw angular velocity control input torque, k r represents the control coefficient of the yaw angular velocity torque, r d represents the desired yaw angular velocity, represents the final selected estimated value of the yaw rate, represents the estimated value of the disturbance caused by internal uncertainty and external disturbance in the final selected heading angular velocity direction, Indicates the final selected yaw angular velocity direction control gain.
