Underwater robot three-dimensional path tracking control method based on second-order filter

An underwater robot, second-order filter technology, applied in three-dimensional position/channel control and other directions

Active Publication Date: 2014-02-12
HARBIN ENG UNIV
View PDF7 Cites 26 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

At present, there is no relevant literature discussing the design

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
  • Underwater robot three-dimensional path tracking control method based on second-order filter
  • Underwater robot three-dimensional path tracking control method based on second-order filter
  • Underwater robot three-dimensional path tracking control method based on second-order filter

Examples

Experimental program
Comparison scheme
Effect test

Example Embodiment

[0080] SUMMARY OF THE INVENTION The specific implementation of the three-dimensional path tracking control method of an underwater robot based on the second-order filter is as follows:

[0081] 1. The figure shows the relationship between the state signal, virtual control value, filter signal and derivative value of the AUV system. The forward loop mainly obtains the filter signal and derivative signal of the virtual control through the second-order filter, and the filter error compensation is designed. The loop guarantees the tracking accuracy of the filter to the input signal.

[0082] 2. image 3 Schematic diagram of robot 3D path tracking, l k Is the desired path, {I}, {B} and {F} represent the fixed coordinate system, the robot carrier coordinate system and the Serret-Frenet coordinate system, respectively; point P is the desired path l k On the virtual guide, point Q represents the position of the center of mass of the robot, for a given desired path l k for To determine 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 underwater robot three-dimensional path tracking control method based on a second-order filter. Underwater robot three-dimensional path tracking control is carried out by means of a filtering back-stepping method, the second-order filter established on the basis of two underwater robot three-dimensional path tracking kinematics error models is brought in to obtain virtual controlling quantity of postures, virtual controlling quantity of speed and virtual controlling quantity of angular speed and derivatives of the postures, derivatives of the speed and derivatives of the angular speed, then an underwater robot kinetic model is combined, control input of a path tracking controller is obtained and acts on a robot propeller and a steering engine, and therefore tracking of a three-dimensional path is achieved; according to the Lyapunov energy function, filtering feedback compensation items are designed for location and posture control loops, an integration element is led in a speed control loop, a system error compensation loop is constituted, and precision of a tracking system is promoted.

Description

technical field [0001] The invention relates to a motion control method of an underwater robot, in particular to a three-dimensional path tracking control method for an underwater robot based on a second-order filter. Background technique [0002] The tracking control of underwater robots has always been a research hotspot at home and abroad. The path tracking problem only requires the trajectory of the underwater robot to converge to the desired path, but does not require when and where it will arrive. By introducing the concept of virtual guide points on the desired path, the path tracking technology avoids the problem that the dynamic model of the underwater robot is disturbed by the environment, and the desired state cannot be accurately obtained during trajectory tracking, resulting in poor performance of the tracking control system. Compared with the trajectory tracking problem, the path tracking is not easy to cause the controller to output a saturated signal because...

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
IPC IPC(8): G05D1/10
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