CN113296517A - Ship course dynamic surface sliding mode control method based on drift angle compensation - Google Patents
Ship course dynamic surface sliding mode control method based on drift angle compensation Download PDFInfo
- Publication number
- CN113296517A CN113296517A CN202110570900.XA CN202110570900A CN113296517A CN 113296517 A CN113296517 A CN 113296517A CN 202110570900 A CN202110570900 A CN 202110570900A CN 113296517 A CN113296517 A CN 113296517A
- Authority
- CN
- China
- Prior art keywords
- course
- error
- ship
- drift angle
- heading
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 14
- 238000001914 filtration Methods 0.000 claims abstract description 18
- 230000008859 change Effects 0.000 claims abstract description 7
- 238000013459 approach Methods 0.000 claims abstract description 4
- 238000004880 explosion Methods 0.000 claims abstract description 4
- 230000007704 transition Effects 0.000 claims abstract description 3
- 238000011045 prefiltration Methods 0.000 claims description 7
- 238000013461 design Methods 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 4
- 238000010586 diagram Methods 0.000 description 5
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 238000005299 abrasion Methods 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention discloses a ship course dynamic surface sliding mode control method based on drift angle compensation, which is characterized by comprising the following steps of: the obtained expected course psi of the shiprPre-filtering to obtain a filtered reference course psidAnd rate of change of courseA smooth transition of (2); according to the estimated drift angle value, the initial heading error e is psih‑ψdCorrecting based on drift angle compensation, wherein the corrected course error is eaWherein ψhThe actual course is taken; designing virtual controlsAnd instruction filtering to prevent the problem of "computing explosion" from occurring; defining a dynamic error e according to the corrected course error and the filtered reference course1、e2(ii) a Calculating the compensation for the instruction filtering of step S3Tracking error v1、υ2And the compensation tracking signal is defined according to the dynamic error of the system to eliminate the influence of the instruction filtering error; calculating a ship yawing control moment command signal tau according to a sliding mode control rule based on an approach lawrThe real-time heading information is updated to step S2.
Description
Technical Field
The invention relates to the technical field of ship course control, in particular to a ship course dynamic surface sliding mode control method based on drift angle compensation.
Background
Heading control is taken as the most basic content of ship motion control in order to ensure the safety and economy of ships sailing on the sea, and is an important research subject in the field of ship control up to now. At present, most ship motion control neglects drift angle influence existing in navigation, and the drift angle causes certain deviation to an expected course. The most direct method to compensate for drift angle is to use GPS, accelerometers and other sensors to make measurements, however, the noise and high cost of the sensors make this method impractical. In addition, the actuator has a saturation constraint problem due to mechanical characteristics, and the rudder saturation problem not only causes actuator abrasion to the ship itself, but also reduces course tracking performance. The ship control belongs to the typical under-actuated system control, and besides the influence of sea surface environment disturbance, the complexity and uncertainty of a ship control model bring huge challenges to ship heading control.
Disclosure of Invention
The invention aims to improve the course tracking performance of an under-actuated ship on the water surface and reduce course errors, and researches ship course dynamic surface sliding mode control based on drift angle compensation. Firstly, a pre-filter is adopted to reduce the influence of a large course change rate when a ship turns, an extended state observer is used for estimating a time-varying drift angle, and course errors are corrected in time through the estimated drift angle. The resulting control effect has good course tracking even in the presence of input saturation.
In order to achieve the purpose, the invention is realized by the following technical scheme:
a ship course dynamic surface sliding mode control method based on drift angle compensation comprises the following steps:
s1, obtaining the expected heading psi of the shiprPre-filtering to obtain a filtered reference course psidAnd rate of change of courseA smooth transition of (2);
s2, according to the estimated drift angle value, the initial heading error e is psih-ψdCorrecting based on drift angle compensation, wherein the corrected course error is eaWherein ψhThe actual course is taken;
s3 design virtual controlAnd instruction filtering to prevent the problem of "computing explosion" from occurring;
s4, defining a dynamic error e according to the corrected course error and the filtered reference course1、e2;
S5, calculating a compensated tracking error upsilon for the command filtering of the step S31、υ2And the compensation tracking signal is defined according to the dynamic error of the system to eliminate the influence of the instruction filtering error;
s6, calculating a ship yawing control moment command signal tau according to a sliding mode control rule based on an approach lawrThe real-time heading information is updated to step S2.
Optionally, the second-order pre-filter adopted in step S1 is in the form of:
wherein λ isi(i ═ 1,2,3) are prefilter parameters;
the drift angle estimation formula is as follows:
Optionally, the expression of the sliding mode in step S6 is:
Optionally, the command signal τ of yaw control moment in step S6rThe calculation formula of (a) is specifically expressed as:
wherein,for the overall estimation of uncertainty terms and external disturbances in the under-actuated vessel model,non-linear term estimates are composed for the yaw rate in the model,k1、k2to design the constants.
Compared with the prior art, the invention has the following advantages:
the under-actuated ship course tracking control method designed by the invention considers drift angle influence and effectively reduces course errors at turning positions; the buffeting is effectively weakened through the sliding mode control based on the exponential approaching law; uncertainty items and external disturbance in the model are estimated and compensated through an observer at the same time, and robustness of course tracking control under severe sea condition navigation conditions is improved.
When the reference course is changed, the drift angle is compensated in the course tracking, so that the time required by the ship to reach the reference course is shortened to a half of the original time; compared with the traditional linear extended state observer, the finite time extended state observer has better estimation performance, and the researched control method enables the surface ship to reduce the course error to be converged to zero in a short time.
Drawings
In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the drawings used in the description of the embodiments will be briefly introduced below, and it is obvious that the drawings in the following description are only some embodiments of the present invention patent, and it is obvious for those skilled in the art that other drawings can be obtained according to these drawings without creative efforts.
FIG. 1 is a schematic diagram of a desired heading after drift angle compensation in an embodiment of the invention;
FIG. 2 is a block diagram of a ship heading control that takes into account drift correction in an embodiment of the invention;
FIG. 3 is a schematic diagram illustrating a ship course tracking control result according to an embodiment of the present invention;
FIG. 4 is a schematic view of a ship course tracking error in an embodiment of the present invention;
FIG. 5 is a schematic diagram illustrating estimation of the ship surging speed according to an embodiment of the present invention;
FIG. 6 is a schematic diagram illustrating estimation of the swaying speed of the ship according to an embodiment of the present invention;
fig. 7 is a schematic view of the ship yaw control moment designed and calculated in an embodiment of the present invention.
Detailed Description
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. It is to be noted that the drawings are in a very simplified form and are all used in a non-precise scale for the purpose of facilitating and distinctly aiding in the description of the embodiments of the present invention. To make the objects, features and advantages of the present invention comprehensible, reference is made to the accompanying drawings. It should be understood that the structures, ratios, sizes, and the like shown in the drawings and described in the specification are only used for matching with the disclosure of the specification, so as to be understood and read by those skilled in the art, and are not used to limit the implementation conditions of the present invention, so that the present invention has no technical significance, and any structural modification, ratio relationship change or size adjustment should still fall within the scope of the present invention without affecting the efficacy and the achievable purpose of the present invention.
It is noted that, herein, relational terms such as first and second, and the like may be used solely to distinguish one entity or action from another entity or action without necessarily requiring or implying any actual such relationship or order between such entities or actions.
Referring to fig. 2, the embodiment provides a dynamic surface sliding mode control method based on drift angle compensation, which is implemented as follows:
step 1: the obtained expected course psi of the shiprPre-filtering is performed. The main function of the pre-filter is to measure the original reference heading psirFiltering to realize the reference course psi after filteringdAnd rate of change of courseThereby avoiding higher control gain requirements and improving the performance of the controller. The pre-filtering formula is represented by formula (1). Wherein the parameters can be adjusted according to specific objects.
Wherein λi(i ═ 1,2,3) are prefilter parameters.
Step 2: and correcting the course error based on the drift angle. Corrected desired heading ψdaError e from courseaRespectively as follows:
ea=ψh-ψda (3)
the drift angle calculation formula is as follows:
the drift angle and total disturbance are estimated by the following finite time extended state observer:
wherein eta is [ u, v, r ═ r]T,A state vector expanded for the system, which contains unknown external interference and internal unmodeled dynamic terms; observer estimation error isWherein, sigα(z1)=|z1|αsgn(z1),and isα2=2α1-1;mi>0,niAnd > 0(i ═ 1,2) is a normal number.
And step 3: design of virtual control lawTo eliminate the effect of 'computing explosion', command filtering is designedWhere α is the filtered virtual control law, kα、τ1Is a constant to be designed.
And 4, step 4: defining a dynamic error based on the corrected course error and the filtered reference course
e1=ea=ψh-ψda (6)
And 5: in order to eliminate the error influence generated by the virtual instruction filtering in the step 3, a compensation tracking signal system is designed according to the dynamic error of the system, and the specific expression of the error compensation signal is as follows:
calculating a compensated tracking error v1=e1-ξ1,υ2=e2-ξ2。
Step 6: the surface of the sliding form is selected as
In order to weaken buffeting, sliding mode control based on an exponential approach law is used, and a moving point is guaranteed to reach a sliding mode within a limited time. In the invention, the initial speed of the surging direction is designed to be 6m/s, and the ship keeps sailing at the speed of 7m/s after acceleration; since the oscillating motion pose v is assumed to be passively bounded, the design of the control law does not need to take this into account. Command signal tau for controlling moment of bowrThe calculation formula of (a) is specifically expressed as:
the three-degree-of-freedom water surface under-actuated nonlinear ship motion model based on the invention is as follows:
where ψ is the actual heading defined in a fixed coordinate system in degrees; the surging and swaying speeds of the ship are u and v respectively, and the unit is m/s; r is the yaw rate in rad/s. Positive constant mjjJ is more than or equal to 1 and less than or equal to 3, which represents the inertia coefficient of the ship including the additional mass; du、dv、dr、dui、dvi、driRepresenting hydrodynamic damping coefficients in the surge, sway and yaw directions; unknown time-varying term tauwu(t)、τwv(t)、τwr(t) represents the environmental disturbance caused by wind, waves, flow, assuming that the external disturbance is bounded. Propelling force tau of ship on wateru(N) provided by propellers or water jets, yaw moment τr(Nm) results from varying the speed of each propeller or sprinkler. Order toFor uncertainty terms and total disturbances in the heading direction,
example (b): a monohull ship with the length of 38 meters is taken as a controlled object, and computer numerical simulation is carried out by using MATLAB. The nonlinear ship motion model is adopted as shown in the formula (11), and specific parameters in the model are as follows.
m11=120×103 m22=177.9×103 m33=636×105
du=215×102 dv=147×103 dr=802×104
du2=0.2du dv2=0.2dv dr2=0.2dr
du3=0.1du dv3=0.1dv dr3=0.1dr
In the embodiment, the surging speed is controlled by an independent control system, the initial navigational speed is designed and set to be 6m/s, and the surging speed of 7m/s is maintained after acceleration. The desired heading angles are 0 °, 20 °, 40 °, respectively, and the simulation time is 300 s. The ocean environment disturbance adopts a disturbance model to simulate in consideration of the complex interference factors of the wind wave flow.
Fig. 3-7 show some simulation results based on this invention. FIG. 3 is a real ship navigation course tracking curve, which shows that the course is effectively tracked and controlled, and the heading can be converged to the expected course within 4s of the change of the heading, thereby greatly shortening the time required by ship steering. Fig. 4 is a time variation curve of the course tracking error, and it can be seen that the course deviation can be converged in a smaller neighborhood range. Fig. 5 and 6 show the surging and swaying speeds estimated by the observer, respectively. Fig. 7 shows a time variation curve of the ship heading propulsion control force obtained by calculating the control law of the formula (10).
While the present invention has been described in detail with reference to the preferred embodiments, it should be understood that the above description should not be taken as limiting the invention. Various modifications and alterations to this invention will become apparent to those skilled in the art upon reading the foregoing description. Accordingly, the scope of the invention should be determined from the following claims.
Claims (4)
1. A ship course dynamic surface sliding mode control method based on drift angle compensation is characterized by comprising the following steps:
s1, obtaining the expected heading psi of the shiprPre-filtering to obtain a filtered reference course psidAnd rate of change of courseA smooth transition of (2);
s2, according to the estimated drift angle value, the initial heading error e is psih-ψdCorrecting based on drift angle compensation, wherein the corrected course error is eaWherein ψhThe actual course is taken;
s3 design virtual controlAnd instruction filtering to prevent the problem of "computing explosion" from occurring;
s4, defining a dynamic error e according to the corrected course error and the filtered reference course1、e2;
S5, calculating a compensated tracking error upsilon for the command filtering of the step S31、υ2And the compensation tracking signal is defined according to the dynamic error of the system to eliminate the influence of the instruction filtering error;
s6, calculating a ship yawing control moment command signal tau according to a sliding mode control rule based on an approach lawrThe real-time heading information is updated to step S2.
2. The ship heading dynamic surface sliding-mode control method based on drift angle compensation as claimed in claim 1, wherein the second-order pre-filter adopted in the step S1 is in the form as follows:
wherein λ isi(i ═ 1,2,3) are prefilter parameters;
the drift angle estimation formula is as follows:
4. The ship heading dynamic surface sliding-mode control method based on drift angle compensation as claimed in claim 1, wherein the heading control moment command signal τ in the step S6rThe calculation formula of (a) is specifically expressed as:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110570900.XA CN113296517B (en) | 2021-05-25 | 2021-05-25 | Ship course dynamic surface sliding mode control method based on drift angle compensation |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110570900.XA CN113296517B (en) | 2021-05-25 | 2021-05-25 | Ship course dynamic surface sliding mode control method based on drift angle compensation |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113296517A true CN113296517A (en) | 2021-08-24 |
CN113296517B CN113296517B (en) | 2023-03-24 |
Family
ID=77324730
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110570900.XA Active CN113296517B (en) | 2021-05-25 | 2021-05-25 | Ship course dynamic surface sliding mode control method based on drift angle compensation |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113296517B (en) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130173096A1 (en) * | 2010-09-11 | 2013-07-04 | Wayne State University | Guidance and control system for under-actuated marine surface ships and other autonomous platforms |
EP3287862A1 (en) * | 2016-08-25 | 2018-02-28 | Imotec Holding B.V. | Method for steering an underactuated ship |
CN110244556A (en) * | 2019-04-30 | 2019-09-17 | 上海海事大学 | Based on the modified underactuated surface vessel course heading control method of desired course |
CN110515387A (en) * | 2019-09-25 | 2019-11-29 | 上海海事大学 | A kind of above water craft drift angle compensating non-linear course heading control method |
CN110597262A (en) * | 2019-09-25 | 2019-12-20 | 上海海事大学 | Under-actuated ship path tracking self-adaptive control method based on drift angle correction |
-
2021
- 2021-05-25 CN CN202110570900.XA patent/CN113296517B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130173096A1 (en) * | 2010-09-11 | 2013-07-04 | Wayne State University | Guidance and control system for under-actuated marine surface ships and other autonomous platforms |
EP3287862A1 (en) * | 2016-08-25 | 2018-02-28 | Imotec Holding B.V. | Method for steering an underactuated ship |
CN110244556A (en) * | 2019-04-30 | 2019-09-17 | 上海海事大学 | Based on the modified underactuated surface vessel course heading control method of desired course |
CN110515387A (en) * | 2019-09-25 | 2019-11-29 | 上海海事大学 | A kind of above water craft drift angle compensating non-linear course heading control method |
CN110597262A (en) * | 2019-09-25 | 2019-12-20 | 上海海事大学 | Under-actuated ship path tracking self-adaptive control method based on drift angle correction |
Non-Patent Citations (4)
Title |
---|
LIU ZHIHUI: "Ship Adaptive Course Keeping Control With Nonlinear Disturbance Observer", 《IEEE ACCESS》 * |
王岩等: "欠驱动船舶航迹跟踪指令滤波滑模鲁棒控制", 《电机与控制学报》 * |
陆潇杨: "带漂角和输入饱和的水面船舶航向控制", 《中国舰船研究》 * |
陆潇杨等: "漂角修正的欠驱动船舶航向鲁棒自适应控制", 《上海海事大学学报》 * |
Also Published As
Publication number | Publication date |
---|---|
CN113296517B (en) | 2023-03-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107024863B (en) | UUV trajectory tracking control method for avoiding differential explosion | |
CN108803632B (en) | Water surface unmanned ship all-state constraint trajectory tracking control method based on saturation compensation technology | |
CN111580523B (en) | Unmanned ship path tracking active disturbance rejection control method based on sideslip angle compensation | |
CN108008628B (en) | Method for controlling preset performance of uncertain underactuated unmanned ship system | |
Fossen et al. | Nonlinear output feedback control of dynamically positioned ships using vectorial observer backstepping | |
CN104898688B (en) | The adaptive anti-interference System with Sliding Mode Controller of UUV four-degree-of-freedom dynamic positionings and control method | |
CN110377036B (en) | Unmanned surface vessel track tracking fixed time control method based on instruction constraint | |
CN110618611A (en) | Unmanned ship trajectory tracking safety control method based on slew rate constraint | |
CN111198502B (en) | Unmanned ship track tracking control method based on interference observer and fuzzy system | |
CN108319140A (en) | A kind of output redefinition formula model-free adaption course heading control method and system | |
CN111798702B (en) | Unmanned ship path tracking control method, system, storage medium and terminal | |
CN110244556B (en) | Under-actuated ship course control method based on expected course correction | |
Leifeng et al. | Adaptive heading control of unmanned wave glider with heading information fusion | |
CN113467231A (en) | Unmanned ship path tracking method based on sideslip compensation ILOS guidance law | |
CN113296511A (en) | Ship course control method based on drift angle compensation and improved supercoiling algorithm | |
CN110515387A (en) | A kind of above water craft drift angle compensating non-linear course heading control method | |
Matusiak | Dynamics of a Rigid Ship-with applications | |
CN105929825A (en) | Ship dynamic positioning backstepping control method based on neural dynamic model | |
CN115686034B (en) | Unmanned submarine trajectory tracking control method considering failure of speed sensor | |
CN113296517B (en) | Ship course dynamic surface sliding mode control method based on drift angle compensation | |
CN116820081A (en) | Under-actuated unmanned ship path tracking control method based on model-free self-adaptive sliding mode | |
CN115686008A (en) | Ship dynamic positioning auxiliary anchoring system design based on instruction filtering backstepping method | |
CN111651943B (en) | Ship motion control method, terminal device and storage medium | |
CN114564029B (en) | Full-drive ship track tracking control method and device based on direct parameterization method | |
CN112230666B (en) | Drift angle correction course control method based on self-adaptive extended state observer |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |