Research on Compliant Controller of Underwater Mechanical Capture System Based on Impedance Theory

Yuanjie Liu1, Fusheng Zha1,*, Qiming Wang1, Chao Zheng2, Jinrui Zhou1 and Lianzhao Zhang1

1State Key Laboratory of Robotics and System, Harbin institute of Technology, Harbin, China
2Wuhan Second Ship Design and Research Institute, Wuhan, China
E-mail: zhafusheng@hit.edu.cn
*Corresponding Author

Received 30 March 2022; Accepted 09 June 2022; Publication 12 June 2023

Abstract

Due to the requirement of the exploitation of marine resources, the execution of specific underwater tasks by onboard manipulators has become one of the key research fields in domestic and all over the world. Based on the underwater capture system designed for the UUV recycling task, which consists of an underwater manipulator and a mechanical capture device, this paper first constructs the kinematics and dynamics model of the capture system through theoretical analysis such as theoretical mechanics and theory of mechanism. Then, combined with the requirements of the recycling task, through the theoretical basis of fluid mechanics such as Morrison equation, dynamic of the capture system in underwater environment is analysed, with a compliant controller designed for the capture system based on impedance theory in order to reduce the impact of underwater environment in the capture task. Moreover, as the capture system modelled in the Adams dynamics simulation platform, it is verified that the designed compliant controller can reduce the underwater environmental impact through simulation experiments in the Adams dynamic platform.

Keywords: Compliant controller, underwater manipulator, hydraulic analysis, dynamics simulation.

1 Introduction

With the gradual reduction of land resources, the degree of development and utilization of marine resources has gradually become one of the standards for measuring the power of science and technology for a country [1]. In recent years, with the development of technology in related fields such as robotics, it has gradually become possible to carry out special underwater tasks by carrying specific actuators on onboard manipulators [24].

Unmanned underwater vehicle (UUV) has the characteristics of wide working space and strong cruising ability in underwater environment, which plays an irreplaceable role in underwater exploration, underwater positioning and deep-sea sampling. Due to the limited energy carried by the UUV, it is necessary to release and recycle the UUV at the beginning and end of the exploration. Thus, utilizing the mechanical operation system of the onboard manipulator to carry the mechanical capture device, as well as building a manipulator controller suitable for the underwater environment are indispensable parts in the close loop of underwater exploration task [5].

Different from conventional industrial manipulators, the study of underwater manipulator must fully analyse the complex marine environment, whose working accuracy is affected by factors such as fluid viscosity resistance and ocean current impact [6]. However, dynamic underwater environmental factors such as ocean current impact and undercurrent not only have a high degree of uncertainty that is difficult to predict and model, but also, in general, generate larger force and faster mutation to the manipulator, compared with static environmental forces such as viscous resistance and buoyancy, leading to the existence of a lot of uncertain parameters in the dynamic modelling of the manipulator [7]. Since Morison equation was proposed to calculate the wave loads on cylindrical components in the ocean, it has been widely applied on the calculation of hydrodynamic terms for underwater manipulator. Since the motion of the manipulator is severely affected by the flow around the manipulator which cause complex fluid-structure interaction, there is no better calculation method to replace Morison equation in the calculation of the hydrodynamic resistance of the manipulator.

In 1984 Hogan [8] proposed impedance control theory, the basic idea of which is adjusting the manipulators’ stiffness in order to maintain ideal dynamic character during interaction with environment. Till now, many scholars have done much research on force and displacement control strategy in time-varying and stochastic environments using impedance control methods. Sheng et al. (2018) designed a fuzzy adaptive hybrid impedance control scheme for the support side of a mirror milling system to solve the support problem with time-varying environmental stiffness [9]. Kang et al. (2020) proposed a variable target stiffness adaptive impedance control method for wheel-legged robots on complex unknown terrain [10]. Liang et al. (2021) proposed an impedance control method for handling unpredictable and time-varying adhesion forces for a rubber depalletizing robot [11].

Currently, most of the control methods for manipulator to cope with variable loads underwater are implemented with adaptive control methods. For example, Carlucho et al. designed an adaptive controller for variable payloads in underwater environment [12], which was implemented with the help of MPC method with data-driven techniques. However, as it stands, the problem that the data-driven approach cannot ensure the control requirements may arise in case of the fluctuation of the systematic dynamic factors.

As for the marine environment in real world, it is difficult to develop a stable current environment, which in another word is mostly turbulent. As a result, it is difficult to eliminate the influence of the underwater dynamic environmental constraint force on the entire manipulator system and the impact caused by the contact between the end effector and the UUV only by the position servo controller, since it is easy to cause damage to the mechanical structure of the manipulator. Therefore, it is necessary to establish a compliant controller for the underwater capture system, in order to avoid mechanical structure damage by compensating the contact force among the manipulator and the environment, as well as the UUV. In this paper, in the beginning, based on the mechanism characteristics of the manipulator, the forward and inverse kinematic solution equations of the manipulator are established. In addition, the kinetic equations are combined with Morrison’s equation to establish the manipulator dynamic model under turbulent flow conditions. Moreover, based on the impedance control theory, a complaint control strategy is proposed to avoid structural damage of the manipulator under the influence of uncertain wave loads by adding virtual impedance. At last, based on the structural characteristics of the manipulator, a detailed structural model of the manipulator is built, and the effectiveness of the impedance control strategy in presenting resistance to water flow disturbance is fully verified by simulating the turbulence phenomenon in the simulation platform and applying the proposed complaint control strategy to the structural model of the manipulator in the platform.

Nomenclature

i Joint number
Xi, Yi, Zi Joint coordinate based on the D-H method
ai Length of the link, represents the distance from axis Zi-1 to axis Zi along axis
αi Torsion angle of the link, represents the angle rotating from axis Zi-1 to axis Zi around axis Xi
di Offset of the link, represents the distance from axis Xi-1 to axis Xi along axis Zi-1
θi Rotation angle of the link, represents angle rotating from axis Xi-1 to axis Xi around axis Zi-1
Tii-1 Linkage transformation matrix
ci cosθi
si sinθi
sij sin(θi+θj)
cij cos(θi+θj)
τ Driving torque of the manipulator’s joint
τh Hydrodynamic term of the manipulator
θ˙ Angular velocity of the manipulator’s joint
θ¨ Angular acceleration of the manipulator’s joint
M(θ) Third-order positive definite inertia matrix of the mass
C(θ,θ˙) The centrifugal force and the Coriolis force vector
H(θ) Equivalent gravity term
g Gravitational acceleration
ρ Density of the water
ρm Density of the manipulator
mi Equivalent mass of link i
F Acting force per unit length along the manipulator
Fd Hydrodynamic resistance per unit length along the manipulator
Fm Inertial force (additional mass force) per unit length along the manipulator
A Projected area of the manipulator’s link in the direction perpendicular to the incoming flow velocity
v(x) Velocity function
Cm Additional mass coefficient
Cd Hydrodynamic resistance coefficient
D Diameter of the cylinder joint
dl Thickness of the cylinder element
τDi Hydrodynamic resistance moment of the Joint i
τAi Additional mass moment of the Joint i
vi-jn Normal velocity of linkage i due to joint j motion over the length of the unit
Md Designed inertia matrix
Bd Designed damping matrix
Kd Designed stiffness matrix
Xe,X˙e,X¨e Actual position, actual velocity, and actual acceleration of the end of the manipulator
Xd,X˙d,X¨d Designed position, designed speed, and designed acceleration of the end of the manipulator
Fd Expected contact force
Fe Actual contact force
τw Hydrodynamic force of each joint in the dynamic water environment

2 Establishment of the Kinematics and Dynamics Model of the Capture System

2.1 Kinematics Model of the Capture System

This study uses the D-H method to establish the kinematic model of the underwater manipulator, mainly to obtain the linear mapping relationship of the robot’s position, velocity, and acceleration in the joint space and the drive space, and obtain the schematic diagram, displaying the joint coordinates distribution of the underwater manipulator, as is shown in Figure 1.

images

Figure 1 Connecting rod coordinate system.

In order to study the kinematics of the manipulator, the model of the manipulator is simplified to a link model by the D-H method. Table 1 shows the parameters of the D-H link obtained according to the joint coordinate system, in which the length of the link ai represents the distance from axis Zi-1 to axis Zi along axis Xi, the torsion angle of the link αi represents the angle rotating from axis Zi-1 to axis Zi around axis Xi, the offset of the link di represents the distance from axis Xi-1 to axis Xi along axis Zi-1, and the rotation angle of the link θi represents angle rotating from axis Xi-1 to axis Xi around axis Zi-1.

Table 1 D-H parameter table of underwater manipular

Joint i ai/m αi/() di/m θi/()
1 0 90 d1 θ1
2 a2 0 0 θ2
3 a3 0 0 θ3
4 0 90 0 θ4
5 0 0 0 θ5

According to the established coordinate system of the manipulator and the D-H parameters in Table 1, the kinematics equation can be directly established through the coordinate transformation matrix. The general expression of the transformation matrix between two adjacent links is shown in Equation (1):

Tii-1=[cosθi-cosαisinθisinαisinθiaicosθisinθicosαicosθi-sinαicosθiaisinθ0sinαicosαidi0001] (1)

Substitute the D-H parameters in Table 1 into Equation (1), the transformation matrix of each link can be obtained, the results of which are shown in Equations (2)–(6)

T10=[cosθ10sinθ10sinθ10-cosθ10010d10001] (2)
T21=[cosθ2-sinθ20a2cosθ2sinθ2cosθ20a2sinθ200100001] (3)
T32=[cosθ3-sinθ30a3cosθ3sinθ3cosθ30a3sinθ300100001] (4)
T43=[cosθ40sinθ40sinθ40-cosθ4001000001] (5)
T54=[cosθ5-sinθ500sinθ5cosθ50000100001] (6)

For a manipulator with five degrees of freedom, the transformation matrix from the base coordinate system to the ending joint coordinate system is shown in Equation (7)

T50=T10T21T32T43T54 (7)

Substituting Equations (2) to (6) into Equation (7), Equation (8) can be required:

T50=[r11r12r13pxr21r22r23pyr31r32r33pz0001] (8)

The value of each element in Equation (8) is

{r11=s1s5+c1c5c234,r12=s1c5-c1s5c234r13=c1s234,r21=s1c5c234-c1s5r22=-c1c5-s1s5c234,r23=s1s234r31=c5s234,r32=-s5s234,r33=-c234px=a2c1c2+a3c1c23py=a2s1c2+a3s1c23pz=d1+a2s2+a3s23 (9)

In which, ci=cosθi,si=sinθi,sij=sin(θi+θj),cij=cos(θi+θj).

The inverse kinematics analysis of the manipulator is to solve the rotation of each joint of the manipulator by analyzing the position and posture of capture device at the end of the manipulator. When the value in the transformation matrix T50 is known, Equation (2.1) can be solved by Equation (9).

T50 =[r11r12r13pxr21r22r23pyr31r32r33pz0001]
=T10(θ1)T21(θ2)T32(θ3)T43(θ4)T54(θ5) (10)

Solving the position angle of each joint θi, it can be required as follow:

{θ1=atan2(py,px)θ2=atan2(pz-d1,±γ2-(pz-d1)2)-atan2(a3s3,a3c3+a2)θ3=atan2(±4a22a32-K2,K)θ4=atan2(r33s23+r13c1c23+r23c23s1,-r33c23+r13c1s23+r23s23s1)θ5=atan2(r21c1-r11s1,r22c1-r12s1)

In which, K=px2+py2+(pz-d1)2-a22-a32.

2.2 Dynamic Analysis of the Manipulator of the Capture System

Since the influence to the dynamic of the entire system of the rotation of the joint on manipulator’s wrist is relatively small in the actual underwater movement, in order to facilitate the dynamic analysis and simulation experiment research, the role of the two wrist joints is not considered here, the manipulator is regarded as of three-degree-of-freedom. For the manipulator, only the functions of the waist joint, shoulder joint, and elbow joint are considered, which can not only reduce the amount of calculation, but also obtain calculation results similar to those of the original five-degree-of-freedom manipulator. The dynamics of the manipulator mainly studies the dynamic relationship between the motion of the manipulator and the driving torque of each joint. Based on the Lagrange equation, this paper establishes the dynamic equation of the underwater manipulator with the hydrodynamic term, by comparing with the conventional industrial manipulator, shown in Equation (11).

τ=M(θ)θ¨+C(θ,θ˙)θ˙+H(θ)+τh (11)

In Equation (11), τ is the driving torque of the manipulator joint, τh is the hydrodynamic term of the manipulator, θ˙ is the angular velocity of the manipulator joint, θ¨ is the angular acceleration of the manipulator joint, M(θ) is the third-order positive definite inertia matrix of the mass, H(θ) is the equivalent gravity term, C(θ,θ˙) is the centrifugal force and the Coriolis force vector.

(1) Calculation of inertial force term For the convenience of calculation, it is assumed that the manipulator is a homogeneous circular rod, with center of gravity coinciding with the center of mass. Since the mass of the capture device is relatively small relative to the overall mass of the manipulator, the mass of the capture device is ignored. After calculation and simplification, the inertial force term can be obtained, shown in Equation (12)

M(θ)=[m11m12m13m21m22m23m31m32m33] (12)

In which, the value of each element is

{m12=m13=m21=m31=0m11=m2x22c22+m3(a2c2+x3c23)2m22=m2x22+m3a22+m3x32+2m2a2x2c3m23=m3x32+m2a2x2c3m32=m3x32+m3a2x3c3m33=m3x32

(2) Calculation of centrifugal force and Coriolis force terms C(θ,θ˙) The underwater manipulator studied in this paper has three degrees of freedom after simplification, so the terms of centrifugal force and Coriolis force can be obtained, as is shown in Equation (13)

C(θ,θ˙)=[C1C2C3] (13)

In which, the value of each element is

{C1=-2m2x22s2c2θ˙1θ˙2+2m3x3a2c2c23θ˙1θ˙2+2m3x32s23c23θ˙1θ˙2+ 2m3a22s2c2θ˙1θ˙2+2m3a2x3s23c2θ˙1θ˙2-2m3x32s23c23θ˙1θ˙3- 2m3x3c2a2s23θ˙1θ˙3C2=m2x22s2c2θ˙12+m3x3c2a2s23θ˙12+m3x32s23c23θ˙12+m3a22s2c2θ˙12+m3x3s2a2c23θ˙12-m3x3a2s3θ˙32- 2m3x3a2s3θ˙2θ˙3C3=m3x3a2s23c2+m3x32s23c23θ˙12+m3a22x3s3θ˙22

(3) Calculation of Equivalent Gravity Term Objects in water are subject to buoyancy, the direction of which is always opposite to the direction of gravity. In order to simplify the calculation, it is assumed that the center of mass of each link of the manipulator is coincident with the center of buoyancy, resulting in the assumption that the equivalent gravity in a downward direction can be used to calculate the buoyancy and gravity, shown in Equation (14)

hi=G-F=(mi-ρV)g=mig(1-ρρm) (14)

In which, ρ is the density of water, ρm is the density of manipulator.

Thus, the equivalent gravity term is obtained, shown in Equation (15)

H(θ)=[H1H2H3] (15)

In which, value of each element is

{H1=0H2=h2gx2c2+h3g(a2c2+x3c23)H3=h3gx3θ˙3c23

2.3 Analysis of the Hydrodynamic Term of the Manipulator of the Capture System

Based on the dynamic model of the derived manipulator, its hydrodynamic model can be derived. Unlike the manipulator on the ground, the manipulator working underwater is also affected by the impact of ocean currents and the constant effect of the fluid resistance. When the fluid resistance increases to a relatively high level, the accuracy of the actual position of the manipulator must be reduced, which greatly affects the quality of task execution. Moreover, there could be an irreversible damage applied on the mechanical structure of the manipulator caused by the sudden mutation impact of ocean current. Therefore, the influence of fluid resistance and fluid impact must be considered when establishing the dynamic model of the manipulator.

Before the hydrodynamic analysis, according to the relevant theories of hydrodynamics, the following assumptions are claimed: the influence of random disturbance in the ocean current is not considered, which is hard to modelled and the water flow does not accelerate. Thus, there is no need considering the force generated by the water flow during the acceleration process. The shape of the manipulator is a smooth cylindrical rod, whose center of gravity of each component coincides with the center of buoyancy in the opposite direction.

From the perspective of hydrodynamics, the manipulator is a small-scale structure in the actual working environment. According to the theory of fluid mechanics, the hydrodynamic force of water flow on an object could be divided into four parts: hydrodynamic resistance, inertial force (additional mass force), lift force and buoyancy force.

When the manipulator working in the fluid, due to the viscosity of the fluid, hydrodynamic resistance will be generated. The hydrodynamic resistance can be equivalent to two directions, one of which affects along the link of the manipulator, with the other lays perpendicular to the link. The hydrodynamic resistance along the link is called tangential hydrodynamic resistance, the hydrodynamic resistance of perpendicular to the link is called the normal hydrodynamic resistance. Considering that the manipulator is a link structure, only the normal resistance is considered. When there exists relative acceleration between the manipulator and the surrounding fluid, the acceleration will cause an additional mass force to the manipulator. Since the manipulator involved in this paper has no wing-shaped structure, the effect of lift is not considered. The calculation of the buoyancy has been given out in the previous section, which therefore will not be described in detail here. Thus, when the manipulator works underwater, the force per unit length can be expressed by Equation (16)

F=Fd+Fm (16)

In which, F is the acting force per unit length of the manipulator; Fd is the hydrodynamic resistance per unit length of the manipulator; Fm is the inertial force (additional mass force) per unit length of the manipulator.

In order to analyze the acting force of the manipulator in the underwater environment, the Morison formula proposed by JR Morison is initially utilized to calculate the hydrodynamic resistance and the inertial force of an underwater object which is considered as a relatively small structure, shown in Equations (17)–(18).

dFd=12ρCdv(x)v(x)Ddl (17)
dFm=ρCmAdvn(x)dtdl (18)

In which, ρ is the fluid density, D is the diameter of the cylinder joint, dl is the thickness of the cylinder element, A is the projected area of the manipulator’s link in the direction perpendicular to the incoming flow velocity, Cd is the hydrodynamic resistance coefficient, Cm is the additional mass coefficient, and v(x) is the velocity function.

The hydrodynamic resistance force and hydrodynamic resistance moment of the underwater object are shown in Equations (19)–(20)

Fd=12ρCdD0lvn(x)vn(x)dl (19)
Td=12ρCdD0l([x 0 0]Tvn(x))vn(x)dl (20)

The additional mass force and additional mass moment of the underwater object are shown in Equations (21)–(22)

dFm=ρCmA0ldvn(x)dtdl (21)
dFm=ρCmA0l([x 0 0]Tdvn(x)dt)dl (22)

Based on the Morison equation, the hydrodynamic resistance moment and the additional mass force of the three-joint manipulator in the hydrostatic environment are calculated. The schematic diagram of the manipulator is shown in Figure 2. For this type of manipulator, the main hydrodynamic resistance and additional mass forces are concentrated on the Link2 and the Link3.

images

Figure 2 Diagram of normal velocity.

(1) Hydrodynamic resistance moment τD1 and additional mass moment τA1 on Joint1 When the Joint1 rotates, the Link2 and the Link3 are driven, so that the Link2 and the Link3 generate a normal velocity, which is perpendicular to the rotation direction of the Joint1. According to the motion relationship between the Link2 and the Link3, the normal velocity is shown in Equation (23)

v2-1n=θ˙1x2c2v3-1n=θ˙1(a2c2+x3c23) (23)

In which,v2-1n,v3-1n are the normal velocities of the Link2 and the Link3 caused by the motion of the Joint1 on the unit length, x2 is the distance from the unit dx2 to the bottom of the Link2, x3 and is the distance from the unit dx3 to the bottom of the Link3.

Substituting Equations (23) into Equation (20), the hydrodynamic resistance moment of the Joint1 can be obtained, shown in Equation (2.3)

τD1 =12ρCdD[0a2θ˙1x2c2|θ˙1x2c2|x2dx2
+0a3θ˙1(a2c2+x3c23)|θ˙1(a2c2+x3c23)|(a2c2+x3)dx3] (24)

Similarly, the additional mass moment of the Joint1 is shown in Equation (2.3)

τA1 =π4ρCmD2[0a2x2dθ˙1x2c2dtdx2
+0a3(a2c2+x3)dθ˙1(a2c2+x3c23)dtdx3] (25)

(2) Hydrodynamic resistance moment τD2 and additional mass moment τA2 on Joint2 When the Joint2 rotates, the Link2 and the Link3 are driven, so that the Link2 and the Link3 generate a normal velocity, which is perpendicular to the rotation direction of the Joint2. According to the motion relationship between the Link2 and the Link3, the normal velocity is shown in Equation (26)

v2-2n=θ˙2x2v3-2n=θ˙2a2c3+x3(θ˙2+θ˙3) (26)

In which, v2-2n,v3-2n are the normal velocities of the Link2 and the Link3 caused by the motion of the Joint2 on the unit length, x3 is the distance from the unit dx3 to the bottom of the Link3.

Substituting Equations (26) into Equation (20), the hydrodynamic resistance moment of the Joint2 can be obtained, shown in Equation (2.3)

τD2 =12ρCdD{0a2θ˙2x2|θ˙2x2|x2dx2
+0a3[θ˙2a2c3+x3(θ˙2+θ˙3)]|[θ˙2a2c3+x3(θ˙2+θ˙3)]|
×(a2c3+x3)dx3} (27)

Similarly, the additional mass moment of the Joint2 is shown in Equation (2.3)

τA2 =π4ρCmD2{0a2x2dθ˙2x2dtdx2
+0a3(a2c3+x3)d[θ˙2a2c3+x3(θ˙3+θ˙2)]dtdx3} (28)

(3) Hydrodynamic resistance moment τD3 and additional mass moment τA3 on Joint3 When the Joint3 rotates, the Link3 is driven, so that the Link3 generates a normal velocity, which is perpendicular to the rotation direction of the Joint3. According to the motion relationship, the normal velocity is shown in Equation (30)

v3-3n=θ˙2a2c3+x3(θ˙2+θ˙3) (29)

Substituting Equations (29) into Equation (20), the hydrodynamic resistance moment of the Joint3 can be obtained, shown in Equation (30)

τD3=12ρCdD0a3[θ˙2a2c3+x3(θ˙2+θ˙3)]|θ˙2a2c3+x3(θ˙2+θ˙3)|x3dx3 (30)

Similarly, the additional mass moment of the Joint3 is shown in Equation (31)

τA3=π4ρCmD20a3(a2c3+x3)d[θ˙2a2c3+x3(θ˙3+θ˙2)]dtdx3 (31)

3 Design of Compliant Controller for Underwater Capture System

In order to maintain the operation accuracy of the manipulator during underwater operations, and at the same time show a degree of voluntary compliance to the unknown interference or the impact force of the unmanned underwater vehicle, this study proposes a position-based impedance controller to study the control strategy of the manipulator. During the movement of the manipulator, the error between the actual contact force Fe and the expected contact force Fd of the manipulator will be obtained through the impedance controller, thereby making the manipulator controlled by the position controller. In general, the impedance relationship can be expressed as shown in Equation (32)

Md(X¨e-X¨d)+Bd(X˙e-X˙d)+Kd(Xe-Xd)=Fe-Fd (32)

In which, Md is the designed inertia matrix, Bd is the designed damping matrix, Kd is the designed stiffness matrix, Xe,X˙e,X¨e is the actual position, actual velocity, and actual acceleration of the end of the manipulator, and Xd,X˙d,X¨d is the designed position, designed speed, and designed acceleration of the end of the manipulator.

When the manipulator is impacted by a water flow with a high velocity, a strong impact will be generated due to the inertia of its own motion, which in general does much harm to the mechanical structure of the manipulator. Thus, reasonable adjustment of the target impedance parameters can help reduce the impact of the ocean current on the manipulator, thereby protecting the body structure of the manipulator from damage. According to Equation (32), the target impedance parameters Md, Bd, and Kd, play a very important role in impedance controller. Generally, since the control system can achieve different control effects by adjusting the value of the impedance parameters, choosing the appropriate impedance parameters is necessary for safe operation.

The larger designed inertia Md can make the manipulator obtain a relatively great inertia. Considering that the velocity of the manipulator is low when moving underwater, the impact on the actual joints is not remarkable, thus the adjustment effect is not obvious. Larger designed damping Bd can reduce the degree of oscillation of the manipulator. Considering the underwater working environment of the manipulator, the viscous resistance generated by seawater can reduce the degree of oscillation of the manipulator to a certain extent, leading to the fact that the adjustment effect of the designed damping is not obvious enough. The larger the stiffness parameter Kd become, the greater the contact force between the manipulator and the underwater environment is generated. Generally speaking, the adjustment of the stiffness parameter should make the manipulator system in the state of critical damping or over-damping as possible to ensure the instant contact moment in contact with the environment is reduced to a low level.

When the manipulator operates in an underwater environment, it will also be impacted by ocean currents. Moreover, the fluid-structure coupling analysis of the manipulator system needs to be carried out. The hydrodynamic resistance of the manipulator needs to be divided into two parts, one of which is the force generated by its own motion in the still water environment, the other of which is fluid resistance produced by the ocean current impact. When the manipulator operates underwater, it needs to reach a certain level of position tracking accuracy, in order to improve its operation accuracy and ensure its operation stability in the underwater environment.

Compared with the conventional industrial manipulators, the working environment of the underwater manipulator is much more complex, and the measurement of the contact force with the environment can only be calculated by the actual joint torque. Since the effect of hydrodynamic force can be directly reflected on the joint torque sensor, this research will use the value collected by the joint torque sensor and the dynamic model of the manipulator to calculate the hydrodynamic force of the manipulator in statics water, so as to deduce the hydrodynamic force τw of each joint in the dynamic water environment to establish the impedance controller of the manipulator in the joint space.

The block diagram of the manipulator’s controller is shown in Figure 3.

images

Figure 3 Block diagram of the manipulator’s controller.

4 Simulation Experiment of the Compliant Controller of Underwater Capture System

4.1 Design of the Simulation Experiment

Figure 4 shows the mechanical structure model established by SolidWorks for the underwater capture system consisting of an underwater manipulator and a capture device involved in this study, which has a total of seven degrees of freedom, including three degrees of freedom on the manipulator to adjust the position of capture device, two degrees of freedom on the manipulator to adjusts the tipping and pitching postures of the capture device, as well as two degrees of freedom on the capture device for capture tasks. The structural parameters of underwater manipulator are shown in Table 2.

images

Figure 4 Schematic diagram of underwater manipulator structure.

Table 2 Parameters table of underwater manipulator’s structure

Length Equivalent Quality Equivalent Moment of Inertia
Link i (m) Diameter (m) (kg) Buoyancy (N) (kgm2)
Link2 5.0 0.30 530 1420.4 (53.7, 1468.1, 1692.7)
Link3 3.0 0.28 290 750.5 (3.0, 221.1, 222.5)

In the real ocean, the actual underwater environment mostly consists of turbulent, making it difficult to model dynamic of the in manipulator due to the severe uncertainty caused by the separation phenomenon between the motion of the manipulator and the flow around it. In order to simulate the turbulent environment and better simulate the fluctuate time-varying environment of the real ocean, the motion of the manipulator under infinite flow field conditions is simulated with the irregular waves generated in Gaussian white noises model. Based on the relative velocity and relative acceleration of the manipulator with respect to the current during the motion, the hydrodynamic resistance of the manipulator is calculated as a whole and applied to each joint using the Morrison formula derived in Equations (20) and (22) to obtain the equivalent hydrodynamic resistance moment on the joints. The dynamics model of the manipulator is established in Adams, and the equivalent hydrodynamic resistance moment is used to replace the effect of hydrodynamic resistance on the joints of the manipulator and applied to the corresponding joints of the manipulator to simulate a relatively realistic dynamic environment.

In order to study the influence of different impedance parameters on the control system, fixing inertia coefficient Md damping coefficient Bd and selecting different stiffness coefficient Kd for simulation, the force tracking curves are obtained as shown in Figures 5, 6, and 7.

images

Figure 5 Moment of joint1 with different impedance parameters.

images

Figure 6 Moment of joint2 with different impedance parameters.

images

Figure 7 Moment of joint3 with different impedance parameters.

4.2 Analysis of The Simulation Experiment Results

From the comparative analysis of Figures 8, 9 and 10, it can be concluded that in the case of no impedance, the instantaneous contact moment of the underwater manipulator in contact with the environment is relatively large. In the case of the impedance controller, with the increase of the designed stiffness of the joint, the joint moment generated by the manipulator and the water environment will continue to increase. Selecting the appropriate designed stiffness is beneficial to protect the mechanical structure of the underwater manipulator and meet the operational accuracy requirements of the underwater capture system.

images

Figure 8 Controller performance index of joint1.

images

Figure 9 Controller performance index of joint2.

images

Figure 10 Controller performance index of joint3.

According to the results in Figure 8, the study found that with the increase of the designed stiffness of joint 1, the system overshoot will gradually decrease, but the instant contact force of the manipulator will also gradually increase. Compared with the manipulator with impedance, the maximum instant contact moment and the average contact moment within 10 s of the manipulator without impedance are larger, which proves that the impedance controller is superior in the water environment. Moreover, although the overshoot of the impedance controller is larger than that of the no-impedance case, compared with the reduction of the contact torque, the research believes that the increased overshoot is acceptable compared to the capture accuracy of the system. With the increase of the designed stiffness, the change of overshoot and contact moment produced by the joint 2 are not obvious. It can be considered that for this system, the stiffness coefficient has a poor adjustment effect on the joint 2. However, it is obvious that the overshoot and contact torque of joint 2 will be significantly reduced compared with the case of no impedance. While the designed stiffness is increased, the contact moment generated by the joint 3 does not change significantly, but the overshoot is significantly reduced. It can be considered that appropriately increasing the stiffness of the joint 3 helps to ensure the capture accuracy of the underwater manipulator.

5 Conclusion

Based on the specific structure of the five-degree-of-freedom underwater manipulator, this research analyzes its kinematic model and simplified dynamic model, as well as the hydrodynamic model. According to the characteristics of the underwater environment, a compliance control method based on joint position is designed. The capture system is modeled in Adams dynamics platform to testify the designed compliant controller. The simulation experiment verifies that the compliant controller can reduce the impact of the underwater environment.

For future research, it is believed that the designed stiffness of joint 1 should be appropriately reduced in order to solve the problem of excessive contact force, and the designed stiffness of joint 3 should be appropriately increased to ensure the accuracy of system operation, while the designed stiffness has little adjustment effect on joint 2.

Acknowledgments

This work is supported by the National Natural Science Foundation of China (U2013602, 52075115, 51521003, 61911530250), National Key R&D Program of China (2020YFB13134), Self-Planned Task (SKLRS202001B, SKLRS202110B) of State Key Laboratory of Robotics and System (HIT), Shenzhen Science and Technology Research and Development Foundation (JCYJ20190813171009236), and Basic Scientific Research of Technology (JCKY2020603C009).

References

[1] Chu Z, Xiang X, D Zhu, et al. Adaptive Fuzzy Sliding Mode Diving Control for Autonomous Underwater Vehicle with Input Constraint. International Journal of Fuzzy Systems, 2017. 20: 1460–1469.

[2] GianlucaAntonelli. Fault Detection/Tolerance Strategies for AUVs and ROVs. 2006, 2: 79–91.

[3] Mishra S, Londhe P S, Mohan S, et al. Robust task-space motion control of a mobile manipulator using a nonlinear control with an uncertainty estimator. Computers & Electrical Engineering,, 2018, 67: 729–740.

[4] Liu T, Hu Y, Xu H, et al. Investigation of the vectored thruster AUVs based on 3SPS-S parallel manipulator. Applied Ocean Research, 2019, 85: 151–161.

[5] Lijun Han et al. Adaptive Wave Neural Network Nonsingular Terminal Sliding Mode Control for an Underwater Manipulator with Force Estimation. Transactions of the Canadian Society for Mechanical Engineering, 2020, 45(2): 183–198.

[6] Sangrok Jin et al. Design, modeling and optimization of an underwater manipulator with four-bar mechanism and compliant linkage. Journal of Mechanical Science and Technology, 2016, 30(9): 4337–4343.

[7] M. Santhakumar. A nonregressor nonlinear disturbance observer-based adaptive control scheme for an underwater manipulator. Advanced Robotics, 2013, 27(16): 1273–1283.

[8] Hogan N. Impedance control: An approach to manipulation. Journal of dynamic systems, measurement, and control, 1985, 107(1): 8–16.

[9] Xianjun Sheng, Xi Zhang, Fuzzy adaptive hybrid impedance control for mirror milling system, Mechatronics, 2018, 53: 20–27,

[10] Kang Xu, Shoukun Wang, Binkai Yue, Junzheng Wang, Hui Peng, Dongchen Liu, Zhihua Chen, Mingxin Shi, Adaptive impedance control with variable target stiffness for wheel-legged robot on complex unknown terrain, Mechatronics, 2020, 69, 102388.

[11] Le Liang, Yanyan Chen, Liangchuang Liao, Hongwei Sun, Yanjie Liu, A novel impedance control method of rubber unstacking robot dealing with unpredictable and time-variable adhesion force, Robotics and Computer-Integrated Manufacturing, 2021, 67, 102038.

[12] Ignacio Carlucho, Dylan W. Stephens, Corina Barbalata, An adaptive data-driven controller for underwater manipulators with variable payload, Applied Ocean Research, 2021, 113, 102726.

Biographies

images

Yuanjie Liu received his bachelor’s degree in Mechanical Design Manufacturing and Automation from Yanshan University, Qinhuangdao, China. He is now pursing his master’s degree in Machinery Engineering at the School of Mechatronic Engineering, Harbin Institute of Technology, Harbin, China. His main research fields are: underwater robots and robots’ dynamic.

images

Fusheng Zha, associate professor at the School of Mechatronic Engineering, Harbin Institute of Technology. He received his doctorate degree in engineering from Harbin Institute of Technology in 2012. His main research fields are: footed robots, underwater robots, artificial intelligence and self-growing networks, bionic information processing methods, neural information encoding and decoding methods.

images

Qiming Wang, received his bachelor’s degree in Mechatronic Engineering from Harbin Institute of Technology, and the Master of science degree in Mechanical Engineering from Washington University in St. Louis, the USA. He is now pursing his doctorate degree in mechanical engineering at the School of Mechatronic Engineering, Harbin Institute of Technology. His main research fields are: underwater robots, six-legged robot, robots’ dynamic, and artificial intelligent control methods.

images

Chao Zheng, is working as an engineer at the Wuhan Second Ship Design and Research Institute, Wuhan, China. His main research area includes underwater robotics and robots’ dynamic.

images

Jinrui Zhou, is a senior student in Mechatronic Engineering at the School of Mechatronic Engineering, Harbin Institute of Technology. He is going to pursuing his Master’s degree in Mechanical Engineering after graduation. His main contribution to this research is proposing a mechanical design of the manipulator.

images

Lianzhao Zhang, received his bachelor’s degree in Mechanical and Electronic Engineering from Northwest A&F University, Yangling, China. He is a graduate student pursing master’s degree in Mechanical Engineering at the School of Mechatronic Engineering, Harbin Institute of Technology and is going to pursing his doctorate degree in mechanical engineering. His research interests include the autonomous control, dynamics analysis and simulation of legged robots.

Abstract

1 Introduction

Nomenclature

2 Establishment of the Kinematics and Dynamics Model of the Capture System

2.1 Kinematics Model of the Capture System

images

2.2 Dynamic Analysis of the Manipulator of the Capture System

2.3 Analysis of the Hydrodynamic Term of the Manipulator of the Capture System

images

3 Design of Compliant Controller for Underwater Capture System

images

4 Simulation Experiment of the Compliant Controller of Underwater Capture System

4.1 Design of the Simulation Experiment

images

images

images

images

4.2 Analysis of The Simulation Experiment Results

images

images

images

5 Conclusion

Acknowledgments

References

Biographies