Abstract
For the motion coordination problem between the underwater vehicle and manipulator of the underwater vehicle–manipulator system, a new redundancy resolution method is proposed and investigated. The proposed method mainly has two parts: a fuzzy logic part and a multitasks weighted gradient projection method part. The fuzzy logic part is used to decide the weight factors of the motion distribute matrix and the priorities of all the secondary objectives, while the multitasks weighted gradient projection method part is used to handle the secondary objectives with the weight factors and priorities decided by the fuzzy logic part. Moreover, a new secondary objective is proposed to optimize underwater vehicle–manipulator system’s attitude, which takes the payload into consideration. Finally, the effectiveness of the proposed redundancy resolution is verified through some comparative simulations.
Introduction
In recent few decades, underwater vehicle–manipulator systems (UVMS) have been widely used in the underwater working applications due to their good capabilities in the deep ocean, especially the area where human driver can hardly arrive. 1 –3 Generally speaking, the UVMS consists of an underwater vehicle and one or more manipulators. However, the most popular type of UVMS nowadays is still the remotely operated vehicle–manipulator system (ROVMS), which means at least one human pilot is required. Usually, the ROV and corresponding manipulator are controlled separately by the pilot during the tasks, or the ROV keeps station automatically while only the manipulator is manually controlled. This operation mode is simple but sometimes inefficient because the inherent redundancy of UVMS is totally eliminated.
To solve the abovementioned problem and improve the working efficient of UVMS, the position and orientation of UVMS’s end-effector can be directly commanded to perform the tasks. This operation mode can effectively exploit the redundancy of UVMS and lead to more flexible working ability. Therefore, the redundancy resolution problem had been widely studied to properly adopt the abovementioned mode since the UVMS usually has more than six degree of freedoms (DOFs). After the redundancy resolution problem is properly handled, advanced control methods 4 –10 can be applied to enhance the working precision.
There are mainly two methods for the redundancy resolution of UVMS, namely pseudoinverse of the Jacobian matrix method and gradient projection method (GPM). The first one, proposed by Whitney in 1969, 11 is focused on the minimum norm solution on the speed level. The later one, proposed by Liegeois in 1977, 12 is developed to utilize the null-space joint speed for the secondary tasks. Since then many redundancy resolutions had been proposed and investigated based on these two methods, 13,14 To avoid both the kinematic and algorithmic singularities with traditional task-priority redundancy resolution for the manipulators, the singularity-robust algorithm was merged with task-priority redundancy resolution. 15 Afterward, a task-priority redundancy resolution was specially proposed for the UVMS based on this method. To handle the different dynamic characteristic of underwater vehicle and manipulator, two novel fuzzy logic (FL)-based task priority redundancy resolutions were proposed. 16,17 The FL was adopted to properly distribute the motion between the underwater vehicle and manipulator and calculate the weight coefficients for all the secondary tasks. To minimize the hydrodynamic force/moment acting on the UVMS, a new redundancy resolution for the UVMS was given and investigated. 18 The method was constructed on the acceleration level to conveniently combine the dynamic controller. A novel FL-based fault-tolerant redundancy resolution was proposed and investigated for the UVMS to handle the fault joints of the manipulator. 19 To reduce the required force/moment during a task, a novel redundancy resolution based on the generalized velocity components was proposed and investigated. 20
Exciting results had been obtained nowadays concerning the redundancy resolution for UVMS. However, few works had taken the payload into consideration. The attitude of UVMS can be greatly affected if the payload is relatively large and no proper redundancy resolution is adopted. To solve this problem, a novel redundancy resolution using a new designed secondary objective is proposed and investigated in this article. The proposed method combines the FL with multitasks weighted GPM and can effectively ensure the attitude of UVMS stable with the new proposed secondary objective.
The contributions we try to make in this article are to
give a new UVMS attitude optimization index design, which takes the payload into consideration;
propose a new multitasks weighted GPM with FL using the newly given index and verify its effectiveness through three comparative simulations.
The remainder of this work is organized as follows. In section “Kinematic modeling,” the kinematic model of UVMS is briefly introduced. In section “Proposed redundancy resolution,” the proposed method is given. In section “Simulation studies,” some comparative simulations are performed to verify the effectiveness of our proposed method. Final section concludes this work.
Kinematic modeling
The simplified kinematic model of an UVMS containing a 6-DOFs underwater vehicle and an n-DOFs underwater manipulator for an m-dimensional task, as shown in Figure 1, can be expressed as 20
where
where s·= sin(·), c·= cos(·), and t·= tan(·). And

Definition of the coordinate frames for an UVMS. UVMS: underwater vehicle–manipulator system.
Equation (1) can be further expressed as
where Jvm is the UVMS Jacobian matrix and
Proposed redundancy resolution
Redundancy resolution
In this subsection, some redundancy resolutions are reviewed, and then our new redundancy resolution will be proposed in the following subsection. The basic way to obtain a redundancy resolution for the UVMS is to adopt the pseudoinverse of the Jacobian matrix as 21
where
This is a redundancy resolution in the least-square sense aiming to minimize the velocity of UVMS. It treats the underwater vehicle/manipulator equally without any difference, which is not suitable for practical applications since the dynamics characteristic of the vehicle and manipulator is quite different. Usually, the vehicle is much larger and heavier than the manipulator. Moreover, the propellers of vehicle have large time constants, while the joint motors of a manipulator have relatively smaller time constants. All the abovementioned elements will result in quite different dynamics between the vehicle and manipulator: the vehicle is suitable for slow and large amplitude motion, while the manipulator is suitable for fast and small amplitude motion. Furthermore, no other constraints can be handled with this method.
By minimizing a cost function ξT ξ, a general solution for equation (5) can be obtained as
where χ ∈ R6+n is an arbitrary UVMS velocity vector and
The widely used GPM is based on the selection of χ which is relative to the gradient of a scalar objective function H(q) as
Combining equations (7) and (8), the GPM can be expressed as
where λ is a factor. When λ is positive, equation (9) gives the minimization of H(q). Otherwise, equation (9) gives the maximization of H(q).
The multiple objectives version of GPM can be expressed as
where k is the quantity of the kinematic constraints and αi is the weight factor that decides the importance of the ith kinematic constraint. ∇hi(q) is the normalized gradient of H(q) which is used to prevent a certain single kinematic constraint from dominating the whole part of
Moreover, if some particular DOF in UVMS needs to be handled, the above method will fail. In this situation, a weighted pseudoinverse
where
Combining equations (3) and (9), we have
The optimal effect of weighted pseudoinverse method equation (13) is weaker compared with GPM, but it has an attractive nature as the end-effector stops moving, the internal movement of UVMS will vanish. This is very important for precise tracking control.
Motion objectives
In this subsection, some motion objectives are presented and analyzed based on the characteristic of our developed UVMS, shown in Figure 1.
Motion distribution
The underwater vehicle and manipulator are suitable for different tasks due to their different dynamic properties. Underwater manipulator has relatively smaller inertia, faster response, and higher precision. These properties make it suitable for tasks that frequently change over time and only need small range of motion. Underwater vehicle, on the other hand, has relatively larger inertia, slower response, and lower precision, which are, nevertheless, suitable for tasks that slowly change over time and need a wide range of motion. Therefore, it is better to use the underwater manipulator when the targets are in its dexterous work space. This can be realized using the method of weighted pseudoinverse with the motion distribution matrix as 21
where 0 ≤ β ≤ 1, and it basically decides the motion distribution between underwater vehicle and manipulator. The system is attempted to use underwater manipulator when β is relatively large, otherwise the underwater vehicle will be used. Specially, only underwater vehicle or manipulator will be used when β = 0 or β = 1. wmax is a constant parameter used to define the maximum value of the weight factor for the underwater vehicle. It has a range of 0 < wmax ≤ 1.
Manipulator joint limitation
Manipulator joint limitation is necessary to avoid collision and damage to the hardware. The abovementioned GPM is used to handle this object, and the corresponding H(q) can be expressed as 19,22
where qi is the angular value for the ith joint, while qi, min, qi, max stand for the lower and upper bounds of the displacement, respectively. Ci is a positive constant used to determine the strength of the corresponding constraint. Moreover, the gradient of H(q) can be calculated as
Define the weight matrix as w −1 = diag(w 1, w 2,…, wn ) for the manipulator, the corresponding elements can be selected as
According to equations (16) and (17), wi = 1 when the underwater manipulator is in the middle of its motion range. Therefore, we have wi ∈ (0, 1].
Manipulator singularity avoidance
When the underwater manipulator is in a singular configuration, the required driven force for some particular joints will increase sharply which may damage corresponding actuators. Thus, the measure of manipulability (MOM) proposed by Yoshikawa 23 will be adopted to quantize the singularity and help to avoid this situation
where
Optimize UVMS’s attitude
Since our underwater vehicle has no ability to control the pitch and roll direction, it is better to keep the UVMS stable with small pitch and roll angles. The UVMS itself has been balanced with the manipulator in the original position. However, when the manipulator stretches out with a relatively large payload, the resulting moment will greatly affect the attitude of UVMS. Therefore, the payload should be taken into consideration besides the own weight of the manipulator. The gravity and buoyancy of manipulator and payload are along z-axis, so the new proposed objective function M(q) is designed in x–y plane as
where F stands for the force acting on the end-effector,
Remark 1
F can be obtained directly through sensors or indirectly by observer algorithms, but the way to get F will not be taken into consideration in this work.
Proposed redundancy resolution
In order to handle all the abovementioned secondary objectives harmonically, we adopt a multitask weighted GPM–based fuzzy logical algorithm combining equations (7)–(13) as
where
Simulation studies
In order to illustrate the effectiveness of our proposed redundancy resolution and objective function M(q), comparative numerical simulations have been performed based on the UVMS developed in our laboratory, as shown in Figure 1.
Simulation setup
Our developed UVMS has nine DOFs, four for the underwater vehicle without the ability to control pitch and roll and five for the underwater manipulator. Corresponding Denavit–Hartenberg (D-H) parameters for the underwater manipulator are listed in Table 1. The fuzzy logical algorithm adopted in this work is the same with the one given in the study by Soylu et al. 19 , and it is mainly responsible for the manipulator singularity avoidance and UVMS’s attitude optimization. Therefore, the final redundancy resolution used in the following simulations is
where α1 is positive and is for manipulator singularity avoidance, α2 is positive and is for the UVMS’s attitude optimization. The negative sign before α2 means that this GPM part tried to reduce the corresponding objective function. And ∇H1 is given in equation (19) while ∇H2 is given in equation (21). The initial position of UVMS is set to η = [0,0,0,0]m/°, q = [0,−45,90,45,0]°, and the corresponding position of the end-effector is x
E = [0.5907,0.053,−0.363] expressed in the base coordinate frame Σ0. The limitation of each joints is set as
D–H parameters of our underwater manipulator.
Simulation results
Three cases had been performed. In the first case, the F is set to 0 which means no payload is attached to the manipulator, and the proposed redundancy resolution equation (23) is adopted. In the second case, redundancy resolution equation (6) is adopted. In the third case, the F is set to 50% of the maximum capability of the manipulator, and the proposed redundancy resolution equation (23) is adopted. The end-effector is expected to go forward to the position of 1.2 m along x in 12 s. Then, it will stop for 9 s and go back to the position of −0.5 m with 22 s. Corresponding trajectory will be obtained using the fifth-order polynomial. During this procedure, its position in y- and z-axes remains unchanged.
Corresponding results are given in Figures 2 to 7. As shown in the subfigures (a) and (b) from Figures 3, 5, and 7, the actual trajectories of the end-effector are coincided with the desired ones, which means the end-effector can effectively track the desired trajectory under all three cases. Moreover, it can be observed from the simulation results of case one that the underwater vehicle almost keeps still from 0 s to 8 s, this is because in this period, the manipulator is still in its dexterous working space as shown in Figure 3(a) to (d) and (g), therefore, the weight factor β is relatively bigger, while α1 is relatively smaller as shown in Figure 3(h). Around 10 s, the manipulator moves near its singular configuration, as shown in Figure 3(g), leading to the sharp decrease of MOM. Then, the weight factor β decreases while α1 increases, leading to the movement of the underwater vehicle. Similar analysis procedure can be used for the left part of the simulation result (Figure 3).

