Task-priority redundancy resolution on acceleration ... - SAGE Journals

Research Article

Task-priority redundancy resolution on acceleration level for underwater vehicle-manipulator system

International Journal of Advanced Robotic Systems July-August 2017: 1–9 ª The Author(s) 2017 DOI: 10.1177/1729881417719825 journals.sagepub.com/home/arx

Qirong Tang1, Le Liang1, Jianhua Xie2, Yinghao Li1 and Zhenqiang Deng1

Abstract A task-priority redundancy resolution with restoring moments optimized on acceleration level for the underwater vehicle-manipulator system is investigated in this article. Redundant resolution is a key and difficult problem in underwater vehicle-manipulator system’s trajectory planning. Firstly, kinematic modeling and dynamic modeling based on Lagrange method are studied. To overcome acceleration’s sudden change in traditional task-priority method, a new redundancy resolution method on the acceleration level is proposed. In this approach, a scalar potential function is established and used for reducing the effect of restoring moments by applying gradient projection. Finally, simulation is performed to verify the effectiveness of the proposed approach by comparing with traditional approaches. Keywords UVMS, redundancy resolution, acceleration level, task priority, restoring moments Date received: 31 March 2017; accepted: 23 May 2017 Topic: Special Issue - Underwater Environmental Perception and Manipulation Topic Editor: Hai Huang Associate Editor: Hai Huang

Introduction Underwater robots nowadays are playing a more and more important role in the field of ocean exploitation. Cable remote controlled submersible, known as remote operated vehicle, is relatively mature however very limited physically. 1 Autonomous underwater vehicle (AUV), which is capable of extending navigation range with higher intelligence, will be used more widely.2 However, AUV lacks the ability to carry out the intervention task. So AUV’s application has many limitations. Underwater vehicle-manipulator system (UVMS), which is based on AUV and equipped with one or more manipulators, is a kind of more practical submersible. Compared to AUV, UVMS has enhanced the operational capacity and made its application value to be further improved. Because of kinematic redundancy, dynamic coupling, and interference from the outside environment, it is very

difficult to determine the optimal trajectory during the executing tasks. For the UVMS with limited energy, a reasonable trajectory can improve the performance on saving energy and increasing its duration. Redundancy resolution of UVMS, which determines UVMS’s position, velocity, and acceleration during the task, is an important part of trajectory planning. Definitely, a reasonable

1

Laboratory of Robotics and Multibody System, School of Mechanical Engineering, Tongji University, Shanghai, China 2 NI Equipment Department, China Nuclear Power Engineering Company, Shenzhen, China Corresponding author: Qirong Tang, Laboratory of Robotics and Multibody System, School of Mechanical Engineering, Tongji University, Room A435, Kaiwu Bd, Shanghai 201804, China. Email: [email protected]

