ROV attitude control method based on error quaternion feedback

An error quaternion and attitude control technology, applied in the direction of program control manipulators, manufacturing tools, ships, etc., can solve the problems of inability to realize 360° rotation motion control without dead angle, more complicated than Euler angle, and increase the amount of calculation. Easy to understand, easy to operate and implement, optimized and upgraded

CN105619394AInactive Publication Date: 2016-06-01QINGDAO HISUN OCEAN EQUIP
4 Cites 9 Cited by

Patent Information

Authority / Receiving Office
CN · China
Current Assignee / Owner
Publication Date
2016-06-01
Estimated Expiration
Not applicable · inactive patent

Smart Images

  • Figure 1
    Figure 1
  • Figure 2
    Figure 2
  • Figure 3
    Figure 3
Patent Text Reader

Abstract

The invention discloses an ROV attitude control method based on error quaternion feedback. An inertial coordinate system and an ROV motion coordinate system are established; a three-freedom-degree rotating attitude of an ROV is modeled; an attitude sensor detects the ROV and outputs an attitude quaternion, the current quaternion of the ROV is compared with a target quaternion, and an error quaternion is solved; the error quaternion is input into a PID controller, needed torque on three axes in the ROV motion coordinate system is calculated, a processor controls the voltage of a propeller motor according to the needed torque, corresponding push force is generated, the ROV attitude adjustment is finished, the ROV is made to rotate by 360 degrees without the dead angle, the attitude is stable, and operation under the complex work environment is achieved.
Need to check novelty before this filing date? Find Prior Art

Description

technical field

[0001] The invention relates to an ROV attitude control method, in particular to an ROV attitude control method based on error quaternion feedback. Background technique

[0002] Unmanned remotely operated submersibles (Remote OperatedVegicle) can be used for various purposes such as operations and observations. Depending on the specific use, its technical implementation schemes are also different. The traditional ROV's motion is mostly linear motion of front and rear, left and right, up and down, and rotational motion of the Z axis. However, in some more complex operating environments, such as attaching to the bottom of the ship, walls, pipes, etc. with continuous and large attachment surfaces, ROVs are required to be able to complete 360° rotation in the X, Y, and Z directions without dead angles. And achieve posture stability. Correspondingly, ROV control cannot use the commonly used Euler angle control method for attitude control, because the Euler angle...

Examples

Embodiment Construction

[0027] The present invention will be described in further detail below in conjunction with the accompanying drawings and specific embodiments.

[0028] exist figure 1 and figure 2 , establish the inertial coordinate system and the motion coordinate system of ROV;

[0029] The inertial coordinate system is that the coordinate origin E is a certain point on the earth; the Eξ axis is located on the horizontal plane, and the forward direction of the ROV is positive; the Eη axis is located in the Eξ plane and rotates Eξ clockwise by 90° according to the right-hand rule; the Eζ axis is located in the Eζξ plane, pointing to the ground Heart. The motion coordinate system is that the coordinate origin G is taken at the center G of the ROV, the Gx axis is parallel to the ROV baseline and points to the forward direction; the transverse axis Gy is parallel to the base plane and points to the right side of the ROV; and the Gz axis points to the bottom of the ROV.

[0030] ROV symmetric...