The configuration of the UVMS during case one. UVMS: underwater vehicle–manipulator system.

Simulation results under case one. (a) and (b) are the desired trajectory and velocity (solid) versus planned ones (dashed) of the end-effector; (c) and (d) are the planned trajectory for nine DOFs; (e) and (f) are the planned velocity for nine DOFs; (g) is the normalized MOM; and (h) is the output of the fuzzy algorithm α1, β. DOF: degree of freedom; MOM: measure of manipulability.

The configuration of the UVMS in a different moment during case two. UVMS: underwater vehicle–manipulator system.

Simulation results under case two. (a) and (b) are the desired trajectory and velocity (solid) versus planned ones (dashed) of the end-effector; (c) and (d) are the planned trajectory for nine DOFs; and (e) and (f) are the planned velocity for nine DOFs. DOF: degree of freedom.

The configuration of the UVMS in a different moment during case three. UVMS: underwater vehicle–manipulator system.

Simulation results under case three. (a) and (b) are the desired trajectory and velocity (solid) versus planned ones (dashed) of the end-effector; (c) and (d) are the planned trajectory for nine DOFs; (e) and (f) are the planned velocity for nine DOFs; (g) is the normalized MOM and moment acting on the underwater vehicle due to F; and (h) is the output of the fuzzy algorithm α1, α2, β. DOF: degree of freedom; MOM: measure of manipulability.
It can be seen from the simulation results of case two that redundancy resolution equation (6) treats the underwater vehicle and manipulator equally without any difference, which, however, is not suitable for practical applications due to the big dynamic difference between the underwater vehicle and manipulator. The underwater vehicle starts to move in the very beginning of the simulation despite the fact that the manipulator is still in its dexterous working space as shown in Figure 5(a) and (c), this may lead to bad control performance. Considering the large mass and low tracking precision of underwater vehicle, this is not good for high-performance tracking control of the end-effector. Furthermore, it can be seen from Figure 5(d) that joint 3 has exceeded the limitation, which clearly shows that redundancy resolution equation (6) has no ability to handle the objective of manipulator joint limitation, which, however, may result in hardware damage.
Comparing the simulation results of case one with case three, it can be clearly observed that our proposed method with the new objective function equations (20) and (21) will limit the movement of the manipulator when the payload is attached as shown in Figure 6(c) and (d). This will greatly reduce the resulting moment and keep the underwater vehicle stable with small pitch and roll angles, which is useful to obtain good control performance since our UVMS has no ability to actively control the pitch and roll angles.
On the other hand, no experimental results had been given in this work limited by practical conditions. But it can be reasonably speculated that our proposed control method may work well in the practical applications. However, some differences compared with the simulation results may appear. Firstly, the trajectories of all signals will become noisy, this is unavoidable due to the existence of measurement noise. Secondly, the vehicle may generate motion all the time. Theoretically, the vehicle should not move when the manipulator is still in its dexterous working space as the simulation results display. In practical situations, the vehicle floats in the water and can be easily disturbed by remaining gravity and external force. Therefore, it will always move since motion controllers are usually based on tracking errors. On the other hand, the motion of vehicle will be suppressed in a certain extent benefiting from our proposed redundancy resolution when the manipulator is in its dexterous working space. Generally speaking, our proposed control method may present some difference with the simulation results, but it will be basically the same.
In conclusion, our proposed redundancy resolution with the new proposed objective function can effectively handle all kinds of secondary objectives and keep the UVMS stable with small pitch and roll angles even under the condition that the manipulator is attached with a large payload, which is very necessary to obtain satisfactory task space tracking control of our UVMS because it has no ability to actively control the pitch and roll angles.
Conclusions
In this article, a new redundancy resolution for UVMS has been proposed and investigated which takes the payload into consideration. Benefiting from the new proposed objective function, the proposed redundancy resolution can effectively keep the UVMS stable with small pitch and roll angles while ensures other secondary objectives. This kind of results is very helpful during the working process. Comparative simulations under three different situations have been conducted, and the corresponding results show that our proposed redundancy can excellently fulfill the task meanwhile ensure a better performance over the traditional method.
Footnotes
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.
Funding
The author(s) disclosed receipt of the following financial support for the research, authorship, and/or publication of this article: This work was funded by the National Natural Science Foundation of China (51575283, 51575256) , the Natural Science Foundation of Jiangsu Province (BK20170789), and the Open Foundation of the State Key Laboratory of Fluid Power and Mechatronic Systems (GZKF-201606).
