Underwater robot attitude and position control method based on double-closed-loop active disturbance rejection

A technology of underwater robot and control method, which is applied in the direction of adaptive control, general control system, control/regulation system, etc., and can solve the problems of slow change, fast change of inner loop speed, low computer operating load, etc.

Active Publication Date: 2018-06-22
NORTHWESTERN POLYTECHNICAL UNIV
View PDF4 Cites 26 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

[0004] The purpose of the present invention is to provide a kind of attitude and position control method of underwater robot based on double-closed-loop active disturbance rejection, to overcome the shortcomings of the existing nonlinear controller, which has a large calculation load, is not conducive to engineering realization and has poor anti-disturbance ability. The invention divides the underwater robot into an inner speed loop and an outer angle loop through

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 attitude and position control method based on double-closed-loop active disturbance rejection
  • Underwater robot attitude and position control method based on double-closed-loop active disturbance rejection
  • Underwater robot attitude and position control method based on double-closed-loop active disturbance rejection

Examples

Experimental program
Comparison scheme
Effect test

Embodiment Construction

[0051] The present invention is described in further detail below:

[0052] Based on the active disturbance rejection control technology of the extended state observer and the double closed-loop control architecture, the attitude and position control method of the underwater robot is designed, and the realization is achieved through the following steps:

[0053] The first step: Construct the dynamic model of the underwater robot:

[0054] The position of the underwater robot under the earth coordinates is where x, y and z are the position coordinates of the robot, φ, θ and is the pose angle of the robot. In the body coordinate system, the velocity of the robot is ν=[μ υ ω pq r] T , where μ, υ and ω are the linear velocity of the robot along the body coordinate axis, p, q and r are the angular velocity of the robot around the body coordinate axis, and the directions satisfy the right-hand spiral theorem, and both η and ν are functions of time t. Where no ambiguity arises,...

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 discloses an underwater robot attitude and position control method based on double-closed-loop active disturbance rejection. The method is characterized by firstly, for a underwater robot, using a momentum and moment theorem and using a conversion relation between a geodetic coordinate system and a body coordinate system to establish a dynamical model; designing the speed loop expansion state observer of the underwater robot to observe unmodeled and external disturbances and carrying out real-time compensation suppression so that the anti-disturbance performance of a speed loop is greatly increased and the robustness of a system is improved; aiming at the high frequency vibration characteristic of the speed loop, using a disturbance observation value to construct a speed loopactive disturbance rejection controller based on nonlinear function feedback; based on a non-linear function fhan, designing the tracking differentiator of a target position signal, giving the transition process and the target speed estimation value of a position signal, avoiding the sudden change of system response and solving the conflict of rapidity and overshoot; and designing a underwater robot position loop proportion-differential controller based on position deviation feedback, wherein the controller is suitable for engineering application.

Description

technical field [0001] The invention belongs to the field of underwater robot control, and relates to an attitude and position control method of an underwater robot, in particular to an attitude and position control method of an underwater robot based on double-closed-loop self-disturbance rejection. Background technique [0002] With the deepening of human development of marine resources, underwater robots have replaced artificial diving due to their deep dive depth and long working time, providing a powerful tool for human research and development of deep sea resources. Widely concerned at home and abroad; affected by its own complex dynamic characteristics and hydrological turbulence, the coupling between the elastic body, propulsion system and structural dynamics of underwater robots is stronger, and the nonlinearity of the model is also higher; in addition, Affected by the viscous resistance of water flow, wave resistance and wave force, underwater robots are very sensi...

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): G05B13/04
CPCG05B13/042
Inventor 袁源成磊袁建平朱占霞孙冲张博
Owner NORTHWESTERN POLYTECHNICAL 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