Sage Journals: Discover world-class research

Abstract

A whole resolved motion rate control algorithm designed for mobile dual-arm redundant robots is presented in this article. Based on this algorithm, the end-effector movements of the dual arms of the mobile dual-arm redundant robot can be decomposed into the movements of the two driving wheels of the differential driving platform and the movements of the dual-arm each joint of this robot harmoniously. The influence of the redundancies of the single- and dual-arm robots on the operation based on the fixed- and differential-driving platforms, which are then based on the whole resolved motion rate control algorithm, is studied after building their motion models. Some comparisons are made to show the advantages of this algorithm on the entire modeling of the complicated robotic system and the influences of the redundancy. First, the comparison of the simulation results between the fixed single-arm robot and the mobile single-arm robot is presented. Second, a comparison of the simulation results between the mobile single-arm robot and the mobile dual-arm robots is shown. Compared with the mobile single-arm robot and the fixed dual-arm robot based on this algorithm, the mobile dual-arm robot has more redundancy and can simultaneously track and operate different objects. Moreover, the mobile dual-arm redundant robot has better smoothness, more flexibility, larger operational space, and more harmonious cooperation between the two arms and the differential driving platform during the entire mobile operational process.

Keywords

Mobile dual-arm robot whole resolved motion rate control redundancy mobile operation inverse generalized Jacobian matrix

Introduction

In recent years, the research direction of the mobile single-arm redundant robot and the mobile dual-arm redundant robot has been paid an increasing amount of attention.

First, the mobile single-arm robot was studied. Specifically, single-arm operation was studied without considering platform control.^1
–3 Kai Liu and Frank L Lewis considered the arm and robot platform, respectively.⁴ Some scholars only examined the fixed industrial manipulator.⁵ Changan Liu and Hong Zhou⁶ did not prove the superiority of the mobile manipulator compared with the 2-D fixed manipulator of the resolved motion rate control. An optimization rule function to solve the problem of the time-consuming computing method of the redundancy degree of freedom (DOF) was proposed in references.^7,8 In addition, the resolved motion rate control algorithm of the mobile arm end movement, which can be decomposed into each joint movement by inverse kinematics equations and can significantly simplify the request of movement operation sequence for the accomplishment of a specific task, was suggested in reference.⁹ However, the mobile single-arm redundant robot cannot fulfill real-life requirements.

Second, academic works on the mobile dual-arm redundant robot were paid much attention. Based on the analysis of the motion relation of the mobile dual-arm robot, the kinematics model, which integrates the geometry method and the analytical method, was used in a special humanoid dual-arm robot. According to the positive solutions and the inverse solutions on the kinematics of the humanoid dual arm, the transformation matrix between the mobile robot and the arm was simultaneously given.¹⁰ Moreover, a manipulation planning method for both arms of a virtual human was proposed for product assembly and maintenance motion simulation under a complex virtual environment; this method was based on a goal-oriented heuristic rapidly exploring random tree (RRT) algorithm with dual balance expansion and combined with the rapid arm inverse kinematical method.¹¹ The trajectory planning for the dual-arm robot and the adopted dual-arm J⁺-RRT to grasp a plate without an inverse kinematical equation was studied.¹² Zhang and Ouyang¹³ focused on the path planning of a dual-robot-coordinated couple motion and proposed replacing the tool coordinate system of the slave robot for offline slave robot path generation. In consideration of parameter variation and load disturbance, the obstacle avoidance of the fixed manipulator based on the resolved motion rate control (RMRC) and the construction of appropriate obstacle avoidance potential functions with the calculation method of obstacles were studied to improve the links and simplify the obstacle avoidance constraints.¹⁴ Moreover, the simulation of the robot tracking different trajectories and avoiding static and dynamic obstacles in the operational space proved the efficiency of this method. However, these studies lack information on the entire modeling of the mobile dual-arm redundant robot and on the redundancy comparisons.

Considering the drawbacks of the previous studies, we propose a whole RMRC (wRMRC) algorithm that can decompose the end-effector movements of the dual arms of the mobile dual-arm redundant robot into the movements of the two wheels of the differential driving platform and the movements of each joint of the dual arm. The advantages of this method are as follows. (1) The entire modeling of the differential driving platform and the fixed dual-arm robot based on the wRMRC algorithm with the generalized Jacobian matrix (GJM) makes the motion planning of the mobile dual-arm redundant robot easier and simpler. (2) This method can be easily realized by currently available fixed dual-arm robots and differential driving platforms. (3) This method intuitively shows the advantages of the mobile dual-arm redundant robot over the mobile single-arm redundant robot and the fixed dual-arm redundant robot in expanding the operational space, enhancing the coordination operation function and improving flexibility.

The remainder of this article is organized as follows. Section “Building an entire model on the mobile dual-arm redundant robot” introduces how to build a whole model on the differential driving platform and the dual arm in stages using RMRC. The specific realization of the wRMRC algorithm of the mobile dual-arm robot is given in section “Realization of the wRMRC algorithm”. The simulations are summarized in section “Simulations and results”. The conclusions and discussions are presented in section “Conclusions and discussion”.

Building an entire model on the mobile dual-arm redundant robot

Motion model of the differential driving platform

The differential driving platform, as shown in Figure 1(a), is produced by the Sichuan HangFa Company (Chengdou, China). Its motion model is presented in Figure 1(b).

Figure 1.

(a) Differential driving platform; (b) motion model of the differential driving platform.

The transformation from ${\dot{θ}}_{w} = {[\begin{matrix} {\dot{θ}}_{r} & {\dot{θ}}_{l} \end{matrix}]}^{T}$ to ${\dot{P}}_{platform} = {[\begin{matrix} \dot{X} & \dot{Y} & \dot{φ} \end{matrix}]}^{T}$ can be described by a homogenous matrix defined as follows

{\dot{P}}_{platform} = J_{platform} {\dot{θ}}_{w}

where $\dot{X}$ and $\dot{Y}$ are the velocities of the differential driving platform; $\dot{φ}$ is the angular velocity of this platform; ${\dot{θ}}_{l}$ and ${\dot{θ}}_{r}$ are the left-wheel and right-wheel rotary angular velocities of this platform, respectively; $J_{platform} = [\begin{matrix} rcosφ / 2 & rcosφ / 2 \\ r sin φ / 2 & r sin φ / 2 \\ r / 2 b & - r / 2 b \end{matrix}]$ is the GJM of this platform; r is the radius of two driving wheels; O is the instantaneous center point of the velocity; and $P_{0}$ is the center point of the axis of two driving wheels.

Motion model of the fixed single-arm robot

The motion model of the fixed single-arm robot is shown in Figure 2, where $P_{s}$ is the fixed intersection point of the first link and the fixed platform, and its coordinates are $(0, 0, 0)$ ; $P_{e}$ is the end effector of the fixed single-arm robot, and its coordinates are $(x_{e}, y_{e}, z_{e})$ ; $l_{i} (i = 1, \dots, 4)$ is the length of the ith link; and $θ_{i} (i = 1, \dots, 4)$ is the ith joint angle.

Figure 2.

Motion model of the fixed single-arm robot.

The end-effector velocity of the fixed single-arm robot is calculated by

{\dot{x}}_{e} = - [l_{2} sin θ_{2} + l_{3} sin (θ_{2} + θ_{3}) + l_{4} sin (θ_{2} + θ_{3} + θ_{4})] {\dot{θ}}_{1} sin θ_{1} + [l_{2} \cos θ_{2} + l_{3} \cos (θ_{2} + θ_{3}) + l_{4} \cos (θ_{2} + θ_{3} + θ_{4})] {\dot{θ}}_{2} \cos θ_{1} + [l_{3} \cos (θ_{2} + θ_{3}) + l_{4} \cos (θ_{2} + θ_{3} + θ_{4})] {\dot{θ}}_{3} \cos θ_{1} + [l_{4} \cos (θ_{2} + θ_{3} + θ_{4})] {\dot{θ}}_{4} \cos θ_{1}

{\dot{y}}_{e} = [l_{2} sin θ_{2} + l_{3} sin (θ_{2} + θ_{3}) + l_{4} sin (θ_{2} + θ_{3} + θ_{4})] {\dot{θ}}_{1} \cos θ_{1} + [l_{2} \cos θ_{2} + l_{3} \cos (θ_{2} + θ_{3}) + l_{4} \cos (θ_{2} + θ_{3} + θ_{4})] {\dot{θ}}_{2} sin θ_{1} + [l_{3} \cos (θ_{2} + θ_{3}) + l_{4} \cos (θ_{2} + θ_{3} + θ_{4})] {\dot{θ}}_{3} sin θ_{1} + [l_{4} \cos (θ_{2} + θ_{3} + θ_{4})] {\dot{θ}}_{4} sin θ_{1}

\begin{array}{l} {\dot{z}}_{e} = - [l_{2} sin θ_{2} + l_{3} sin (θ_{2} + θ_{3}) + l_{4} sin (θ_{2} + θ_{3} + θ_{4})] {\dot{θ}}_{2} \\ - [l_{3} sin (θ_{2} + θ_{3}) + l_{4} sin (θ_{2} + θ_{3} + θ_{4})] {\dot{θ}}_{3} \\ - [l_{4} sin (θ_{2} + θ_{3} + θ_{4})] {\dot{θ}}_{4} \end{array}

The transformation from ${\dot{θ}}_{s} = {[\begin{matrix} {\dot{θ}}_{1} & {\dot{θ}}_{2} & {\dot{θ}}_{3} & {\dot{θ}}_{4} \end{matrix}]}^{T}$ to ${\dot{P}}_{e_s} = {[\begin{matrix} {\dot{x}}_{e} & {\dot{y}}_{e} & {\dot{z}}_{e} \end{matrix}]}^{T}$ can be described by the following homogenous transformation matrix

