Cascade expansion state observer for unmanned surface vehicle

By designing the unmanned boat cascaded expansion state observer, using the cascade branches of combined speed and bow angular velocity, the problem of traditional expansion state observer amplification due to high gain is solved, and high-precision disturbance estimation in a noise environment is achieved , improves the control performance of unmanned boats.

CN118915450APending Publication Date: 2024-11-08DALIAN MARITIME UNIVERSITY
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410967362.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-18
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

The existing unmanned boat disturbance estimation method based on expansion state observers has a high gain that causes measurement noise amplification to affect the estimation performance, and does not fully consider the measurement noise of the speed sensor, which limits the practical application effectiveness of the method.

Method used

A cascaded expansion state observer of an unmanned boat is designed. Through two cascaded expansion state observation branches of combined speed and bow angular velocity, it includes the cascaded first-stage and second-stage expansion state observer modules, using To estimate the internal model uncertainty and external perturbation of the unmanned boat, the impact of noise on the estimation is reduced.

Benefits of technology

It effectively overcomes the problem of high-gain observer amplification of measurement noise, accurately estimates velocity signals and concentrated disturbances, improves the estimation performance in a noisy environment, and enhances the immunity of unmanned boats.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118915450A_ABST
    Figure CN118915450A_ABST
Patent Text Reader

Abstract

The invention discloses an unmanned ship cascade expansion state observer, which comprises a resultant velocity state observation branch and a yawing angular velocity state observation branch, and is characterized in that the resultant velocity state observation branch comprises a first-stage resultant velocity expansion observer module and a second-stage resultant velocity expansion observer module which are cascaded; and the yawing angular velocity state observation branch comprises a first-stage yawing angular velocity extended observer module and a second-stage yawing angular velocity extended observer module which are cascaded. According to the invention, the two-stage unmanned ship resultant velocity cascade expansion state observer and the two-stage unmanned ship yawing angular velocity cascade expansion state observer are used to estimate the internal model uncertainty of the unmanned ship and the concentrated disturbance caused by the external environment in the presence of measurement noise; accurate estimation of disturbance by the high-gain observer in the presence of measurement noise is realized.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the field of unmanned boat motion control, and in particular to an unmanned boat cascade expansion state observer. Background Art

[0002] In recent years, under the influence of the strategy of building a strong maritime nation, unmanned submerged vehicle (ASV) has received more and more attention in marine operations due to its low cost and intelligent characteristics. Having good control performance is the basis for the safe and reliable application of unmanned submerged vehicle. Since unmanned submerged vehicle is affected by many factors such as wind, waves and currents in the marine environment, traditional PID control cannot achieve good control effect. In order to realize the anti-interference function of unmanned submerged vehicle, the self-disturbance rejection control technology based on the extended state observer (ESO) has been widely used in the field of unmanned submerged vehicle dynamic control. The self-disturbance rejection control of unmanned submerged vehicle aims to use the extended state observer to estimate and compensate for the unknown concentrated disturbance of the unmanned submerged vehicle in real time, significantly improving the performance and stability of the unmanned submerged vehicle.

[0003] In terms of using extended state observers to estimate unknown disturbances of unmanned boats, domestic and foreign researchers have achieved corresponding research results. T. Tahsin et al. proposed a non-singular terminal sliding mode control scheme based on adaptive neural networks and nonlinear extended state observers, using nonlinear extended state observers to estimate and compensate for model uncertainties and external disturbances, and accurately track the trajectory of unmanned boats. L. Liu et al. proposed a nonlinear extended state observer with finite time convergence, which can reconstruct speed and disturbance information from position and heading information using only the global positioning system (GPS) and gyrocompass. Z. Peng et al. proposed a data-driven adaptive extended state observer algorithm to estimate disturbances, which can achieve cluster behavior without any prior information of model parameters. L. Liu et al. proposed an event-triggered extended state observer, which establishes reliable event triggering conditions based only on position and heading information to avoid unnecessary communication and significantly reduce the communication cost between sensors and observers.

[0004] There are some feasible technical solutions for estimating unknown disturbances using extended state observers, but the existing patents still have the following problems:

[0005] First, most of the existing disturbance estimation methods based on extended state observers have the problem that the extended state observer amplifies the impact of measurement noise on the estimation performance due to its high gain. The contradiction between the accurate estimation of uncertain disturbances and noise sensitivity is a problem that needs to be solved urgently.

[0006] Second, most of the existing disturbance estimation methods for unmanned boats based on extended state observers do not fully consider the existence of measurement noise in the speed sensor. This simplified assumption of ignoring the influence of noise limits the effectiveness of these methods in the actual application of unmanned boats. Summary of the invention

[0007] In view of the shortcomings of the prior art, the present invention provides an unmanned boat cascade extended state observer. The present invention respectively designs a two-stage unmanned boat combined velocity cascade extended state observer and a two-stage unmanned boat bow angular velocity cascade extended state observer to estimate the internal model uncertainty of the unmanned boat under the presence of measurement noise and the concentrated disturbance caused by the external environment, so as to achieve accurate estimation of the disturbance by the high-gain observer under the presence of measurement noise.

[0008] The technical means adopted by the present invention are as follows:

[0009] An unmanned boat cascade expansion state observer comprises a combined speed state observation branch and a bow angular velocity state observation branch, wherein the input of the combined speed state observation branch comprises an actual unmanned boat combined speed signal extracted by a combined speed sensor and an unmanned boat combined speed direction control input signal, and the input of the bow angular velocity state observation branch comprises an actual unmanned boat bow angular velocity signal extracted by a bow angular velocity sensor and an unmanned boat bow angular velocity direction control input signal;

[0010] The combined speed state observation branch includes a cascaded first-stage combined speed extension observer module and a second-stage combined speed extension observer module;

[0011] The input end of the first-stage combined speed expansion state observer module is respectively connected to the combined speed direction control input signal of the unmanned boat and the output end of the combined speed sensor module, and the output end of the first-stage combined speed expansion state observer module is connected to the input end of the second-stage combined speed expansion state observer module;

[0012] The input end of the second-stage combined speed expansion state observer module is respectively connected to the combined speed direction control input signal of the unmanned boat and the output end of the first-stage combined speed expansion state observer module; the second-stage combined speed expansion state observer module outputs the combined speed direction concentrated disturbance estimation of the unmanned boat;

[0013] The yaw angular velocity state observation branch comprises a cascaded first-stage yaw angular velocity extended observer module and a second-stage yaw angular velocity extended observer module;

[0014] The input end of the first-stage bow angular velocity expansion state observer module is respectively connected to the unmanned boat bow angular velocity direction control input signal and the output end of the bow angular velocity sensor module, and the output end of the first-stage bow angular velocity expansion state observer module is connected to the input end of the second-stage bow angular velocity expansion state observer module;

[0015] The input end of the second-stage bow angular velocity expansion state observer module is respectively connected to the unmanned boat bow angular velocity direction control input signal and the output end of the first-stage bow angular velocity expansion state observer module, and the second-stage bow angular velocity expansion state observer module outputs the unmanned boat bow angular velocity direction concentrated disturbance estimation.

[0016] Further, the first-stage combined speed extension observer module is configured as:

[0017]

[0018] In the formula, y U =U+ν U is the actual combined speed signal of the unmanned boat obtained by the combined speed sensor, ν U is the noise signal, U is the combined speed of the unmanned boat, The estimation of the combined speed of the unmanned boat by the first-stage combined speed extended state observer; It is the estimation of the disturbance of the combined velocity direction of the unmanned boat by the first-stage combined velocity extended state observer; is the positive first-order total velocity extended observer gain, m u is the hull inertia coefficient of the unmanned boat in the direction of the combined speed, τ u It is the input force for the combined speed and direction control of the unmanned boat.

[0019] Furthermore, the second-stage combined speed extension observer module is configured as:

[0020]

[0021] In the formula, The estimation of the combined speed of the unmanned boat by the second-stage combined speed extended state observer; is the total estimate of the disturbance in the combined velocity direction of the unmanned boat by the second-stage combined velocity extended state observer, is the intermediate estimate of the disturbance in the combined velocity direction of the unmanned boat by the second-stage combined velocity extended state observer, is the gain of the traditional combined velocity extended state observer,

[0022] Further, the first-stage yaw angular velocity expansion state observer module is set to:

[0023]

[0024] In the formula, y r =r+ν r is the actual bow angular velocity signal of the unmanned boat obtained by the bow angular velocity sensor, v r is the noise signal, r is the bow angular velocity of the unmanned boat, is the estimation of the bow angular velocity of the unmanned boat by the first-stage bow angular velocity extended state observer, is the estimation of the bow angular velocity expansion state observer of the first stage bow angular velocity for the unmanned boat bow directional disturbance, is the positive first-stage yaw angular velocity expansion state observer gain, m r is the hull inertia coefficient of the unmanned boat in the direction of the bow angular velocity, τ r Input torque for the unmanned boat's bow angular velocity direction control.

[0025] Furthermore, the second-stage yaw angular velocity expansion state observer module is set to:

[0026]

[0027] In the formula, is the estimation of the bow angular velocity of the unmanned boat by the second-stage bow angular velocity extended state observer, is the total estimate of the bow angular velocity extended state observer of the second-stage bow angular velocity for the unmanned boat bow directional disturbance, is the intermediate estimate of the bow angular velocity expansion state observer of the second-stage bow angular velocity for the unmanned boat bow directional disturbance, is the gain of the traditional heading angle expansion state observer,

[0028] Compared with the prior art, the present invention has the following advantages:

[0029] 1. Compared with the existing unmanned boat extended state observer method, the unmanned boat cascade extended state observer method proposed in the present invention cleverly cascades two extended state observers with different parameters, which can overcome the limitation of the traditional extended state observer that amplifies the impact of measurement noise on estimation performance due to high gain.

[0030] 2. Compared with the existing unmanned boat extended state observer method, the unmanned boat cascade extended state observer method proposed in the present invention is convenient for effectively filtering out the noise of the speed signal in a noisy environment and accurately estimating the speed signal and concentrated disturbance, which is more conducive to practical application. BRIEF DESCRIPTION OF THE DRAWINGS

[0031] 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.

[0032] Figure 1 The figure is a schematic diagram of the structure of a cascade expansion state observer for an unmanned boat in an embodiment of the present invention.

[0033] Figure 2 is the estimated error of the combined speed of the unmanned boat in the presence of measurement noise in the embodiment of the present invention Simulation diagram.

[0034] Figure 3 is the estimation error of the bow angular velocity of the unmanned boat under the measurement noise in the embodiment of the present invention Simulation diagram.

[0035] Figure 4 This is a simulation diagram of disturbance estimation of the combined velocity direction of the unmanned boat in the presence of measurement noise in an embodiment of the present invention.

[0036] Figure 5 This is a simulation diagram of disturbance estimation of the bow roll direction of an unmanned boat in the presence of measurement noise in an embodiment of the present invention. DETAILED DESCRIPTION

[0037] 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.

[0038] like Figure 1 As shown, an unmanned boat cascade expanded state observer structure includes: a combined speed sensor module, a first-stage combined speed expanded state observer module, a second-stage combined speed expanded state observer module, a bow angular velocity sensor module, a first-stage bow angular velocity expanded state observer module, a second-stage bow angular velocity expanded state observer module and an unmanned boat module. Specifically,

[0039] The input end of the combined speed sensor module is connected to the combined speed output end of the unmanned boat module and the combined speed noise signal v U The output end of the closing speed sensor module is connected to the input end of the first-stage closing speed expanded state observer module.

[0040] The input end of the first-stage combined velocity expansion state observer module is respectively connected to the combined velocity direction control input force τ of the unmanned boat u , the output end of the closing speed sensor module is connected; the output end of the first-stage closing speed expansion state observer module is connected to the input end of the second-stage closing speed expansion state observer module.

[0041] The input end of the second-level combined speed expanded state observer module is respectively connected to the unmanned boat combined speed direction control input signal and the output end of the first-level combined speed expanded state observer module; the output end of the second-level combined speed expanded state observer module is connected to the unmanned boat combined speed direction concentrated disturbance estimation.

[0042] The input end of the bow angular velocity sensor module is connected to the bow angle output end of the unmanned boat module and the bow angle noise signal v r The output end of the bow angular velocity sensor module is connected to the input end of the first-stage bow angular velocity expanded state observer module.

