Unmanned surface vessel full state constraint trajectory tracking control method based on saturation compensation technology

A trajectory tracking and control method technology, applied in two-dimensional position/course control, non-electric variable control, control/regulation system, etc., can solve the problems of state constraint saturation and large control error

Active Publication Date: 2018-11-13
HARBIN ENG UNIV
View PDF8 Cites 40 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

[0004] In order to solve the problem that the existing control method for the trajectory tracking control of the surface unmanned vehicle does not deal with the problems of state constraints and saturation, resulting in large control errors, the present invention proposes a fully automatic surface unmanned vehicle based on saturation compensation technology. State Constrained Trajectory Tracking Control Method

Method used

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
View more

Image

Smart Image Click on the blue labels to locate them in the text.
Viewing Examples
Smart Image
  • Unmanned surface vessel full state constraint trajectory tracking control method based on saturation compensation technology
  • Unmanned surface vessel full state constraint trajectory tracking control method based on saturation compensation technology
  • Unmanned surface vessel full state constraint trajectory tracking control method based on saturation compensation technology

Examples

Experimental program
Comparison scheme
Effect test

specific Embodiment approach 1

[0033] Specific implementation mode one: the full-state constraint trajectory tracking control method of the surface unmanned vehicle based on the saturation compensation technology includes the following steps:

[0034] Before describing this implementation, first define the relevant parameters:

[0035] n x , η y , η ψ ——The position component and heading of the target USV relative to the ground coordinate system;

[0036] v x ,ν y ,ν ψ ——the surge, sway and yaw speed of the target USV;

[0037] M——symmetric positive definite inertia matrix;

[0038] C(ν)——centripetal force and Coriolis force matrix;

[0039] D(ν)——damping matrix;

[0040] g(η)——restoring force caused by gravity, sea current and buoyancy;

[0041] H - unknown interference;

[0042] J(η)——the non-singular transformation matrix from the satellite coordinate system to the ground coordinate system;

[0043] τ——desired control input;

[0044] sat(τ)——actual control input;

[0045] Δτ—the difference ...

specific Embodiment approach 2

[0158] Specific embodiment two: the difference between this embodiment and specific embodiment one is: the specific process of establishing the dynamics model of surface unmanned boat in the described step one is:

[0159] The coordinate origin o of the satellite coordinate system o-xy is located at the center of gravity of the surface unmanned boat, the x-axis points from the stern to the bow along the longitudinal axis, and the y-axis points to the port side; the coordinate origin O of the ground coordinate system O-XY is located at the mooring line At the connection with the mooring terminal, the X, Y axes and the x, y axes of the satellite coordinate system are in the same plane;

[0160] The dynamic model of the 3-DOF, multi-input and multi-output surface unmanned vehicle is as follows:

[0161]

[0162] in hollow Represents the field of real numbers; (η x , η y ) represents the position in the ground coordinate system, η ψ Indicates the heading angle in the gro...

specific Embodiment approach 3

[0165] Specific embodiment three: the difference between this embodiment and specific embodiment one or two is that: the dynamics model of the surface unmanned boat established according to step one in the described step two, the specific process of designing the saturation compensation auxiliary system is:

[0166] The present invention uses an anti-saturation compensator to process the saturation function, and designs a saturation compensation auxiliary system:

[0167]

[0168] Where M is a symmetric positive definite inertia matrix, C 1 ,C 2 is a diagonal matrix whose diagonal elements are all constant numbers, ζ 1 ,ζ 2 is the output of the saturation compensation auxiliary system, J is the non-singular transformation matrix from the satellite coordinate system to the ground coordinate system, Δτ is the difference between the desired control input τ and the actual control input sat(τ);

[0169] The error variable z for the position 1 and the error variable z for the...

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

PUM

No PUM Login to view more

Abstract

The invention provides an unmanned surface vessel full state constraint trajectory tracking control method based on the saturation compensation technology, relates to the unmanned surface vessel fullstate constraint trajectory tracking control method, and aims at solving the problem of high control error caused by the fact that the present control method for unmanned surface vessel trajectory tracking control does not process the problem of state constraints and saturation. The unmanned surface vessel full state constraint trajectory tracking control method comprises the steps that step one,the kinetic model of the unmanned surface vessel is established; step two, a saturation compensation auxiliary system is designed according to the kinetic model of the unmanned surface vessel established in the step one; step three, the saturation function of the unmanned surface vessel control law is established according to the saturation compensation auxiliary system designed in the step two; step four, the closed-loop system of the unmanned surface vessel is established; step five, the external interference is processed by using the adaptive method so as to obtain the adaptive estimation error; and step six, full state constraint trajectory tracking control of the unmanned surface vessel can be realized according to the adaptive estimation error obtained in the step five. The unmannedsurface vessel full state constraint trajectory tracking control method based on the saturation compensation technology is used for the field of trajectory tracking control.

Description

technical field [0001] The invention relates to the field of trajectory tracking control, in particular to a control method for an unmanned surface boat. Background technique [0002] At present, people are paying more and more attention to ocean development, so marine survey and development tools such as surface unmanned ships, remote-controlled unmanned submersibles, and autonomous underwater submersibles are constantly being developed. Among them, as a multi-purpose, low-cost unmanned vehicle, the surface unmanned vehicle has broad application prospects in both military and civilian fields, so the research on the control of surface unmanned vehicles is of great significance. [0003] Nowadays, with the increasing emphasis on surface unmanned boats, there are already a variety of motion control methods for them, such as trajectory tracking control, path following control, stabilization control, and formation control (Liao Yulei. Research on nonlinear motion control methods...

Claims

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

Application Information

Patent Timeline
no application Login to view more
Patent Type & Authority Applications(China)
IPC IPC(8): G05D1/02
CPCG05D1/0206
Inventor 秦洪德孙延超李骋鹏曹金梦陈辉吴哲远邢森林
Owner HARBIN ENG UNIV
Who we serve
  • R&D Engineer
  • R&D Manager
  • IP Professional
Why Eureka
  • Industry Leading Data Capabilities
  • Powerful AI technology
  • Patent DNA Extraction
Social media
Try Eureka
PatSnap group products

Browse by: Latest US Patents, China's latest patents, Technical Efficacy Thesaurus, Application Domain, Technology Topic.

© 2024 PatSnap. All rights reserved.Legal|Privacy policy|Modern Slavery Act Transparency Statement|Sitemap