[\begin{matrix} {\dot{x}}_{e} \\ {\dot{y}}_{e} \\ {\dot{z}}_{e} \end{matrix}] = [\begin{matrix} J_{11} & J_{12} & J_{13} & J_{14} \\ J_{21} & J_{22} & J_{23} & J_{24} \\ J_{31} & J_{32} & J_{33} & J_{34} \end{matrix}] [\begin{matrix} {\dot{θ}}_{1} \\ {\dot{θ}}_{2} \\ {\dot{θ}}_{3} \\ {\dot{θ}}_{4} \end{matrix}]

\Rightarrow {\dot{P}}_{e_s} = J_{s_f} {\dot{θ}}_{s}

where ${\dot{P}}_{e_s}$ is a $(3 \times 1)$ vector that denotes the velocity of the end effector; ${\dot{θ}}_{s}$ is a $(4 \times 1)$ vector that denotes the angular velocity of four joints of the fixed single-arm robot; and $J_{s_f}$ is the GJM of the robot.

Motion model of the mobile single-arm redundant robot

The motion model of the mobile single-arm robot is shown in Figure 3, where $P_{s}$ is the fixed intersection point of the first link and the differential driving platform, and its coordinates are $(x_{s}, y_{s}, 0)$ . The coordinate $P_{0}$ can be uniquely decided by φ and d together with $P_{s}$ , and its coordinates are $(x_{o}, y_{o}, 0)$ . d is the distance between $P_{0}$ and $P_{s}$ .

Figure 3.

Motion model of the mobile single-arm redundant robot.

The end-effector velocity of the mobile single-arm robot is calculated by

{\dot{x}}_{e} = {\dot{x}}_{s} - [l_{2} sin θ_{2} + l_{3} sin (θ_{2} + θ_{3}) + l_{4} sin (θ_{2} + θ_{3} + θ_{4})] sin (\dot{φ} + {\dot{θ}}_{1}) (\dot{φ} + {\dot{θ}}_{1}) + [l_{2} \cos θ_{2} + l_{3} \cos (θ_{2} + θ_{3}) + l_{4} \cos (θ_{2} + θ_{3} + θ_{4})] \cos (φ + θ_{1}) {\dot{θ}}_{2} + [l_{3} \cos (θ_{2} + θ_{3}) + l_{4} \cos (θ_{2} + θ_{3} + θ_{4})] \cos (φ + θ_{1}) {\dot{θ}}_{3} + [l_{4} \cos (θ_{2} + θ_{3} + θ_{4})] \cos (φ + θ_{1}) {\dot{θ}}_{4}

{\dot{y}}_{e} = {\dot{y}}_{s} + [l_{2} sin θ_{2} + l_{3} sin (θ_{2} + θ_{3}) + l_{4} sin (θ_{2} + θ_{3} + θ_{4})] \cos (φ + θ_{1}) (\dot{φ} + {\dot{θ}}_{1}) + [l_{2} \cos θ_{2} + l_{3} \cos (θ_{2} + θ_{3}) + l_{4} \cos (θ_{2} + θ_{3} + θ_{4})] sin (φ + θ_{1}) {\dot{θ}}_{2} + [l_{3} \cos (θ_{2} + θ_{3}) + l_{4} \cos (θ_{2} + θ_{3} + θ_{4})] sin (φ + θ_{1}) {\dot{θ}}_{3} + [l_{4} \cos (θ_{2} + θ_{3} + θ_{4})] sin (φ + θ_{1}) {\dot{θ}}_{4}

\begin{array}{l} {\dot{z}}_{e} = - [l_{2} sin θ_{2} + l_{3} sin (θ_{2} + θ_{3}) + l_{4} sin (θ_{2} + θ_{3} + θ_{4})] {\dot{θ}}_{2} \\ - [l_{3} sin (θ_{2} + θ_{3}) + l_{4} sin (θ_{2} + θ_{3} + θ_{4})] {\dot{θ}}_{3} \\ - [l_{4} sin (θ_{2} + θ_{3} + θ_{4})] {\dot{θ}}_{4} \end{array}

The transformation from ${\dot{θ}}_{s_m} = {[\begin{matrix} (\dot{φ} + {\dot{θ}}_{1}) & {\dot{θ}}_{2} & {\dot{θ}}_{3} & {\dot{θ}}_{4} \end{matrix}]}^{T}$ to ${\dot{P}}_{e_s}$ can be described by the following homogenous transformation matrix

[\begin{matrix} {\dot{x}}_{e} \\ {\dot{y}}_{e} \\ {\dot{z}}_{e} \end{matrix}] = [\begin{matrix} {\dot{x}}_{s} \\ {\dot{y}}_{s} \\ 0 \end{matrix}] + [\begin{matrix} cos φ & - sin φ & 0 \\ sin φ & cos φ & 0 \\ 0 & 0 & 1 \end{matrix}] [\begin{matrix} J_{11} & J_{12} & J_{13} & J_{14} \\ J_{21} & J_{22} & J_{23} & J_{24} \\ J_{31} & J_{32} & J_{33} & J_{34} \end{matrix}] [\begin{matrix} \dot{φ} + {\dot{θ}}_{1} \\ {\dot{θ}}_{2} \\ {\dot{θ}}_{3} \\ {\dot{θ}}_{4} \end{matrix}]

\Rightarrow {\dot{P}}_{e_s} = {\dot{P}}_{s} + R_{s_f} J_{s_f} {\dot{θ}}_{s_m}

where ${\dot{θ}}_{s_m}$ is a $(4 \times 1)$ vector; $R_{s_f}$ is a nonconstant matrix related to φ for simplicity sake of the GJM of the mobile single-arm robot; $J_{s_f}$ is the $(3 \times 4)$ simplified GJM of the robot; and ${\dot{P}}_{s} = {[\begin{matrix} {\dot{x}}_{s} & {\dot{y}}_{s} & 0 \end{matrix}]}^{T}$ is a $(3 \times 1)$ vector that denotes the velocity of the point $P_{s}$ .

The motion model of the mobile single-arm redundant robot can be derived by equations (11) and (1)

[\begin{matrix} {\dot{x}}_{s} \\ {\dot{y}}_{s} \\ {\dot{x}}_{e} \\ {\dot{y}}_{e} \\ {\dot{z}}_{e} \end{matrix}] = [\begin{matrix} cos φ & - sin φ & 0 & 0 & 0 \\ sin φ & cos φ & 0 & 0 & 0 \\ 0 & 0 & cos φ & - sin φ & 0 \\ 0 & 0 & sin φ & cos φ & 0 \\ 0 & 0 & 0 & 0 & 1 \end{matrix}] [\begin{matrix} \frac{r}{2} & \frac{r}{2} & 0 & 0 & 0 & 0 \\ - \frac{d \cdot r}{2 b} & \frac{d \cdot r}{2 b} & 0 & 0 & 0 & 0 \\ \frac{r}{2} - \frac{r}{2 b} J_{11} & \frac{r}{2} + \frac{r}{2 b} J_{11} & J_{11} & J_{12} & J_{13} & J_{14} \\ - \frac{d + J_{21}}{2 b} r & \frac{d + J_{21}}{2 b} r & J_{21} & J_{22} & J_{23} & J_{24} \\ - \frac{r}{2 b} J_{31} & \frac{r}{2 b} J_{31} & J_{31} & J_{32} & J_{33} & J_{34} \end{matrix}] [\begin{matrix} {\dot{θ}}_{l} \\ {\dot{θ}}_{r} \\ {\dot{θ}}_{1} \\ {\dot{θ}}_{2} \\ {\dot{θ}}_{3} \\ {\dot{θ}}_{4} \end{matrix}]

\Rightarrow {\dot{P}}_{e_s}^{'} = R_{s_m} J_{s_m} {\dot{θ}}_{s_m}^{'}