[0043] The input end of the first-stage bow angular velocity expansion state observer module is respectively connected to the unmanned boat bow angular direction control input signal τ r , the output end of the bow angular velocity sensor module is connected; the output end of the first-stage bow angular velocity expanded state observer module is connected to the input end of the second-stage bow angular velocity expanded state observer module.

[0044] The input end of the second-stage bow angular velocity expansion state observer module is respectively connected to the unmanned boat bow angular direction control input signal τ r , the output end of the first-stage bow angular velocity expansion state observer module is connected to the output end of the second-stage bow angular velocity expansion state observer module and the unmanned boat bow angular velocity concentrated disturbance estimation connected.

[0045] The input end of the unmanned boat module is respectively connected to the unmanned boat speed direction control input signal τ u 、Unmanned boat bow angular velocity direction control input signal τ r The output end of the unmanned boat module is respectively connected to the input end of the combined speed sensor module and the input end of the bow angular velocity sensor module.

[0046] In the present invention, the dynamic model equation of the unmanned boat is described as:

[0047]

[0048] In the formula, represents the speed vector of the unmanned boat, u represents the swell speed vector, v represents the drift speed, r represents the bow angular speed vector, and the vector sum of the swell speed vector and the drift speed vector constitutes the combined speed vector u of the unmanned boat; represents the input force and torque vector of the unmanned boat control, where τ u is the input force for the combined speed direction control of the unmanned boat, τ v is the lateral thrust of the unmanned boat, τ r Input torque for the unmanned boat's bow angular velocity direction control; represents the disturbance vector caused by wind, waves and currents, where τ wu is the forward disturbance of the unmanned boat, τ wv is the lateral disturbance of the unmanned boat, τ wr is the bow roll directional disturbance of the unmanned boat; g(ν) includes the unmodeled fluid dynamics and modeling errors; is the hull inertial mass matrix; is the centripetal force and Coriolis force coefficient matrix; is the damping matrix.

[0049] Where M satisfies

[0050]

[0051] In the formula, is the hull inertia coefficient in each direction, where m u is the inertial mass of the unmanned boat in the longitudinal direction, m v is the inertial mass of the unmanned boat in the lateral direction, m r is the inertial mass of the unmanned boat in the bow rolling direction, m vr is the inertial coupling mass of the unmanned boat in the lateral direction to the bow rolling direction, m rv It is the inertial coupling mass of the unmanned boat in the bow rolling direction to the lateral direction.

[0052] Let F(ν)=-C(ν)ν-D(ν)ν+g(ν)=[f u (u,v,r),f v (u,v,r),f r (u,v,r)] T , rewrite formula (1) as follows:

[0053]

[0054] Furthermore, since u = Ucos(β), v = Usin(β), the dynamic equations of U and r can be written as

[0055]

[0056] In the formula, σ U and σ r The concentrated disturbance to the unmanned boat;

[0057] β = arctan (v / u) is the sideslip angle of the unmanned boat.

[0058] The input end of the unmanned boat dynamics system is connected to the unmanned boat speed direction control input signal τ u 、Unmanned boat bow angular velocity direction control input signal τ r The output end of the unmanned boat dynamics system is connected to the unmanned boat speed signals U and r.

[0059] As a preferred embodiment of the present invention, the input end of the first-stage combined speed expansion state observer module is respectively connected to the unmanned boat combined speed direction control input signal τ u , the output signal y of the speed sensor module U The output signal of the first-stage combined speed expansion state observer module is obtained through the following transformation

[0060]

[0061] In the formula, y U =U+ν U is the actual combined speed signal of the unmanned boat obtained by the combined speed sensor, ν U is the noise signal, U is the combined speed of the unmanned boat, The estimation of the combined speed of the unmanned boat by the first-stage combined speed extended state observer; It is the estimation of the disturbance of the combined velocity direction of the unmanned boat by the first-stage combined velocity extended state observer; is the positive first-order total velocity extended observer gain, m u is the hull inertia coefficient of the unmanned boat in the direction of the combined speed, τ u It is the input force for the combined speed and direction control of the unmanned boat.

[0062] As a preferred embodiment of the present invention, the input end of the second-stage combined speed expansion state observer module is respectively connected to the unmanned boat combined speed direction control input signal τ u , the output signal of the first stage combined speed expansion state observer module The output signal of the second-stage combined speed expansion state observer module is obtained through the following transformation

[0063]

[0064] In the formula, The estimation of the combined speed of the unmanned boat by the second-stage combined speed extended state observer; is the total estimate of the disturbance in the combined velocity direction of the unmanned boat by the second-stage combined velocity extended state observer, is the intermediate estimate of the disturbance in the combined velocity direction of the unmanned boat by the second-stage combined velocity extended state observer, is the gain of the traditional combined velocity extended state observer, The conventional combined velocity extended state observer refers to an observer without a cascade structure that is commonly used in the prior art.

[0065] As a preferred embodiment of the present invention, the input end of the first-stage bow angular velocity expansion state observer module is respectively connected to the unmanned boat bow angular velocity direction control input signal τ r , the output signal y of the yaw angular velocity sensor module r The output signal of the first-stage bow angular velocity expansion state observer module is obtained through the following transformation

[0066]

[0067] In the formula, y r =r+ν r is the actual bow angular velocity signal of the unmanned boat obtained by the bow angular velocity sensor, v r is the noise signal, r is the bow angular velocity of the unmanned boat, is the estimation of the bow angular velocity of the unmanned boat by the first-stage bow angular velocity extended state observer, is the estimation of the bow angular velocity expansion state observer of the first stage bow angular velocity for the unmanned boat bow directional disturbance, is the positive first-stage yaw angular velocity expansion state observer gain, m r is the hull inertia coefficient of the unmanned boat in the direction of the bow angular velocity, τ r Input torque for the unmanned boat's bow angular velocity direction control.

[0068] As a preferred embodiment of the present invention, the input end of the second-stage bow angular velocity expansion state observer module is respectively connected to the unmanned boat bow angular velocity direction control input signal τ r , the output signal of the first-stage bow angular velocity expansion state observer module The output signal of the second-stage yaw angular velocity expansion state observer module is obtained through the following transformation

[0069]

[0070] In the formula, is the estimation of the bow angular velocity of the unmanned boat by the second-stage bow angular velocity extended state observer, is the total estimate of the bow angular velocity extended state observer of the second-stage bow angular velocity for the unmanned boat bow directional disturbance, is the intermediate estimate of the bow roll direction disturbance of the unmanned boat by the second-stage combined velocity extended state observer, is the gain of the traditional heading angle expansion state observer,

[0071] The scheme and effect of the present invention are further described below through specific application examples.

[0072] The simulation test is as follows:

[0073] The parameters of the unmanned boat model are as follows:

[0074]

[0075] g(ν)=[0,0,0] T ; τ w (t)=[-0.2cos(t)cos(1.5t),0.01sin(0.1t),-0.3sin(2t)cos(2.3t)] T .

[0076] The external measurement noise signal of the system follows the normal distribution N(0,0.02 2 ) is a random white noise.

[0077] Cascaded extended state observer parameters:

[0078] The simulation results are as follows Figures 2 to 5 shown.

[0079] Figure 2 and Figure 3 They are the error diagram of the combined velocity estimation of the unmanned boat and the error diagram of the bow angular velocity estimation of the unmanned boat. It can be seen from the figures that in the presence of measurement noise, the estimation performance of the cascaded extended state observer for the combined velocity and bow angular velocity is better than that of the traditional extended state observer. Figure 4 and Figure 5 They are the disturbance estimation diagram of the combined velocity direction of the unmanned boat and the disturbance estimation diagram of the bow roll direction of the unmanned boat. It can be seen from the figures that the cascade expanded state observer has a better suppression effect on measurement noise than the traditional expanded state observer.