Creative Commons CC BY: This article is distributed under the terms of the Creative Commons Attribution 4.0 License (http://www.creativecommons.org/licenses/by/4.0/) which permits any use, reproduction and distribution of the work without further permission provided the original work is attributed as specified on the SAGE and Open Access pages (https://us.sagepub.com/en-us/nam/ open-access-at-sage).

2 redundancy resolution method is able to ensure the stability of the system, meanwhile, reduce the external interference as much as possible. Therefore, it is of great significance to study the redundancy resolution method for UVMS trajectory planning. For a UVMS with kinematic redundancy, there are infinite solutions of inverse kinematics. One of the methods is to obtain the least squares solution using Moore–Penrose pseudoinverse of Jacobian matrix.3,4 The physical meaning of least square solution is that the solution makes the twonorm of generalized velocity vector minimum.5 Usually, there is big difference between the mass of the vehicle and manipulator. For a UVMS whose energy is limited, the movement of the vehicle should be as small as possible, meanwhile, fulfills the requirements of performance. It is a common method to assign weights between degrees of freedom (DOFs). The motion amplitude of different DOFs can be adjusted by changing the values of the weight matrix. If the weight matrix is taken as the inertia matrix, then weighted least square solution reaches minimal kinetic energy physically. This approach is not suitable for UVMS’s trajectory planning since hydrodynamic forces are not considered in this approach. Because of the underwater environment, hydrodynamic force is the key factor affecting the movement of the system. Its impact on the system cannot be ignored in redundancy resolution. Gradient projection method (GPM) is one of the methods that often used to solve this problem. The GPM has been successfully applied to the optimization of fluid drag force, obstacle avoidance, and torque optimization.6–9 In this method, a scalar potential function to be optimized is established firstly and then its negative gradient is projected into the inverse kinematics solution by means of the null space operator. In the study by Ji et al.,10 zero moment point equation is chosen as the function to be optimized. That means the propulsion energy for controlling the vehicle’s motion can be reduced. The restoring moments have been optimized using GPM in the studies by Ismail and Dunnigan11 and Han and Chung,12 and results are verified by simulation examples. Antonelli and Chiaverini13 developed a task-priority redundancy resolution for UVMS. Afterward, Soylu et al.14 have proposed a revised task-priority approach that is able to avoid singular configurations of the manipulator. Targets are divided into priority task and secondary task. Task-priority method completes the secondary task while ensuring the completion of the priority tasks. When the two tasks conflict, the secondary task is released to allow fulfillment of the primary task. However, all these three methods have some deficiencies. The hydrodynamic factors of UVMS are not considered in weighted generalized inverse method. For GPM, it is difficult to determine its gradient amplification coefficient, so the optimal result cannot be reached. The taskpriority method is well developed because of its practical significance. However, the relationship between the

International Journal of Advanced Robotic Systems

Figure 1. Coordinate systems of a UVMS. UVMS: underwater vehicle-manipulator system.

secondary task and the optimization target is usually hard to determine. Besides, traditional resolution on velocity level often leads to abrupt change of acceleration and discontinuity of the velocity. In this article, a task-priority redundancy resolution on acceleration level is introduced, and the secondary task is replaced by optimization function which using GPM approach. Such system performance can be improved while the priority task is ensured. The effectiveness of the approach is verified by simulations. This article is organized as follows. In the next section, the kinematic and dynamic modeling of the UVMS is introduced. Then, a task priority with restoring moment optimized solution of redundancy on acceleration level is proposed. Afterward, some numerical examples are carried out to validate the effectiveness of the proposed method. The last section holds the conclusion.

Kinematic and dynamic modeling of UVMS Kinematic modeling The UVMS system is usually made up of a vehicle and one or more manipulators. The coordinate system and some key vectors of a UVMS which is equipped P with anP n-DOF manipulator are shown in Figure 1. Here, 0 and v represent the inertial frame and the vehicle frame, respectively. The transformation matrix of ith link of the manipulator can be obtained based on the homogeneous coordinate transformation method 0

Ti ¼ 0 Tv v T 1   i1 Ti ; ði ¼ 1; 2; . . . ; nÞ

(1)

where 0 Ti 2 Rð44Þ indicates the transformation matrix from ith link-fixed frame to the inertial frame. Similarly, 0 Tv represents the transformation matrix from the vehicle frame to the inertial frame and v T1 represents the transformation matrix from the vehicle frame to the link frame. The generalized form of transformation matrix from ith link frame to (i1)th link frame can be expressed as

Tang et al.

3

i1

 i1 Ti ¼

Ri

di 1

0

Dynamic modeling

 (2)

where i1 Ri 2 Rð33Þ denotes the rotation matrix and the vector di indicates the position vector of the origin of the (i1)th frame in the ith link frame. Using the transformation matrix, vectors in different frames can be transformed into the same frame which is usually selected as inertial frame. The kinematic and dynamic equation can be carried out in inertial frame. According to the position relation of linkage mechanism, the position vector of end effector pe ¼ ½pex pey pez T 2 R 3 can be obtained from pe ¼ pv þ l 0 þ

n X li

(3)

i¼1

where pv is position of vehicle in the inertial frame, l 0 is position vector between the vehicle frame’ origin to first link frame’ origin, and li is the position vector between the (i1)th link frame’ origin to ith’s. Taking the derivation of equation (3) with respect to time, end effector’ velocity p_ e can be obtained p_ e ¼ vv þ ␻v  l 0 þ

n X ␻i  li

(4)

i¼1

where ␻v and ␻i are the rotation velocity of vehicle and ith link in inertial frame, respectively. Using geometric relations and relative velocity relation, p_ e and rotation velocity ␻e are rewritten as p_ e ¼ p_ v þ ␻v  ðpe  pv Þ þ

n X q_ i ki  ðpe  pi Þ

In this work, the dynamic modeling of the UVMS in the inertial frame is established through the second Lagrange equation which is expressed by   d @L @L ¼Q (9)  dt @ _ @ where  ¼ ½T qT T 2 Rð6þnÞ is the vector containing the vehicle position, attitude , and the joint variable q. In  ¼ ½x y z ’  T 2 R 6 , x, y, and z indicate position of the center of mass (CM) of vehicle in the inertial frame, and ’; ; and represent the yaw angle, pitch angle, and roll angle, respectively. Vector q ¼ ½q1 . . . qn T 2 Rn is the joint variable vector of manipulator, and L represents the Lagrange function of the system that is defined as the difference between the kinetic energy and the potential energy of the system. The UVMS needs to be adjusted to keep the buoyancy being basically consistent with the gravity before launching, so the potential energy is ignored in this case. In equation (9), Q indicates those generalized external forces acting on the system. In underwater environment, generalized external forces Q mainly include external driving force τ (usually denotes propulsive force and motor torque and damping forces), hydrodynamic force D (fluid drag force and lift force), and restoring moments (come from deviation between center of buoyancy (CB) and CM). According to Antonelli, 15 dynamic equation of the UVMS can be written in a compact state-space form, which is the final outcome of solving equation (9). It is governed by

(5)

MðÞ€ þ Cð; _ Þ_ þ Dð_ Þ_ þ GðÞ ¼ τ

i¼1

␻e ¼ ␻v þ

n X

q_ i ki

(6)

i¼1

where q ¼ ½q1    qn T 2 Rn is the joint variable vector and ki is the rotation direction vector of ith joint in inertial frame. Equations (5) and (6) can be written in the matrix form 2 3 " # " # p_ v p_ e I3 ^ p ev JTe 6 7 6 ␻v 7 ¼ 4 5 (7) ␻e 033 I3 JRe q_ ¼ Je _ where JTe ¼ ½k 1  ðpe  p1 Þ; k 2  ðpe  p 2 Þ JRe ¼ ½k 1 ; k 2 

(8)

^ ev 2 R33 is defined by equation Matrix p ^ ev ðpe  pv Þ, and vector _ is the gener␻v  ðpe  pv Þ ¼ p alized velocity vector. Equation (7) is the well-known kinematic equation.

(10)

where " MðÞ ¼

Mv ðÞ HðÞ

HT ðÞ Mm ðqÞ

3 T _ C1 _ 6 7 .. 7 Cð; _ Þ_ ¼ 6 4 5 . _ T Cð6þnÞ _

# (11)

2

(12)

In equation (11), MðÞ 2 Rð6þnÞð6þnÞ is the inertia matrix of the UVMS including added mass terms. Matrix HðÞ 2 Rðn6Þ is the term of reaction forces and moments between the vehicle and the manipulator. The nonlinear term Cð; _ Þ_ 2 Rð6þnÞ is Coriolis and centripetal terms and Ci is a nonlinear force matrix corresponding to each DOF. Subscripts v and m represent the vehicle and manipulator, respectively. The damping effect of the fluid cannot be ignored in UVMS’s dynamics. It can be considered as the sum of the drag force and the lift forces. The former is opposite to the relative velocity between the body and the fluid, while

4

International Journal of Advanced Robotic Systems

the latter are normal to it and they are supposed to act on the CM of the body.16 For a completely submerged body, a simplified damping coefficients matrix which only consists of linear and quadratic terms is presented by15 Dð_ Þ ¼  diagfDl1 Dl2    Dlð6þnÞ g _ Dq2 jyj _    Dqð6þnÞ jq_ n jg  diagfDq1 jxj

Classical task-priority approach (13)

where Dl1 . . . Dlð6þnÞ are the flow resistance coefficients about linear terms, while Dq1 . . . Dqð6þnÞ are about quadratic terms. The values of coefficients are depending on vehicle configuration and fluid properties. In general, an experiment is necessary to obtain the certain value of them. Vector GðÞ 2 Rð6þnÞ is the vector of gravity and buoyancy effects (restoring moment) that affects UVMS strongly. It is assumed that the manipulator joints are all rotating joints, and the restoring moments can be expressed as " # gv ðÞ GðÞ ¼  gm ðÞ 3 2 B0 þ G0 X n 7 6 6 ð 0 rbj  Bj þ 0 rgj  Gj Þ 7 j¼0 7 6 7 6 7 (14) 6 .. 7 6 . 7 6 7 X ¼ 6 n 7 6 0 0 ð r  B þ r  G Þ 7 6 ni  bj j gj j j¼i 7 6 7 6 7 6 . .. 7 6 5 4 nn  ð 0 rbn  Bn þ 0 rgn  Gn Þ

where ni ¼ 0 Ri  ½0 0 1T 2 3 0 6 7 Gi ¼ 4 0 5 ði ¼ 1; 2; . . . ; nÞ mi g 2 3 0 6 7 Bi ¼ 4 0 5 ði ¼ 1; 2; . . . ; nÞ Bi

Acceleration-level task-priority redundancy resolution approach with restoring moments optimized

(15)

(16)

Considering task-priority kinematics equation x_ p ¼ Jp _

where vector x_ p 2 Rtp is the priority task vector, matrix Jp 2 Rtp ð6þnÞ is the Jacobian matrix that corresponds to x_ p , and tp is the dimension of priority task. Unlike end effector velocity vector x_ e , vector x_ p can not only include end effector velocity x_e but the vehicle displacement or rotation velocity vector according to the actual requirements. The expression of task priority is represented in the form _ ¼ Jpy x_ p þ ðI  Jyp Jp ÞJyl x_ s

(19)

where x_ p denotes the primary task vector and Jyp is the Jacobian matrix corresponding to it and x_ s is the secondary task vector. In this framework, a primary task x_ p is defined which is fulfilled along with a suitably defined secondary task as long as the two tasks do not conflict. When the two tasks conflict, the secondary task is released to allow fulfillment of the primary task.

Task-priority approach with restoring moments optimized on acceleration level In order to avoid the discontinuity of acceleration, the taskpriority method is extended to the acceleration level in this section. Meanwhile, in order to optimize the solution of redundancy, the GPM is used to optimize restoring moments which have a strong influence on both vehicle and manipulator. By taking the derivative of equation (18) with respect to time, the kinematic equation on acceleration level can be expressed as €x p ¼ Jp € þ J_ p _

(17)

where Gi and Bi are the gravity and buoyancy of the ith link of UVMS represented in the inertial frame, 0 rgi 2 R 3 indicates the position vector of the ith link’s CM, and 0 rbi 2 R 3 denotes the position vector of CB in the inertial frame. The vector ni represents the direction vector of the Z-axis in the ith link-fixed frame. Generalized external force τ 2 Rð6þnÞ driving UVMS includes two parts: the vehicle generalized force τv and joint motor driving force τm . Through equations (10) to (17), the dynamic model of UVMS is established.

(18)

(20)

where matrix J_ p is the time derivative of Jacobian matrix. Here, defining vector ~x€p 2 Rtp and x~€p ¼ €x p  J_ p _

(21)

Then using GPM, the inverse kinematic of equation (20) on acceleration level is in the form € ¼ Jy ~x€p þ ðI  Jy Jp Þφ€ pW pW

(22)

JypW ¼ W1 JTp ðJp W1 JTp Þ

(23)

where

Tang et al.

5

€ 2 Rð6þnÞ is an arbitrary value vector, Here,  ðI  JypW Jp Þ is the null space factor of Jp , and W is the weight coefficient matrix. In order to reduce the influence of restoring moment, here a positive definite scalar potential function is defined as pðÞ ¼ GðÞT Wu GðÞ

(24)

where G 2 Rð6þnÞ is the restoring moments and Wu is a positive defining weight matrix. The negative gradient of the function pðÞ is the restoring torque’s descent direction. The gradient is expressed as rpðÞ ¼

@pðÞ @GðÞ ¼ GðÞT Wu @ @

(25)

By amplifying the gradient rpðÞ using a suitable € can be amplification factor, the arbitrary vector ’ expressed as € ¼ krpðÞT 

(26)

Table 1. D-H parameters of manipulator in UVMS. Joints 1 2 3

i

i

ai1 (mm)

di (mm)

0 p p=2

p=2 p=2 0

0 0 0:22

0 0:312 0:05

UVMS: underwater vehicle-manipulator system.

Table 2. Main parameters of UVMS. Items m= kg Ixx = kgm2 Iyy = kgm2 Izz = kgm2 Ixy = kgm2 Ixz = kgm2 Iyz = kgm2

Vehicle

Link 1

Link 2

Link 3

85.2 35:040 2:140 35:667 0:0063 0 0:0233

2:603 0:0062 0:0061 0:0071 0 0 0

3:159 0:177 0:177 0:0047 0 0 0:00559

2:752 0:119 0:0304 0:0911 0 0 0:0426

UVMS: underwater vehicle-manipulator system.

where k is a gain coefficient. Because of the existence of numerical floating, the acceleration variable ~ x€p should be written as the closed-loop form € ¼~ X x€p þ kv ðx_ des  x_ p Þ

(27)

where x_ des is the desired value of the task velocity and kv is a constant. Thus, the task-priority redundancy resolution on acceleration level with restoring moments optimized is represented in the form € ¼ Jy X €  ðI  Jy Jp ÞkrpðÞT pM pM

(28)

Numerical examples Simulation setup Three numerical are carried out to verify the validity of the proposed approach in this section. Its expressions are as follows: 1. inertia weight solution on velocity level _ ¼ JypM x_ p 2. inertia weight solution on acceleration level € ¼ Jy X € pM 3. restoring moment optimized solution on acceleration level € ¼ Jy X €  ðI  JypM Jp ÞkrpðÞT pM The first one uses inertia weight resolution on velocity level whose weight matrix W is chosen as inertia matrix M in equation (10). The inertia weight solution on

Figure 2. Coordinate system of 3-DOFs manipulator. DOF: degree of freedom.

acceleration level is applied in the second example and its weight matrix is also selected as matrix M. The third example uses the restoring moment optimized resolution on acceleration level. Contrasting to the second example, the effectiveness of the proposed approach can be verified. Because capsizing is not allowed in the actual system during its manipulation operation, the priority task is selected as the position of end effector, vehicle pitch angle, and vehicle roll angle x_ p ¼ ½pex pey pez  T

(29)

In equation (29), pex pey pez are selected as the desired path and  are chosen as zero. That is, the end effector reaches the desired position while the pitch and roll angle stay stable. The data used for the simulation come from a physical UVMS which consist of a 6-DOFs vehicle and a 3-DOFs rotary joint manipulator. The specific parameters are displayed in Tables 1 and 2. The coordinate system of manipulator is shown in Figure 2. The initial generalized position vector is  ¼ ½0 0 0 0 0 0  p=4 0 p=4T when system time is 0. The end effector is required to complete a circular trajectory in 10 s

6

International Journal of Advanced Robotic Systems

Figure 3. History of inertia weight solution on acceleration level. (a) Translational velocity. (b) Rotational velocity. (c) Joint velocity. (d) Translational acceleration. (e) Rotational acceleration. (f) Joint acceleration. (g) Moving trail. (h) Restoring moments.

and return to its initial position after a circle travel. The motion of UVMS is determined by the dynamic equation without external interference.

Results and discussion Figures 3 to 5 show the simulation results of three approaches mentioned above. In general, the three approaches have successfully completed the scheduled end effector trajectory. The moving trail of inertia weight resolution on velocity level is shown in Figure 3(g). The advantage of approach 1 is that the minimal instantaneous kinetic energy is guaranteed during the travel using inertia matrix M. Because the vehicle mass is much greater than manipulator’s, movement range of vehicle is strongly restricted. We can find that the desired trajectory is almost completed by the movement of manipulator and the acceleration of the vehicle is almost zero in the first 4 s. Then, the

desired trajectory surpasses the range of motion of the manipulator gradually. The vehicle must take its own displacement to ensure the end effector to reach its desired position, see Figure 3(a) and (d). It is worth to be mentioned that in Figure 3(b) and (d), the rotation velocity and acceleration are maintained at a very small value. Meanwhile, as shown in Figure 3(g), we can visually find that pitch angle and roll angle of the vehicle remain stable. The effectiveness of the task-priority approach is verified in this case. However, there are obvious sudden changes, which are unfavorable for the control system, in vehicle and manipulator’s acceleration history. This problem can be solved by solving the redundancy on the acceleration level. The simulation result of inertia weight resolution on acceleration level is shown in Figure 4. Similarly, the displacement of vehicle is much smaller than the manipulator’s. Meanwhile, because of using equation (29) as the priority task, the velocity and acceleration of vehicle

Tang et al.

7

Figure 4. History of restoring moment optimized solution on acceleration level. (a) Translational velocity. (b) Rotational velocity. (c) Joint velocity. (d) Translational acceleration. (e) Rotational acceleration. (f) Joint acceleration. (g) Moving trail. (h) Restoring moments.

pitch angle and roll angle approach zero so that the pose of the vehicle is able to remain stable. Most notably, there is no sudden change in acceleration, and the velocity curve becomes smoother. Comparing Figure 4(a) to (c) with Figure 3(a) to (c), respectively, the trajectory obtained by the redundancy resolution on acceleration level is smoother than one on velocity level. Meanwhile, there are smaller amplitude in both acceleration and velocity. It can be seen that the redundant resolution acceleration level can ensure the continuity of the acceleration, that is, smooths the velocity curve and reduces the impact of the system. So that the dynamic performance of system can be improved. In case of restoring moment optimized approach, its simulation results are shown in Figure 5. As shown in Figures 4(g) and 5(g) intuitively, in case of restoring moment optimized approach, the vehicle movement is

significantly decreased, as well as in the range of motion of the manipulator’s movement. The change of restoring moments can be observed from the numerical curves in Figures 3(h) to 5(h). It can be observed that restoring moments on the joints, vehicle yaw angle, and vehicle pitch angle have the same trend, and there is no significant difference in the numerical value. It is worth to be mentioned that the maximum of amplitude of the pitch angle is reduced significantly. In the case of restoring moments optimized solution on acceleration level, moments on the vehicle roll angle decreases constantly and finally tends to zero. The optimization results are shown in Figure 6. The curves in Figure 6 are the histories of the restoring moments vector G’s two-norm. Obviously, the results obtained by the proposed approach reduced the effect of restoring moments. Comparing Figure 4(a) with Figure 5(a), the amplitude of the motion is further

8

International Journal of Advanced Robotic Systems

Figure 5. History of restoring moments two-norm jjGjj.

reduced. This is because that the reduction of the restoring moments decreases the work which is used to overcome the restoring moments, so that it can accomplish the scheduled task while lower velocity is reached.

Conclusion

Figure 6. History of inertia weight solution on velocity level. (a) Translational velocity. (b) Rotational velocity. (c) Joint velocity. (d) Translational acceleration. (e) Rotational acceleration. (f) Joint acceleration. (g) Moving trail. (h) Restoring moments.

A restoring moment optimized task-priority redundancy resolution approach on acceleration level for UVMS is proposed in this article. Firstly, considering the influence of the restoring torque and the viscous force, the kinematic and dynamic modeling of UVMS is established based on the second Lagrange equation. Then, the proposed task-priority approach is introduced and it replaces the process of determining the secondary task with the optimization of restoring moment using gradient projection. In order to verify the validity of the approach, simulation is carried out using real UVMS data. By comparing with cases 1 and 2, it can be found that the acceleration curve is smoother and the restoring moments’ two-norm is

Tang et al. reduced in case 3. So far, the simulation results show that the proposed approach is feasible and effective in redundancy resolution of UVMS. However, the proposed method has not been verified in the actual system. The future work will focus on transferring the work to real physical UVMS system and verifying the proposed method in detail and more practically. Still, the acceleration is not smooth enough using the redundancy resolution on acceleration level. The redundancy resolution on the jerk speed level will be researched in the following.

9

5.

6.

7.

Acknowledgement All financial supports for this work are highly appreciated. 8.

Declaration of conflicting interests The author(s) declared no potential conflicts of interest with respect to the research, authorship, and/or publication of this article.

9.

Funding The author(s) disclosed receipt of the following financial support for the research, authorship, and/or publication of this article: This work is supported by the Key Basic Research Project of “Shanghai Science and Technology Innovation Plan” under grant 15JC1403300, the National Natural Science Foundation of China under grants 61603277 and 51579053, the State Key Laboratory of Robotics and Systems (Harbin Institute of Technology), key project under grant SKLRS-2015-ZD-03, and the SAST Project under grant 2016017. Meanwhile, this work is also partially supported by the Fundamental Research Funds for the Central Universities under grant 2014KJ032 (“Interdisciplinary Project” with no. 20153683), and “The Youth 1000 program” project under grant 1000231901. It is also partially sponsored by “Shanghai Pujiang Program” project under grant 15PJ1408400, the National College Students Innovation Project under grant 1000107094, as well as the project from Nuclear Power Engineering Co., Ltd under grant 20161686.

10.

References

13.

1. Huang H, Wan L, Chang WT, et al. A fault-tolerable control scheme for an open-frame underwater vehicle. Int J Adv Robot Syst 2014; 11(1): 1–12. 2. Thomas H, Arnar S, and Robert M. Expanding the small AUV mission envelope; longer, deeper and more accurate. In: Proceedings of 2012 IEEE/OES autonomous underwater vehicles, Vol. 1, Southampton, UK, 24–27 September 2012, pp. 1–4. Piscataway, NJ, USA; Los Alamitos, CA, USA: IEEE. 3. Egeland O, Sagli J, Spangelo I, et al. A damped least-squares solution to redundancy resolution. In: Proceedings. 1991 IEEE international conference on robotics and automation, Vol. 1, Sacramento, USA, 9–11 April 1991, pp. 945–950. Los Alamitos, CA, USA: IEEE. 4. Chan T and Dubey R. A weighted least-norm solution based scheme for avoiding joint limits for redundant manipulators. In: Proceedings of 1993 IEEE international conference on robotics

11.

12.

14.

15. 16.

and automation, Vol. 3, Atlanta, USA, 2–6 May 1993, pp. 395–402. Los Alamitos, CA, USA: IEEE. Antonelli G. Underwater robots: motion and force control of vehicle-manipulator systems. Berlin Heidelberg: Springer, 2003. Sarkar N and Podder TK. Coordinated motion planning and control of autonomous underwater vehicle-manipulator system subject to drag optimization. IEEE J Ocean Eng 2001; 26(2): 228–239. Shen Y and Huper K. Optimal trajectory planning of manipulators subject. In: Proceedings of 12th international conference on advanced robotics 2005, Seattle, USA, 17–20 July 2005, pp. 9–16. Piscataway, NJ, USA: IEEE. Podder T and Sarkar N. A unified dynamics-based motion planning algorithm for autonomous underwater vehiclemanipulator systems (UVMS). Robotica 2004; 22(1): 117–128. Hollerbach J and Suh K. Redundancy resolution of manipulators through torque optimization. IEEE J Robot Autom 1987; RA–3(4): 308–316. Ji DH, Kim D, Kang JI, et al. Redundancy analysis and motion control using ZMP equation for underwater vehiclemanipulator systems. In: OCEANS 2016 - Shanghai number 1 in 1, Shanghai, China, 10–13 April 2016, pp. 1–6. Piscataway, NJ, USA: IEEE. Ismail ZH and Dunnigan MW. Redundancy resolution for underwater vehicle-manipulator systems with congruent gravity and buoyancy loading optimization. In: Proceedings of 2009 IEEE international conference on robotics and biomimetics (ROBIO), Guilin, China, 19–23 December 2009, pp. 1393–1399. Piscataway, NJ, USA: IEEE. Han J and Chung WK. Redundancy resolution for underwater vehicle-manipulator systems with minimizing restoring moments. In: Proceedings of 2007 IEEE/RSJ international conference on intelligent robots and systems, San Diego, USA, 29 October–2 November 2007, pp. 3522–3527. Piscataway, NJ, USA: IEEE. Antonelli G and Chiaverini S. Task-priority redundancy resolution for underwater vehicle-manipulator systems. In: Proceedings of the 1998 IEEE international conference on robotics and automation, Vol. 1, Leuven, Belgium, 1998, pp. 768–773. Soylu S, Buckham BJ, and Podhorodeski RP. Dexterous task-priority based redundancy resolution for underwatermanipulator systems. Trans Canad Soc Mech Eng 2007; 31(4): 519–533. Antonelli G. Underwater robots. Berlin/Heidelberg: Springer, 2014. McMillan S, Orin D, and McGhee R. Efficient dynamic simulation of an unmanned underwater vehicle with a manipulator. In: Proceedings of the 1994 IEEE international conference on robotics and automation, Vol. 2, San Diego, USA, 8–13 May 1994, pp. 1133–1140. Los Alamitos, CA, USA: IEEE.