where ${\dot{P}}_{e_s}^{'} = [\begin{matrix} {\dot{P}}_{s}^{' T} & {\dot{P}}_{e_s}^{T} \end{matrix}]^{T}$ is the $(5 \times 1)$ vector (for simplicity, the z value of $P_{s}$ is omitted, i.e. ${\dot{P}}_{s}^{'} = {[\begin{matrix} {\dot{x}}_{s} & {\dot{y}}_{s} \end{matrix}]}^{T}$ ); ${\dot{θ}}_{s_m}^{'} = {[\begin{matrix} {\dot{θ}}^{T}_{w} & {\dot{θ}}^{T}_{s} \end{matrix}]}^{T}$ is the $(6 \times 1)$ vector; $R_{s_m}$ is a $(5 \times 5)$ nonconstant matrix related to φ for simplicity sake of the GJM of the mobile single-arm robot; and $J_{s_m}$ is the $(5 \times 6)$ simplified GJM of the robot.

Unlike in equation (5), the number of the DOF increases from four to six because of the addition of the differential driving platform based on the fixed single-arm robot, as shown in equation (13). The end-effector velocity of this robot is also associated with the angular velocities of the two driving wheels of the platform.

Motion model of the fixed dual-arm redundant robot

The fixed dual-arm robot with seven DOF per arm produced by the Rethink Company is a flexible research platform. Its software is based on the ROS framework for seamless integration across platforms, and it has various sensors, including a 360° sonar and a front camera for custom sensing applications, torque, position, and velocity sensing on each joint. The front cameras on the head are integrated with the one on each wrist for visualizing the end-effector interactions and the end-effector specification for designing custom intelligent hands. To improve the entire performance of the mobile dual-arm robot, we plan to install a binocular vision system and a laser sensor, which are both used for distance measuring and environment modeling. As the seventh joint of this robot is rotary, an entire motion model of the fixed dual-arm robot with six DOF per arm is built with the seventh joint omitted, as shown in Figure 4(a), where the definition of $P_{s}$ is the same as the previous definition of the fixed single-arm robot in section “Motion model of the fixed single-arm robot”; $P_{e}$ and $P_{e}^{'}$ are the left-arm and the right-arm end effectors of the fixed dual-arm robot and their robotic coordinates are $(x_{e}, y_{e}, z_{e})$ and $(x_{e}^{'}, y_{e}^{'}, z_{e}^{'})$ , respectively; $l_{i} (i = 1, \dots, 4)$ is the left-arm and the right-arm length of the ith link; and $θ_{i}$ and ${θ'}_{i} (i = 1, \dots, 7)$ are the left-arm and the right-arm ith joint angle of the robot, respectively. The motions of the first, third, fifth, and seventh joints are the rotary motion, and the motions of the second, fourth, and sixth joints are the revolute motion.

Figure 4.

(a) The fixed dual-arm robot with seven DOF per arm; (b) motion model of the fixed dual-arm robot. DOF: degree of freedom.

The left-arm end-effector velocity of the fixed dual-arm robot is calculated by

\begin{array}{l} {\dot{x}}_{e} = [l_{2} sin θ_{2} cos θ_{1} + l_{3} cos (θ_{1} + θ_{3}) sin (θ_{2} + θ_{4}) + l_{4} cos (θ_{1} + θ_{3} + θ_{5}) sin (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{1} ​ \\ + [l_{2} cos θ_{2} sin θ_{1} + l_{3} sin (θ_{1} + θ_{3}) cos (θ_{2} + θ_{4}) + l_{4} sin (θ_{1} + θ_{3} + θ_{5}) cos (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{2} \\ + [l_{3} cos (θ_{1} + θ_{3}) sin (θ_{2} + θ_{4}) + l_{4} cos (θ_{1} + θ_{3} + θ_{5}) sin (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{3} \\ + [l_{3} sin (θ_{1} + θ_{3}) cos (θ_{2} + θ_{4}) + l_{4} sin (θ_{1} + θ_{3} + θ_{5}) cos (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{4} \\ + l_{4} cos (θ_{1} + θ_{3} + θ_{5}) sin (θ_{2} + θ_{4} + θ_{6}) {\dot{θ}}_{5} + l_{4} sin (θ_{1} + θ_{3} + θ_{5}) cos (θ_{2} + θ_{4} + θ_{6}) {\dot{θ}}_{6} \end{array}

\begin{array}{l} {\dot{y}}_{e} = - [l_{2} sin θ_{2} sin θ_{1} + l_{3} sin (θ_{1} + θ_{3}) sin (θ_{2} + θ_{4}) + l_{4} sin (θ_{1} + θ_{3} + θ_{5}) sin (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{1} \\ + [l_{2} cos θ_{2} cos θ_{1} + l_{3} cos (θ_{1} + θ_{3}) cos (θ_{2} + θ_{4}) + l_{4} cos (θ_{1} + θ_{3} + θ_{5}) cos (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{2} \\ - [l_{3} sin (θ_{1} + θ_{3}) sin (θ_{2} + θ_{4}) + l_{4} sin (θ_{1} + θ_{3} + θ_{5}) sin (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{3} \\ + [l_{3} cos (θ_{1} + θ_{3}) cos (θ_{2} + θ_{4}) + l_{4} cos (θ_{1} + θ_{3} + θ_{5}) cos (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{4} \\ - l_{4} sin (θ_{1} + θ_{3} + θ_{5}) sin (θ_{2} + θ_{4} + θ_{6}) {\dot{θ}}_{5} + l_{4} cos (θ_{1} + θ_{3} + θ_{5}) cos (θ_{2} + θ_{4} + θ_{6}) {\dot{θ}}_{6} \end{array}

\begin{array}{l} {\dot{z}}_{e} = - [l_{2} sin θ_{2} + l_{3} sin (θ_{2} + θ_{4}) + l_{4} sin (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{2} - [l_{3} sin (θ_{2} + θ_{4}) + l_{4} sin (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{4} \\ - l_{4} sin (θ_{2} + θ_{4} + θ_{6}) {\dot{θ}}_{6} \end{array}

As mentioned in section “Motion model of the mobile single-arm redundant robot,” the transformation from ${\dot{θ}}_{d_l} = {[\begin{matrix} {\dot{θ}}_{1} & {\dot{θ}}_{2} & \dots & {\dot{θ}}_{6} \end{matrix}]}^{T}$ to ${\dot{P}}_{e_d_l} = {[\begin{matrix} {\dot{x}}_{e} & {\dot{y}}_{e} & {\dot{z}}_{e} \end{matrix}]}^{T}$ can be described by the following homogenous transformation matrix

[\begin{matrix} {\dot{x}}_{e} \\ {\dot{y}}_{e} \\ {\dot{z}}_{e} \end{matrix}] = [\begin{matrix} J_{11} & J_{12} & J_{13} & J_{14} & J_{15} & J_{16} \\ J_{21} & J_{22} & J_{23} & J_{24} & J_{25} & J_{26} \\ J_{31} & J_{32} & J_{33} & J_{34} & J_{35} & J_{36} \end{matrix}] [\begin{matrix} {\dot{θ}}_{1} \\ {\dot{θ}}_{2} \\ {\dot{θ}}_{3} \\ {\dot{θ}}_{4} \\ {\dot{θ}}_{5} \\ {\dot{θ}}_{6} \end{matrix}]

\Rightarrow {\dot{P}}_{e_d_l} = J_{d_l_f} {\dot{θ}}_{d_l}

where ${\dot{P}}_{e_d_l}$ is the $(3 \times 1)$ vector that denotes the left-arm velocity of the fixed dual-arm robot; ${\dot{θ}}_{d_l}$ is the $(6 \times 1)$ vector that denotes the angular velocity of the six left-arm joints of this robot; and $J_{d_l_f}$ is the $(3 \times 6)$ GJM of the left arm of the robot.

Similarly, the right-arm end-effector velocity of the fixed dual-arm robot is calculated by

\begin{array}{l} {\dot{x}'}_{e} = [l_{2} sin (- {θ'}_{2}) cos (- {θ'}_{1}) + l_{3} cos (- {θ'}_{1} - {θ'}_{3}) sin (- {θ'}_{2} - {θ'}_{4}) + l_{4} cos (- {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) sin (- {θ'}_{2} - {θ'}_{4} - {θ'}_{6})] {\dot{θ}'}_{1} ​ \\ + [l_{2} cos (- {θ'}_{2}) sin (- {θ'}_{1}) + l_{3} sin (- {θ'}_{1} - {θ'}_{3}) cos (- {θ'}_{2} - {θ'}_{4}) + l_{4} sin (- {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) cos (- {θ'}_{2} - {θ'}_{4} - {θ'}_{6})] {\dot{θ}'}_{2} \\ + [l_{3} cos (- {θ'}_{1} - {θ'}_{3}) sin (- {θ'}_{2} - {θ'}_{4}) + l_{4} cos (- {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) sin (- {θ'}_{2} - {θ'}_{4} - {θ'}_{6})] {\dot{θ}'}_{3} \\ + [l_{3} sin (- {θ'}_{1} - {θ'}_{3}) cos (- {θ'}_{2} - {θ'}_{4}) + l_{4} sin (- {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) cos (- {θ'}_{2} - {θ'}_{4} - {θ'}_{6})] {\dot{θ}'}_{4} \\ + l_{4} cos (- {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) sin (- {θ'}_{2} - {θ'}_{4} - {θ'}_{6}) {\dot{θ}'}_{5} + l_{4} sin (- {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) cos (- {θ'}_{2} - {θ'}_{4} - {θ'}_{6}) {\dot{θ}'}_{6} \end{array}

\begin{array}{l} {\dot{y}'}_{e} = - [l_{2} sin (- {θ'}_{2}) sin (- {θ'}_{1}) + l_{3} sin (- {θ'}_{1} - {θ'}_{3}) sin (- {θ'}_{2} - {θ'}_{4}) + l_{4} sin (- {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) sin (- {θ'}_{2} - {θ'}_{4} - {θ'}_{6})] {\dot{θ}'}_{1} \\ + [l_{2} cos (- {θ'}_{2}) cos (- {θ'}_{1}) + l_{3} cos (- {θ'}_{1} - {θ'}_{3}) cos (- {θ'}_{2} - {θ'}_{4}) + l_{4} cos (- {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) cos (- {θ'}_{2} - {θ'}_{4} - {θ'}_{6})] {\dot{θ}'}_{2} \\ - [l_{3} sin (- {θ'}_{1} - {θ'}_{3}) sin (- {θ'}_{2} - {θ'}_{4}) + l_{4} sin (- {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) sin (- {θ'}_{2} - {θ'}_{4} - {θ'}_{6})] {\dot{θ}'}_{3} \\ + [l_{3} cos (- {θ'}_{1} - {θ'}_{3}) cos (- {θ'}_{2} - {θ'}_{4}) + l_{4} cos (- {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) cos (- {θ'}_{2} - {θ'}_{4} - {θ'}_{6})] {\dot{θ}'}_{4} \\ - l_{4} sin (- {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) sin (- {θ'}_{2} - {θ'}_{4} - {θ'}_{6}) {\dot{θ}'}_{5} + l_{4} cos (- {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) cos (- {θ'}_{2} - {θ'}_{4} - {θ'}_{6}) {\dot{θ}'}_{6} \end{array}

\begin{array}{l} {\dot{z}'}_{e} = - [l_{2} sin (- {θ'}_{2}) + l_{3} sin (- {θ'}_{2} - {θ'}_{4}) + l_{4} sin (- {θ'}_{2} - {θ'}_{4} - {θ'}_{6})] {\dot{θ}'}_{2} - [l_{3} sin (- {θ'}_{2} - {θ'}_{4}) + l_{4} sin (- {θ'}_{2} - {θ'}_{4} - {θ'}_{6})] {\dot{θ}'}_{4} \\ - l_{4} sin (- {θ'}_{2} - {θ'}_{4} - {θ'}_{6}) {\dot{θ}'}_{6} \end{array}

The transformation from ${\dot{θ}}_{d_r} = {[\begin{matrix} {\dot{θ}'}_{1} & {\dot{θ}'}_{2} & \dots & {\dot{θ}'}_{6} \end{matrix}]}^{T}$ to ${\dot{P}}_{e_d_r} = {[\begin{matrix} {\dot{x}'}_{e} & {\dot{y}'}_{e} & {\dot{z}'}_{e} \end{matrix}]}^{T}$ can be described by the following homogenous transformation matrix

[\begin{matrix} {\dot{x}'}_{e} \\ {\dot{y}'}_{e} \\ {\dot{z}'}_{e} \end{matrix}] = [\begin{matrix} {J'}_{11} & {J'}_{12} & {J'}_{13} & {J'}_{14} & {J'}_{15} & {J'}_{16} \\ {J'}_{21} & {J'}_{22} & {J'}_{23} & {J'}_{24} & {J'}_{25} & {J'}_{26} \\ {J'}_{31} & {J'}_{32} & {J'}_{33} & {J'}_{34} & {J'}_{35} & {J'}_{36} \end{matrix}] [\begin{matrix} {\dot{θ}'}_{1} \\ {\dot{θ}'}_{2} \\ {\dot{θ}'}_{3} \\ {\dot{θ}'}_{4} \\ {\dot{θ}'}_{5} \\ {\dot{θ}'}_{6} \end{matrix}]

\Rightarrow {\dot{P}}_{e_d_r} = J_{d_r_f} {\dot{θ}}_{d_r}

where ${\dot{P}}_{e_d_r}$ is the $(3 \times 1)$ vector that denotes the right-arm velocity of the fixed dual-arm robot; ${\dot{θ}}_{d_r}$ is the $(6 \times 1)$ vector that denotes the angular velocity of the six right-arm joints of the robot; and $J_{d_r_f}$ is the $(3 \times 6)$ GJM of the right arm of the robot.

Motion model of the mobile dual-arm redundant robot

The combination of the motion model of the differential driving platform, which is shown in Figure 1(b), with the motion model of the fixed dual-arm robot, which is shown in Figure 4(b), comprises the entire motion model of the mobile dual-arm robot, as shown in Figure 5, where the definitions of $P_{s}$ and $P_{0}$ are, respectively, the same as the previous definitions in the mobile single-arm robot in section “Motion model of the mobile single-arm redundant robot.”

Figure 5.

Motion model of the mobile dual-arm robot with seven DOF per arm. DOF: degree of freedom.

The end-effector velocity of the left arm of the mobile dual-arm robot is calculated by

\begin{array}{l} {\dot{x}}_{e} = {\dot{x}}_{s} + [W cos φ + l_{2} sin θ_{2} cos (θ_{1} + φ) + l_{3} cos (φ + θ_{1} + θ_{3}) sin (θ_{2} + θ_{4}) + l_{4} cos (φ + θ_{1} + θ_{3} + θ_{5}) sin (θ_{2} + θ_{4} + θ_{6})] \dot{φ} \\ + [r cos φ / 2 + d r sin φ / 2 / b + r J_{11} / 2 / b] {\dot{θ}}_{l} + [r cos φ / 2 - d r sin φ / 2 / b - r J_{11} / 2 / b] {\dot{θ}}_{r} ​ \\ + [l_{2} sin θ_{2} cos (θ_{1} + φ) + l_{3} cos (φ + θ_{1} + θ_{3}) sin (θ_{2} + θ_{4}) + l_{4} cos (φ + θ_{1} + θ_{3} + θ_{5}) sin (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{1} \\ + [l_{2} cos θ_{2} sin (θ_{1} + φ) + l_{3} sin (φ + θ_{1} + θ_{3}) cos (θ_{2} + θ_{4}) + l_{4} sin (φ + θ_{1} + θ_{3} + θ_{5}) cos (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{2} \\ + [l_{3} cos (φ + θ_{1} + θ_{3}) sin (θ_{2} + θ_{4}) + l_{4} cos (φ + θ_{1} + θ_{3} + θ_{5}) sin (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{3} \\ + [l_{3} sin (φ + θ_{1} + θ_{3}) cos (θ_{2} + θ_{4}) + l_{4} sin (φ + θ_{1} + θ_{3} + θ_{5}) cos (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{4} \\ + l_{4} cos (φ + θ_{1} + θ_{3} + θ_{5}) sin (θ_{2} + θ_{4} + θ_{6}) {\dot{θ}}_{5} + l_{4} sin (φ + θ_{1} + θ_{3} + θ_{5}) cos (θ_{2} + θ_{4} + θ_{6}) {\dot{θ}}_{6} \end{array}

\begin{array}{l} {\dot{y}}_{e} = {\dot{y}}_{s} - [W sin φ + l_{2} sin θ_{2} sin (φ + θ_{1}) + l_{3} sin (φ + θ_{1} + θ_{3}) sin (θ_{2} + θ_{4}) + l_{4} sin (φ + θ_{1} + θ_{3} + θ_{5}) sin (θ_{2} + θ_{4} + θ_{6})] \dot{φ} \\ + [r sin φ / 2 - d r cos φ / 2 / b + r J_{21} / 2 / b] {\dot{θ}}_{l} + [r sin φ / 2 + d r cos φ / 2 / b - r J_{21} / 2 / b] {\dot{θ}}_{r} \\ - [l_{2} sin θ_{2} sin (φ + θ_{1}) + l_{3} sin (φ + θ_{1} + θ_{3}) sin (θ_{2} + θ_{4}) + l_{4} sin (φ + θ_{1} + θ_{3} + θ_{5}) sin (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{1} \\ + [l_{2} cos θ_{2} cos (φ + θ_{1}) + l_{3} cos (φ + θ_{1} + θ_{3}) cos (θ_{2} + θ_{4}) + l_{4} cos (φ + θ_{1} + θ_{3} + θ_{5}) cos (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{2} \\ - [l_{3} sin (φ + θ_{1} + θ_{3}) sin (θ_{2} + θ_{4}) + l_{4} sin (φ + θ_{1} + θ_{3} + θ_{5}) sin (θ_{2} + θ_{4} + θ_{5})] {\dot{θ}}_{3} \\ + [l_{3} cos (φ + θ_{1} + θ_{3}) cos (θ_{2} + θ_{4}) + l_{4} cos (φ + θ_{1} + θ_{3} + θ_{5}) cos (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{4} \\ - l_{4} sin (φ + θ_{1} + θ_{3} + θ_{5}) sin (θ_{2} + θ_{4} + θ_{6}) {\dot{θ}}_{5} + l_{4} cos (φ + θ_{1} + θ_{3} + θ_{5}) cos (θ_{2} + θ_{4} + θ_{6}) {\dot{θ}}_{6} \end{array}

\begin{array}{l} {\dot{z}}_{e} = - [l_{2} sin θ_{2} + l_{3} sin (θ_{2} + θ_{4}) + l_{4} sin (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{2} - [l_{3} sin (θ_{2} + θ_{4}) + l_{4} sin (θ_{2} + θ_{4} + θ_{6})] {\dot{θ}}_{4} \\ - l_{4} sin (θ_{2} + θ_{4} + θ_{6}) {\dot{θ}}_{6} \end{array}

Similarly, the transformation from ${\dot{θ}}_{d_l_m} = {[\begin{matrix} φ & {\dot{θ}}_{d_l}^{T} \end{matrix}]}^{T}$ to ${\dot{P}}_{e_d_l} = {[\begin{matrix} {\dot{x}}_{e} & {\dot{y}}_{e} & {\dot{z}}_{e} \end{matrix}]}^{T}$ can be described by the following homogenous transformation matrix

[\begin{matrix} {\dot{x}}_{e} \\ {\dot{y}}_{e} \\ {\dot{z}}_{e} \end{matrix}] = [\begin{matrix} {\dot{x}}_{s} \\ {\dot{y}}_{y} \\ 0 \end{matrix}] + [\begin{matrix} J_{11} & J_{12} & J_{13} & J_{14} & J_{15} & J_{16} & J_{17} \\ J_{21} & J_{22} & J_{23} & J_{24} & J_{25} & J_{26} & J_{27} \\ J_{31} & J_{32} & J_{33} & J_{34} & J_{35} & J_{36} & J_{37} \end{matrix}] [\begin{matrix} \dot{φ} \\ {\dot{θ}}_{1} \\ {\dot{θ}}_{2} \\ {\dot{θ}}_{3} \\ {\dot{θ}}_{4} \\ {\dot{θ}}_{5} \\ {\dot{θ}}_{6} \end{matrix}]

\Rightarrow {\dot{P}}_{e_d_l} = {\dot{P}}_{s} + J_{d_l_m} {\dot{θ}}_{d_l_m}

where ${\dot{θ}}_{d_l_m}$ is the $(7 \times 1)$ vector; and $J_{d_l_m}$ is the GJM of the left arm of the mobile dual-arm robot.

The motion model of the left arm of the mobile dual-arm redundant robot can be derived using equations (28) and (1)

[\begin{matrix} {\dot{x}}_{s} \\ {\dot{y}}_{s} \\ {\dot{x}}_{e} \\ {\dot{y}}_{e} \\ {\dot{z}}_{e} \end{matrix}] = [\begin{matrix} cos φ & - sin φ & 0 & 0 & 0 \\ sin φ & cos φ & 0 & 0 & 0 \\ 0 & 0 & 1 & 0 & 0 \\ 0 & 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 0 & 1 \end{matrix}] [\begin{matrix} \frac{r}{2} & \frac{r}{2} & 0 & 0 & 0 & 0 & 0 & 0 \\ - \frac{d \cdot r}{2 b} & \frac{d \cdot r}{2 b} & 0 & 0 & 0 & 0 & 0 & 0 \\ \frac{r}{2} cos φ + \frac{r}{2 b} J_{11} + \frac{d r}{2 b} sin φ & \frac{r}{2} cos φ - \frac{r}{2 b} J_{11} - \frac{d r}{2 b} sin φ & J_{12} & J_{13} & J_{14} & J_{15} & J_{16} & J_{17} \\ \frac{r}{2} sin φ + \frac{r}{2 b} J_{21} - \frac{d r}{2 b} cos φ & \frac{r}{2} sin φ - \frac{r}{2 b} J_{21} + \frac{d r}{2 b} cos φ & J_{22} & J_{23} & J_{24} & J_{25} & J_{26} & J_{27} \\ 0 & 0 & J_{32} & J_{33} & J_{34} & J_{35} & J_{36} & J_{37} \end{matrix}] [\begin{matrix} {\dot{θ}}_{l} \\ {\dot{θ}}_{r} \\ {\dot{θ}}_{1} \\ {\dot{θ}}_{2} \\ {\dot{θ}}_{3} \\ {\dot{θ}}_{4} \\ {\dot{θ}}_{5} \\ {\dot{θ}}_{6} \end{matrix}]

\Rightarrow {\dot{P}'}_{e_d_l} = R_{d_l_m} J_{d_l_m} {\dot{θ}}_{d_l_m}

where ${\dot{P}'}_{e_d_l} = {[\begin{matrix} {\dot{P}}_{s}^{' T} & {\dot{P}}_{e_d_l}^{T} \end{matrix}]}^{T}$ is the $(5 \times 1)$ vector; ${\dot{θ}}_{d_l_m} = {[\begin{matrix} {\dot{θ}}^{T}_{w} & {\dot{θ}}^{T}_{d_l} \end{matrix}]}^{T}$ is the $(8 \times 1)$ vector; $R_{d_l_m}$ is a $(5 \times 5)$ nonconstant matrix related to φ for simplicity sake of the GJM of the left arm of the mobile dual-arm robot; and $J_{d_l_m}$ is the $(5 \times 8)$ simplified GJM of the left arm of the robot.

Unlike in equation (17), the DOF increases from six to eight, as shown in equation (29), because of the addition of the differential driving platform based on the fixed dual-arm robot. ${\dot{P}'}_{e_d_l}$ is not only associated with ${\dot{θ}}_{d_l}$ but also with ${\dot{θ}}_{w}$ .

The right arm’s end-effector velocity of the mobile dual-arm robot is calculated by

\begin{array}{l} {\dot{x}'}_{e} = {\dot{x}}_{s} + [W cos φ - l_{2} sin θ_{2} cos (- {θ'}_{1} + φ) - l_{3} cos (φ - {θ'}_{1} - {θ'}_{3}) sin ({θ'}_{2} + {θ'}_{4}) - l_{4} cos (φ - {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) sin ({θ'}_{2} + {θ'}_{4} + {θ'}_{6})] \dot{φ} \\ + [r cos φ / 2 + d r sin φ / 2 / b + r J_{11} / 2 / b] {\dot{θ}}_{l} + [r cos φ / 2 - d r sin φ / 2 / b - r J_{11} / 2 / b] {\dot{θ}}_{r} \\ - [l_{2} sin {θ'}_{2} cos (- {θ'}_{1} + φ) + l_{3} cos (φ - {θ'}_{1} - {θ'}_{3}) sin ({θ'}_{2} + {θ'}_{4}) + l_{4} cos (φ - {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) sin ({θ'}_{2} + {θ'}_{4} + {θ'}_{6})] {\dot{θ}'}_{1} \\ + [l_{2} cos {θ'}_{2} sin (- {θ'}_{1} + φ) + l_{3} sin (φ - {θ'}_{1} - {θ'}_{3}) cos ({θ'}_{2} + {θ'}_{4}) + l_{4} sin (φ - {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) cos ({θ'}_{2} + {θ'}_{4} + {θ'}_{6})] {\dot{θ}'}_{2} \\ - [l_{3} cos (φ - {θ'}_{1} - {θ'}_{3}) sin ({θ'}_{2} + {θ'}_{4}) + l_{4} cos (φ - {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) sin ({θ'}_{2} + {θ'}_{4} + {θ'}_{6})] {\dot{θ}'}_{3} \\ + [l_{3} sin (φ - {θ'}_{1} - {θ'}_{3}) cos ({θ'}_{2} + {θ'}_{4}) + l_{4} sin (φ - {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) cos ({θ'}_{2} + {θ'}_{4} + {θ'}_{6})] {\dot{θ}'}_{4} \\ - l_{4} cos (φ - {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) sin ({θ'}_{2} + {θ'}_{4} + {θ'}_{6}) {\dot{θ}'}_{5} + l_{4} sin (φ - {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) cos ({θ'}_{2} + {θ'}_{4} + {θ'}_{6}) {\dot{θ}'}_{6} \end{array}

\begin{array}{l} {\dot{y}'}_{e} = {\dot{y}}_{s} - [W sin φ - l_{2} sin θ_{2} sin (φ - {θ'}_{1}) - l_{3} sin (φ - {θ'}_{1} - {θ'}_{3}) sin ({θ'}_{2} + {θ'}_{4}) - l_{4} sin (φ - {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) sin ({θ'}_{2} + {θ'}_{4} + {θ'}_{6})] \dot{φ} \\ + [r sin φ / 2 - d r cos φ / 2 / b + r J_{21} / 2 / b] {\dot{θ}}_{l} + [r sin φ / 2 + d r cos φ / 2 / b - r J_{21} / 2 / b] {\dot{θ}}_{r} \\ + [l_{2} sin {θ'}_{2} sin (φ - {θ'}_{1}) + l_{3} sin (φ - {θ'}_{1} - {θ'}_{3}) sin ({θ'}_{2} + {θ'}_{4}) + l_{4} sin (φ - {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) sin ({θ'}_{2} + {θ'}_{4} + {θ'}_{6})] {\dot{θ}'}_{1} \\ + [l_{2} cos {θ'}_{2} cos (φ - {θ'}_{1}) + l_{3} cos (φ - {θ'}_{1} - {θ'}_{3}) cos ({θ'}_{2} + {θ'}_{4}) + l_{4} cos (φ - {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) cos ({θ'}_{2} + {θ'}_{4} + {θ'}_{6})] {\dot{θ}'}_{2} \\ + [l_{3} sin (φ - {θ'}_{1} - {θ'}_{3}) sin ({θ'}_{2} + {θ'}_{4}) + l_{4} sin (φ - {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) sin ({θ'}_{2} + {θ'}_{4} + {θ'}_{6})] {\dot{θ}'}_{3} \\ + [l_{3} cos (φ - {θ'}_{1} - {θ'}_{3}) cos ({θ'}_{2} + {θ'}_{4}) + l_{4} cos (φ - {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) cos ({θ'}_{2} + {θ'}_{4} + {θ'}_{6})] {\dot{θ}'}_{4} \\ + l_{4} sin (φ - {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) sin ({θ'}_{2} + {θ'}_{4} + {θ'}_{6}) {\dot{θ}'}_{5} + l_{4} cos (φ - {θ'}_{1} - {θ'}_{3} - {θ'}_{5}) cos ({θ'}_{2} + {θ'}_{4} + {θ'}_{6}) {\dot{θ}'}_{6} \end{array}

\begin{array}{l} {\dot{z}'}_{e} = [l_{2} sin {θ'}_{2} + l_{3} sin ({θ'}_{2} + {θ'}_{4}) + l_{4} sin ({θ'}_{2} + {θ'}_{4} + {θ'}_{6})] {\dot{θ}'}_{2} + [l_{3} sin ({θ'}_{2} + {θ'}_{4}) + l_{4} sin ({θ'}_{2} + {θ'}_{4} + {θ'}_{6})] {\dot{θ}'}_{4} \\ + l_{4} sin ({θ'}_{2} + {θ'}_{4} + {θ'}_{6}) {\dot{θ}'}_{6} \end{array}

The transformation from ${\dot{θ}}_{d_r_m} = {[\begin{matrix} \dot{φ} & {\dot{θ}}^{T}_{d_r} \end{matrix}]}^{T}$ to ${\dot{P}}_{e_d_r}$ can be described by the following homogenous transformation matrix

[\begin{matrix} {\dot{x}'}_{e} \\ {\dot{y}'}_{e} \\ {\dot{z}'}_{e} \end{matrix}] = [\begin{matrix} {\dot{x}}_{s} \\ {\dot{y}}_{y} \\ 0 \end{matrix}] + [\begin{matrix} {J'}_{11} & {J'}_{12} & {J'}_{13} & {J'}_{14} & {J'}_{15} & {J'}_{16} & {J'}_{17} \\ {J'}_{21} & {J'}_{22} & {J'}_{23} & {J'}_{24} & {J'}_{25} & {J'}_{26} & {J'}_{27} \\ {J'}_{31} & {J'}_{32} & {J'}_{33} & {J'}_{34} & {J'}_{35} & {J'}_{36} & {J'}_{37} \end{matrix}] [\begin{matrix} \dot{φ} \\ {\dot{θ}'}_{1} \\ {\dot{θ}'}_{2} \\ {\dot{θ}'}_{3} \\ {\dot{θ}'}_{4} \\ {\dot{θ}'}_{5} \\ {\dot{θ}'}_{6} \end{matrix}]

\Rightarrow {\dot{P}}_{e_d_r} = {\dot{P}}_{s} + J_{d_r_m} {\dot{θ}}_{d_r_m}

where ${\dot{θ}}_{d_r_m}$ is the $(7 \times 1)$ vector, and $J_{d_r_m}$ is the $(3 \times 7)$ GJM of the right arm of the mobile dual-arm robot.

Similarly, the motion model of the right arm of the mobile dual-arm redundant robot can be derived using equations (35) and (1) as follows

[\begin{matrix} {\dot{x}}_{s} \\ {\dot{y}}_{s} \\ {\dot{x}'}_{e} \\ {\dot{y}'}_{e} \\ {\dot{z}'}_{e} \end{matrix}] = [\begin{matrix} cos φ & - sin φ & 0 & 0 & 0 \\ sin φ & cos φ & 0 & 0 & 0 \\ 0 & 0 & 1 & 0 & 0 \\ 0 & 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 0 & 1 \end{matrix}] [\begin{matrix} \frac{r}{2} & \frac{r}{2} & 0 & 0 & 0 & 0 & 0 & 0 \\ - \frac{d \cdot r}{2 b} & \frac{d \cdot r}{2 b} & 0 & 0 & 0 & 0 & 0 & 0 \\ \frac{r}{2} cos φ + \frac{r}{2 b} {J'}_{11} + \frac{d r}{2 b} sin φ & \frac{r}{2} cos φ - \frac{r}{2 b} {J'}_{11} - \frac{d r}{2 b} sin φ & {J'}_{12} & {J'}_{13} & {J'}_{14} & {J'}_{15} & {J'}_{16} & {J'}_{17} \\ \frac{r}{2} sin φ + \frac{r}{2 b} {J'}_{21} - \frac{d r}{2 b} cos φ & \frac{r}{2} sin φ - \frac{r}{2 b} {J'}_{21} + \frac{d r}{2 b} cos φ & {J'}_{22} & {J'}_{23} & {J'}_{24} & {J'}_{25} & {J'}_{26} & {J'}_{27} \\ 0 & 0 & {J'}_{32} & {J'}_{33} & {J'}_{34} & {J'}_{35} & {J'}_{36} & {J'}_{37} \end{matrix}] [\begin{matrix} {\dot{θ}}_{l} \\ {\dot{θ}}_{r} \\ {\dot{θ}'}_{1} \\ {\dot{θ}'}_{2} \\ {\dot{θ}'}_{3} \\ {\dot{θ}'}_{4} \\ {\dot{θ}'}_{5} \\ {\dot{θ}'}_{6} \end{matrix}]

\Rightarrow {\dot{P}'}_{e_d_r} = R_{d_r_m} J_{d_r_m} {\dot{θ}}_{d_r_m}

where ${\dot{P}'}_{e_d_r} = {[\begin{matrix} {\dot{P}}_{s}^{' T} & {\dot{P}}^{T}_{e_d_r} \end{matrix}]}^{T}$ is the $(5 \times 1)$ vector; ${\dot{θ}}_{d_r_m} = {[\begin{matrix} {\dot{θ}}_{w}^{T} & {\dot{θ}}_{d_r}^{T} \end{matrix}]}^{T}$ is the $(8 \times 1)$ vector; $R_{d_r_m}$ is a $(5 \times 5)$ nonconstant matrix related to φ for simplicity sake of the GJM of the right arm of the mobile dual-arm robot; and $J_{d_r_m}$ is the $(5 \times 8)$ simplified GJM of the right arm of the robot.

After modeling the platform, the left arm, and the right arm, the entire motion model of the mobile dual-arm robot can be achieved using wRMRC algorithm. The advantage of this method is that the movements of the dual-arm end effectors of the mobile dual-arm robot can intuitively be decomposed into the movements of the two driving wheels of the differential driving platform and the movements of each joint of the dual arm. The transformation from ${\dot{θ}}_{d_m} = {[\begin{matrix} {\dot{θ}}_{w}^{T} & {\dot{θ}}_{d_l}^{T} & {\dot{θ}}_{d_r}^{T} \end{matrix}]}^{T}$ to ${\dot{P}}_{e_d} = {[\begin{matrix} {\dot{P}}_{s}^{' T} & {\dot{P}}_{e_d_l}^{T} & {\dot{P}}_{e_d_r}^{T} \end{matrix}]}^{T}$ can be described by the following homogenous transformation matrix (equation (38)):

\begin{matrix} [\begin{matrix} {\dot{x}}_{s} \\ {\dot{y}}_{s} \\ {\dot{x}}_{e} \\ {\dot{y}}_{e} \\ {\dot{z}}_{e} \\ {\dot{x}}^{'} \\ {\dot{y}'}_{e} \\ {\dot{z}'}_{e} \end{matrix}] = [\begin{matrix} cos φ & - sin φ & 0 & 0 & 0 & 0 & 0 & 0 \\ sin φ & cos φ & 0 & 0 & 0 & 0 & 0 & 0 \\ 0 & 0 & 1 & 0 & 0 & 0 & 0 & 0 \\ 0 & 0 & 0 & 1 & 0 & 0 & 0 & 0 \\ 0 & 0 & 0 & 0 & 1 & 0 & 0 & 0 \\ 0 & 0 & 0 & 0 & 0 & 1 & 0 & 0 \\ 0 & 0 & 0 & 0 & 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 0 & 0 & 0 & 0 & 1 \end{matrix}] \\ [\begin{matrix} \frac{r}{2} & \frac{r}{2} & 0 & 0 & 0 & 0 & 0 & 0 & 0 & 0 & 0 & 0 & 0 & 0 \\ - \frac{d \cdot r}{2 b} & \frac{d \cdot r}{2 b} & 0 & 0 & 0 & 0 & 0 & 0 & 0 & 0 & 0 & 0 & 0 & 0 \\ \frac{r}{2} cos φ + \frac{r}{2 b} J_{11} + \frac{d r}{2 b} sin φ & \frac{r}{2} cos φ - \frac{r}{2 b} J_{11} - \frac{d r}{2 b} sin φ & J_{12} & J_{13} & J_{14} & J_{15} & J_{16} & J_{17} & 0 & 0 & 0 & 0 & 0 & 0 \\ \frac{r}{2} sin φ + \frac{r}{2 b} J_{21} - \frac{d r}{2 b} cos φ & \frac{r}{2} sin φ - \frac{r}{2 b} J_{21} + \frac{d r}{2 b} cos φ & J_{22} & J_{23} & J_{24} & J_{25} & J_{26} & J_{27} & 0 & 0 & 0 & 0 & 0 & 0 \\ 0 & 0 & J_{32} & J_{33} & J_{34} & J_{35} & J_{36} & J_{37} & 0 & 0 & 0 & 0 & 0 & 0 \\ \frac{r}{2} cos φ + \frac{r}{2 b} {J'}_{11} + \frac{d r}{2 b} sin φ & \frac{r}{2} cos φ - \frac{r}{2 b} {J'}_{11} - \frac{d r}{2 b} sin φ & 0 & 0 & 0 & 0 & 0 & 0 & {J'}_{12} & {J'}_{13} & {J'}_{14} & {J'}_{15} & {J'}_{16} & {J'}_{17} \\ \frac{r}{2} sin φ + \frac{r}{2 b} {J'}_{21} - \frac{d r}{2 b} cos φ & \frac{r}{2} sin φ - \frac{r}{2 b} {J'}_{21} + \frac{d r}{2 b} cos φ & 0 & 0 & 0 & 0 & 0 & 0 & {J'}_{22} & {J'}_{23} & {J'}_{24} & {J'}_{25} & {J'}_{26} & {J'}_{27} \\ 0 & 0 & 0 & 0 & 0 & 0 & 0 & 0 & {J'}_{32} & {J'}_{33} & {J'}_{34} & {J'}_{35} & {J'}_{36} & {J'}_{37} \end{matrix}] [\begin{matrix} {\dot{θ}}_{l} \\ {\dot{θ}}_{r} \\ {\dot{θ}}_{1} \\ {\dot{θ}}_{2} \\ {\dot{θ}}_{3} \\ {\dot{θ}}_{4} \\ {\dot{θ}}_{5} \\ {\dot{θ}}_{6} \\ {\dot{θ}'}_{1} \\ {\dot{θ}'}_{2} \\ {\dot{θ}'}_{3} \\ {\dot{θ}'}_{4} \\ {\dot{θ}'}_{5} \\ {\dot{θ}'}_{6} \end{matrix}] \end{matrix}

\Rightarrow {\dot{P}}_{e_d} = R_{d_m} J_{d_m} {\dot{θ}}_{d_m}

where ${\dot{P}}_{e_d}$ is the $(8 \times 1)$ vector; ${\dot{θ}}_{d_m}$ is the $(14 \times 1)$ vector; $R_{d_m}$ is a $(8 \times 8)$ nonconstant matrix related to φ for simplicity sake of the GJM of the mobile dual-arm redundant robot; and $J_{d_r_m}$ is the $(8 \times 14)$ simplified GJM of the robot.

Realization of the wRMRC algorithm

As mentioned previously, the position relationship between $θ_{d_m} = {[\begin{matrix} θ_{w}^{T} & θ_{d_l}^{T} & θ_{d_r}^{T} \end{matrix}]}^{T}$ and $P_{e_d} = [\begin{matrix} P_{s}^{' T} & P_{e_d_l}^{T} & P_{e_d_r}^{T} \end{matrix}]$ can be described by equation (40)

P_{e_d} = f (θ_{d_m})

where $P_{e_d} = {[\begin{matrix} {P'}_{s}^{T} & P_{e_d_l}^{T} & P_{e_d_r}^{T} \end{matrix}]}^{T}$ is the $(8 \times 1)$ vector; $θ_{d_m}$ is the $(14 \times 1)$ vector; $P_{s}$ , $P_{e_d_l}$ , and $P_{e_d_r}$ are the corresponding positions of $P_{s}$ , $P_{e}$ , and $P_{e}^{'}$ , respectively; and $θ_{w}$ , $θ_{d_l}$ , and $θ_{d_r}$ are the corresponding angles of $θ_{l}$ , $θ_{r}$ , $θ_{i}$ , and ${θ'}_{i} (i = 1, \dots, 6)$ , respectively.

Clearly, the derivative of equation (40) is equation (39), and the inverse of equation (39) is equation (41) as follows

\Rightarrow {\dot{θ}}_{d_m} = J_{d_m}^{- 1} R_{d_m}^{- 1} {\dot{P}}_{e_d}

where $J_{d_m}^{- 1}$ is the $(14 \times 8)$ IGJM of the mobile dual-arm robot.

For the simulation, equation (41) is described in the form of the variation per unit time as follows

\Rightarrow Δ θ_{d_m} = J_{d_m}^{- 1} R_{d_m}^{- 1} Δ P_{e_d}

where $Δ θ_{d_m} = {[{\begin{matrix} Δ θ_{w}^{T} & Δ θ_{d_l}^{T} & Δ θ \end{matrix}}_{d_r}^{T}]}^{T}$ is the $(14 \times 1)$ vector; $Δ P_{e_d} = {[\begin{matrix} Δ P_{s}^{'} & Δ P_{e_d_l}^{T} & Δ P_{e_d_r}^{T} \end{matrix}]}^{T}$ is the $(8 \times 1)$ vector; $Δ θ_{l}$ and $Δ θ_{r}$ of $Δ θ_{w}$ , $Δ θ_{d_l}$ , and $Δ θ_{d_r}$ are the corresponding angular variations per unit time of $θ_{l}$ , $θ_{r}$ , $θ_{i}$ , and ${θ'}_{i} (i = 1, \dots, 6)$ , respectively; and $Δ P_{s}^{'}$ , $Δ P_{e_d_l}$ , and $Δ P_{e_d_r}$ are the corresponding position variation per unit time of $P_{s}$ , $P_{e}$ , and $P_{e}^{'}$ , respectively.

The specific processes in the simulation are listed as follows:

Step 1: Input the initial configuration of the mobile dual-arm redundant robot including the differential driving platform and the dual arms;

Step 2: Input the different trajectories of the dual-arm end effectors of the mobile dual-arm robot;

Step 3: As the unit time $Δ T$ is confirmed, the whole steps N and the corresponding $Δ P_{e_d}$ are also confirmed;

Step 4: $Δ θ_{d_m}$ is calculated by equation (42);

Step 5: According to the value of $Δ θ_{d_m}$ , the movements of $Δ θ_{w}$ , $Δ θ_{d_l}$ and $Δ θ_{d_r}$ are given in order;

Step 6: The next motion status of the mobile dual-arm robot is confirmed. If the number of whole steps is less than N, the program will go to Step 4; otherwise, it will go to Step 7;

Step 7: End algorithm.

Simulations and results

To verify the validity of this algorithm and the influence of redundancy on the operation of the single- and dual-arm robots on the basis of the fixed platform and the differential driving platform, some simulations are made. First, we simulate the movement operations both on the fixed single-arm robot and the mobile single-arm robot. It is shown that the mobile single-arm robot has better smoothness, more flexibility, and greater operational space with more redundancy during the whole operational process. Second, by the simulation comparison between the movement operations of the single-arm robot and the dual-arm robot, the mobile dual-arm robot shows better cooperating performance during the whole operational process.

Simulation of the fixed single-arm robot with four DOF

The trajectory of the execution point $P_{e}$ is described as follows

\begin{array}{l} x_{e} = 0.0075 t + 0.5 \\ y_{e} = - 0.254 x_{e}^{3} + 1.8317 \\ z_{e} = 0.1 + 0.1 \sqrt[3]{t} \end{array}

The parameters of the fixed single-arm robot are set as follows

\begin{matrix} l_{1} = 0.47 m; & l_{2} = 0.44 m; \\ l_{3} = 0.374 m; & l_{4} = 0.1 m \end{matrix}

The initial configuration of the fixed single-arm robot is set as follows

\begin{array}{l} θ^{(0)} = (θ_{1}, θ_{2}, θ_{3}, θ_{4}) \\ = (90 °, 45 °, 45 °, 72 °) \end{array}

The numerical simulations are as follows:

Duo to the absence of the differential driving platform, the operating space of the fixed single-arm robot becomes narrow and can lead to the inability to completely track the target, as shown in Figure 6(a). When the value of the sampling point is 180, the mutation of the every joint angular variations is caused by the absence of the differential driving platform and the restriction of the total arm length of the fixed single-arm robot as shown in Figure 6(b).

Figure 6.

(a) Movement simulation in 3-D; (b) Four joint angular variations of the four DOF fixed single-arm robot. DOF: degree of freedom.

Simulation of the mobile single-arm redundant robot

The trajectory of the execution point is the same with the one of the execution point in section “Simulation of the fixed single-arm robot with Four DOF.” The trajectory of the fixed intersection point $P_{s}$ is described as follows

\begin{array}{l} x_{s} = 0.0065 t + 0.3 \\ y_{s} = - 0.5017 x_{s}^{2} + 1.5254 \\ z_{s} = 0.2 \end{array}

The parameters of the differential driving platform and the single-arm robot are set as follows

\begin{array}{l} r = 0.1 m; d = 0.2 m; b = 0.15 m; \\ l_{1} = 0.27 m; l_{2} = 0.44 m; \\ l_{3} = 0.374 m; l_{4} = 0.1 m \end{array}

The initial configuration of the mobile single-arm redundant robot is set as follows

\begin{array}{l} θ^{(0)} = (φ, θ_{1}, θ_{2}, θ_{3}, θ_{4}) \\ = (90 °, - 45 °, 90 °, 30 °, 144 °) \end{array}

The numerical simulations are as follows:

By adding the differential driving platform on the basis of the fixed single-arm robot, the number of the DOF increases from four to six. Thus, compared with Figure 6(a), Figure 7(a) and (b) shows that the operational space of the mobile single-arm redundant robot is expanded and this robot is completely able to track the target. The comparative study on the value of mean squared error (MSE) of each joint between the fixed and mobile robot illustrates that the angular variation of each joint of the mobile robot is smoother than that of the fixed single-arm robot shown in Table 1 and Table 2 in the whole sampling points.

Table 1.

The MSE of four joints of the single-arm fixed robot.^a

Sampling Variation Nth joint	1	20	40	60	80	100	120	140	160	180	200	MSE
1st joint	−0.010	−0.012	−0.012	−0.013	−0.015	−0.016	−0.014	♦	♦	♦	♦	0.014
2nd joint	−0.065	−0.004	0.010	0.014	−0.013	−0.000	−1.572	♦	♦	♦	♦	0.642
3rd joint	−0.132	0	−0.024	0	0	0	3.038	♦	♦	♦	♦	1.241
4th joint	0	−0.021	0	−0.135	0.128	0.053	0	♦	♦	♦	♦	0.079

MSE: mean squared error.

^a♦—no function of tracking.

Figure 7.

(a) Movement simulation in the x and y plane; (b) movement simulation in 3-D; (c) left-wheel, right-wheel, and four joint angular variations of the mobile single-arm redundant robot.

Table 2.

The MSE of four joints of the single-arm mobile robot.

Sampling Variation Nth joint	1	20	40	60	80	100	120	140	160	180	200	MSE
Left wheel	0.016	0.069	0.101	0.106	0.106	0.107	0.112	0.117	0.123	0.130	0.137	0.112
Right wheel	−0.082	−0.045	0.013	0.054	0.076	0.090	0.100	0.108	0.116	0.124	0.132	0.097
1st joint	0.033	0.038	0.029	0.017	0.008	0.003	−2.4E-04	−0.004	−0.009	−0.016	−0.022	0.022
2nd joint	−0.225	−0.004	−8.5E-05	−0.004	−0.003	−0.002	−0.002	−0.001	−0.008	−0.005	0.004	0.071
3rd joint	0.217	−0.011	−0.012	0	0	0	0	0	0.012	0.005	−0.011	0.069
4th joint	0	0	0	−0.008	−0.004	0.001	0.005	0.010	0	0	0	0.005

MSE: mean squared error.

Mobile operating simulation of the mobile single-arm redundant robot

All initial configurations of the simulation including the trajectories of $P_{e}$ and $P_{s}$ , the parameters of the mobile single-arm robot are the same with the corresponding ones in section “Simulation of the mobile single-arm redundant robot.”

The numerical simulations are as follows:

Figure 8(a) and (b) illustrates the movement simulation of the end-effector operation on the static object A of the mobile single-arm redundant robot. As shown in Figure 8(c), though the green lines fluctuate heavily during the process of the operation on the static object A, the mobile single-arm redundant robot features as completely tracking and operating on the target when moving. Therefore, more redundancy means more flexibility and greater operation for the mobile single-arm robot.

Figure 8.

(a) Simulation of the mobile operating on the static object A in the x and y plane; (b) simulation in 3-D; (c) four joint angular variations of the mobile single-arm redundant robot.

Simulation of tracking the same target of the dual arms

The tracking trajectories of $P_{e}$ and $P_{e}^{'}$ of the mobile dual-arm robot are the same and are described as follows

\begin{array}{l} x_{e} = {x'}_{e} = 0.0075 t + 0.5 \\ y_{e} = {y'}_{e} = - 0.254 x_{e}^{3} + 1.8317 \\ z_{e} = {z'}_{e} = 1.05 + 0.1 \sqrt[3]{t} \end{array}

The dual-arm parameters of this robot are the same and are set to the following

\begin{array}{l} h = 0.78 m; w = 0.473 m; \\ l_{1} = {l'}_{1} = 0.27 m; l_{2} = {l'}_{2} = 0.44 m; \\ l_{3} = {l'}_{3} = 0.374 m; l_{4} = {l'}_{4} = 0.23 m \end{array}

The left-arm and right-arm initial configurations of this robot are, respectively, set to the following

\begin{array}{l} θ^{(0)} = (φ, θ_{1}, θ_{2}, θ_{3}, θ_{4}, θ_{5}, θ_{6}) \\ = (0 °, 20 °, 36 °, 180 °, 20 °, - 270 °, - 300 °) \\ θ^{' (0)} = (φ, {θ'}_{1}, {θ'}_{2}, {θ'}_{3}, {θ'}_{4}, {θ'}_{5}, {θ'}_{6}) \\ = (0 °, - 20 °, - 18 °, 180 °, - 30 °, - 270 °, - 300 °) \end{array}

The trajectory of $P_{s}$ is

\begin{array}{l} x_{s} = 0.0065 t + 0.5; \\ y_{s} = - 0.5017 x_{s}^{2} + 1.8254; \\ z_{s} = 1 / 4.55 \end{array}

The parameters of the differential driving platform are

\begin{array}{l} r = 0.1 m; \\ d = 0 m; \\ b = 0.38 m \end{array}

The numerical simulations are as follows:

Compared with Figure 7(a) and (b), Figure 9(a) and (b) demonstrates that the mobile dual-arm redundant robot can harmoniously track the same target and has collaboration capability. Furthermore, Figure 9(c) and (d) illustrates that the angular variations of the left-arm and right-arm of each joint of this robot are smoother than those of the mobile single-arm robot in the entire sampling points.

Figure 9.

(a) Tracking simulation on the same target of the dual arms of the mobile dual-arm robot in the x and y planes; (b) simulation of tracking the same target in 3-D; (c) six joint angular variations of the left arm; (d) six joint angular variations of the robot.

Simulation of tracking different targets of the dual arms

The trajectories of $P_{e}$ and $P_{s}$ are the same as the corresponding ones in section “Simulation of tracking the same target of the dual arms,” respectively. The trajectory of $P_{e}^{'}$ is different and is described as follows

\begin{array}{l} {x'}_{e} = 0.0075 t + 0.3; \\ {y'}_{e} = - 0.254 {x′}_{e}^{3} + 1.4317; \\ {z'}_{e} = 1.1 + 0.1 \sqrt[3]{t} \end{array}

The parameters of the dual-arm and the differential driving platforms including the initial configurations of the dual-arm are the same as the corresponding ones in section “Simulation of tracking the same target of the dual arms.”

The numerical simulations are as follows:

In section “Simulation of tracking the same target of the dual arms” and in this section, the number of the DOF of the mobile dual-arm robot increases from 14 to 16 because of the addition of the differential driving platform based on the fixed dual-arm robot. Therefore, as the operational space is significantly expanded, this robot not only can completely track the same target shown in Figure 9(a) and (b) but also can completely track different targets simultaneously. The robot also has harmonious cooperation between the two arms and between the arms and the differential driving platform, as shown in Figure 10(a) and (b). Furthermore, the comparison analysis between this robot and other robots shows that the angular variation of each joint of the dual arms is minute, as shown in Figure 10(c) and (d). The movement of each joint of this robot has better smoothness than that of other robots in all sampling points.

Figure 10.

(a) Tracking simulation on the different targets of the dual arms of the mobile dual-arm robot in the x and y planes; (b) movement simulation in 3-D; (c) six joint angular variations of the left arm; (d) six joint angular variations of the right arm of the mobile dual-arm redundant robot.

Mobile operating simulation of the dual arms of the robot

A simulation was conducted to verify the manipulability of the mobile dual-arm redundant robot on different targets. Object A is an operation point on the end-effector trajectory of the left arm, and object B is an operation point on the end-effector trajectory of the right arm. All initial configurations of the simulation including the trajectories of $P_{e}$ , $P_{e}^{'}$ , and $P_{s}$ , and the parameters of the mobile dual-arm robot are the same as the corresponding ones in section “Simulation of tracking different targets of the dual arms.”

The numerical simulations are as follows:

The movement simulations are shown in Figure 11(a) and (b). Figure 11(c) and (d) shows that although the green lines fluctuate heavily during the operation on the static objects A and B separately, the mobile dual-arm redundant robot can operate on the different objects and coordinate the two arms and the differential driving platform when moving. Therefore, more redundancy shows the advantages of expanding the operational space, enhances the coordination operation function, and improves flexibility.

Figure 11.

(a) Simulation of the mobile robot operating on static object A for the left arm and on static object B for the right arm in the x and y planes; (b) movement simulation in 3-D; (c) six joint angular variations of the left arm; (d) six joint angular variations of the right arm of the mobile dual-arm redundant robot.

Conclusions and discussion

If applying the RMRC algorithm to model the left arm and the mobile platform of and the right arm and the mobile platform of the redundant mobile dual-arm robot separately, we can also get the same results. The advantage of the method is that it can directorially decompose the end-effector movements of the dual arms of the mobile dual-arm redundant robot into the movements of the two driving wheels of the differential driving platform and each joint of the dual arms of the robot harmonically, which makes the motion planning of the mobile dual-arm redundant robot easier and simpler. Through the modeling based on the wRMRC algorithm, it intuitively demonstrates that more redundancy leads to better smoothness, more flexibility and greater operational space, and the harmonious cooperation during the whole mobile operational process. In this study, we make two comparison simulations based on the wRMRC algorithm. The first comparison simulation is made between the fixed single-arm robot and the mobile single-arm robot. The second comparison simulation is made between the mobile single-arm robot and the mobile dual-arm robot. According to these simulations, the mobile dual-arm redundant robot can completely track and operate different objects and can cooperate harmoniously when moving. According to the comparative study of the MSE of each joint between Table 1 and Table 2, the mobile robot with redundancy shows better smoothness and more flexibility. In a word, the modeling based on the wRMRC algorithm clearly demonstrates the advantages of better smoothness, more flexibility, larger operational space, and more harmonious cooperation during the entire mobile operational process of the mobile dual-arm robot with more redundancy. In future works, the proposed algorithm will be applied and optimized in further experiments including the study of the singularity and dynamics about the redundant mobile dual-arm robots.

Footnotes

Author’s note

Author Hongxing Wang is also affiliated to Nanchang Institute of Technology, Nanchang, Jiangxi Province, China.

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 separately supported by the National Natural Science Foundation of China under grant no. 61273339, the Self-Planned Task (SKLRS201609B) of State Key Laboratory of Robotics and System (HIT), Science and Technology Planning Project of Jiangxi Province (20161BBH80040) and the Science and Technology Project Affiliated to the Education Department of Jiangxi Province (GJJ14745).

References

Zhao

. The design of the path-planning simulation platform for the omnidirectional mobile manipulator. Comput Eng Appl 2005; 41(31): 86–89.

da Graça Marcos

Tenreiro Machado

JA,

Azevedo-Perdicoúlis

T-P

. A multi-objective approach for the motion planning of redundant manipulators. Appl Soft Comput 2012; 12(2): 589–599.

Wiens

. Effects of dynamics coupling in mobile robotic system. In: Proceedings of world conference on robotic systems, pp. 43–57, 1989.

Liu

Lewis

. Decentralized continuous robust controller for mobile robots. In: Proceedings of IEEE international conference on robotics and automation (ICRA 1990), Tsukuba, pp. 1822–1827, 1990.

Arifi

Hang

. General framework of the force and compliant motion control for macro mini manipulator. In: IEEE/ASME international conference on advanced intelligent mechatronics (AIM), Australia, pp. 949–954, 2013.

Liu

Zhou

. Motion plan of mobile manipulator with differential driving. J Astronaut 2004; 25(2): 183–186.

Tevatia

Schaal

. Inverse kinematics for humanoid robots. In: Proceedings of the IEEE international conference on robotics & automation, CA, pp. 294–299, 2000.

D’Souza

Vijayakumar

. Learning inverse kinematics. In: Proceedings of the IEEE/RSJ international conference on intelligent robots and systems, USA, pp. 298–303, 2001.

Lin

Zhou

. A resolve of kinematic of mobile robot. J South China Univ Technol Nat Sci 2000; 28(4): 66–70.

10.

Chen

. Research on kinematics of humanoid dual-arm for mobile robots. J Huazhong Univ Sci Technol 2011; 39: 1–4.

11.

Wang

. RRT-based manipulation planning method for both arms of virtual human. J Syst Simul 2009; 21(20): 6515–6518.

12.

Vahrenkamp

Berenson

Asfour

. Humanoid motion planning for dual-arm manipulation and re-grasping tasks. In: The 2009 IEEE/RSJ international conference on intelligent robots and systems, St. Louis, USA, pp. 2464–2470, 2009.

13.

Zhang

Ouyang

. Kinematics analysis and path planning of dual-robot coordinated couple motion. J Shanghai Jiao Tong Univ 2013; 47(8): 1251–1256.

14.

Wang

You

. Path planning research and simulation of planar 3R redundant robot. In: The 2009 IEEE international conference on industrial engineering and applications, pp. 2855–2858, 2009.

Comparative study on the redundancy of mobile single- and dual-arm robots

Abstract

Keywords

Introduction

Building an entire model on the mobile dual-arm redundant robot

Motion model of the differential driving platform

Motion model of the fixed single-arm robot

Motion model of the mobile single-arm redundant robot

Motion model of the fixed dual-arm redundant robot

Motion model of the mobile dual-arm redundant robot

Realization of the wRMRC algorithm

Simulations and results

Simulation of the fixed single-arm robot with four DOF

Simulation of the mobile single-arm redundant robot

Mobile operating simulation of the mobile single-arm redundant robot

Simulation of tracking the same target of the dual arms

Simulation of tracking different targets of the dual arms

Mobile operating simulation of the dual arms of the robot

Conclusions and discussion

Footnotes

Author’s note

Declaration of conflicting interests

Funding

References