[0080] 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 cascade expansion state observer for unmanned boats, It is characterized in that It includes a combined speed state observation branch and a bow angular velocity state observation branch, the input of the combined speed state observation branch includes an actual unmanned boat combined speed signal extracted by a combined speed sensor and an unmanned boat combined speed direction control input signal, and the input of the bow angular velocity state observation branch includes an actual unmanned boat bow angular velocity signal extracted by a bow angular velocity sensor and an unmanned boat bow angular velocity direction control input signal; The combined speed state observation branch includes a cascaded first-stage combined speed extension observer module and a second-stage combined speed extension observer module; The input end of the first-stage combined speed expansion state observer module is respectively connected to the combined speed direction control input signal of the unmanned boat and the output end of the combined speed sensor module, and the output end of the first-stage combined speed expansion state observer module is connected to the input end of the second-stage combined speed expansion state observer module; The input end of the second-stage combined speed expansion state observer module is respectively connected to the combined speed direction control input signal of the unmanned boat and the output end of the first-stage combined speed expansion state observer module; the second-stage combined speed expansion state observer module outputs the combined speed direction concentrated disturbance estimation of the unmanned boat; The yaw angular velocity state observation branch comprises a cascaded first-stage yaw angular velocity extended observer module and a second-stage yaw angular velocity extended observer module; The input end of the first-stage bow angular velocity expansion state observer module is respectively connected to the unmanned boat bow angular velocity direction control input signal and the output end of the bow angular velocity sensor module, and the output end of the first-stage bow angular velocity expansion state observer module is connected to the input end of the second-stage bow angular velocity expansion state observer module; The input end of the second-stage bow angular velocity expansion state observer module is respectively connected to the unmanned boat bow angular velocity direction control input signal and the output end of the first-stage bow angular velocity expansion state observer module, and the second-stage bow angular velocity expansion state observer module outputs the unmanned boat bow angular velocity direction concentrated disturbance estimation.

2. The unmanned boat cascade expansion state observer according to claim 1, It is characterized in that The first-stage combined speed extended observer module is set as: In the formula, y U =U+ν U is the actual combined speed signal of the unmanned boat obtained by the combined speed sensor, ν U is the noise signal, U is the combined speed of the unmanned boat, The estimation of the combined speed of the unmanned boat by the first-stage combined speed extended state observer; It is the estimation of the disturbance of the combined velocity direction of the unmanned boat by the first-stage combined velocity extended state observer; is the positive first-order total velocity extended observer gain, m u is the hull inertia coefficient of the unmanned boat in the direction of the combined speed, τ u It is the input force for the combined speed and direction control of the unmanned boat.

3. The unmanned boat cascade expansion state observer according to claim 2, It is characterized in that The second-stage combined speed extended observer module is set as: In the formula, The estimation of the combined speed of the unmanned boat by the second-stage combined speed extended state observer; is the total estimate of the disturbance in the combined velocity direction of the unmanned boat by the second-stage combined velocity extended state observer, is the intermediate estimate of the disturbance in the combined velocity direction of the unmanned boat by the second-stage combined velocity extended state observer, is the gain of the traditional combined velocity extended state observer, 4. The unmanned boat cascade expansion state observer according to claim 3, It is characterized in that The first-stage yaw rate expansion state observer module is set as: In the formula, y r =r+ν r is the actual bow angular velocity signal of the unmanned boat obtained by the bow angular velocity sensor, v r is the noise signal, r is the bow angular velocity of the unmanned boat, is the estimation of the bow angular velocity of the unmanned boat by the first-stage bow angular velocity extended state observer, is the estimation of the bow angular velocity expansion state observer of the first stage bow angular velocity for the unmanned boat bow directional disturbance, is the positive first-stage yaw angular velocity expansion state observer gain, m r is the hull inertia coefficient of the unmanned boat in the direction of the bow angular velocity, τ r Input torque for the unmanned boat's bow angular velocity direction control.

5. The unmanned boat cascade expansion state observer according to claim 4, It is characterized in that The second-stage yaw rate expansion state observer module is set as: In the formula, is the estimation of the bow angular velocity of the unmanned boat by the second-stage bow angular velocity extended state observer, is the total estimate of the bow angular velocity extended state observer of the second-stage bow angular velocity for the unmanned boat bow directional disturbance, is the intermediate estimate of the bow angular velocity expansion state observer of the second-stage bow angular velocity for the unmanned boat bow directional disturbance, is the gain of the traditional heading angle expansion state observer,