Generalized Kinematics Analysis of Hybrid Mechanisms Based on Screw Theory and Lie Groups Lie Algebras

Abstract

Advanced mathematical tools are used to conduct research on the kinematics analysis of hybrid mechanisms, and the generalized analysis method and concise kinematics transfer matrix are obtained. In this study, first, according to the kinematics analysis of serial mechanisms, the basic principles of Lie groups and Lie algebras are briefly explained in dealing with the spatial switching and differential operations of screw vectors. Then, based on the standard ideas of Lie operations, the method for kinematics analysis of parallel mechanisms is derived, and Jacobian matrix and Hessian matrix are formulated recursively and in a closed form. Then, according to the mapping relationship between the parallel joints and corresponding equivalent series joints, a forward kinematics analysis method and two inverse kinematics analysis methods of hybrid mechanisms are examined. A case study is performed to verify the calculated matrices wherein a humanoid hybrid robotic arm with a parallel-series-parallel configuration is considered as an example. The results of a simulation experiment indicate that the obtained formulas are exact and the proposed method for kinematics analysis of hybrid mechanisms is practically feasible.

Introduction

As robotic technology evolves, various types of robots are introduced in our day-to-day life, and they are increasingly applied to assist humans in many different fields [1]. Currently, the research hotspots of robotics are still focused on the lightweight design and compliance control [2, 3]. However, although advanced control algorithms and drive technologies have expanded the application of robots, their further application is limited by the inherent characteristics of typical robots [4].

The serial mechanism with a large workspace and flexible movement is the typical configuration of robots [4]. The serial robot with joint actuators mounted exhibits a bulky mechanical structure, large moment of inertia, and low payload to weight ratio. When compared with the serial mechanism, the parallel mechanism exhibits several advantages of higher stiffness, higher payload to weight ratio, reduced inertia, and higher precision [5, 6]. Although the parallel mechanism effectively compensates for the shortcomings of serial mechanisms, it also exhibits the disadvantage of small working space. Therefore, hybrid mechanism, which exhibits the advantages of serial and parallel mechanisms, exhibits broad application prospects for a humanoid robotic configuration. The serial mechanism can provide a larger workspace for the end manipulator. The parallel mechanism can guarantee stronger stiffness, higher load capacity of the hybrid mechanism, and higher positioning precision of the end manipulator. Mustafa et al. [7] proposed a cable-driven humanoid robotic arm for the field of surgical instruments. Liu et al. [8] proposed a lightweight high-payload cable-driven serial–parallel manipulator based on the special tension-amplifying principle.

The Denavit–Hartenberg method [9, 10] is commonly used to design and analyze hybrid mechanisms. Li et al. [11] explored a better kinematic performance and design scheme for a novel mechanical leg. Pinskier et al. [12] investigated a four degrees-of-freedom (DOF) hybrid parallel–serial slave mechanism and developed a bilateral haptic controller to compensate for coupling and assembly errors. Liu et al. [13] examined a bionic flexible manipulator driven by pneumatic muscle actuator and designed a fuzzy torque control algorithm based on the computed torque method. Ling et al. [14] presented a kinetostatic modeling method for flexure-hinge-based compliant mechanisms with hybrid serial–parallel substructures for providing accurate and concise solutions by combining the matrix displacement method with the transfer matrix method. Hu [15] proposed a serial–parallel hybrid mechanism formed by two well-known Tricept parallel manipulators connected in serial and derived simple and compact formulae for the forward and inverse acceleration based on a vector approach. However, the Denavit–Hartenberg method involves several weaknesses including a singularity problem and difficulty in locating the immediacy of physical meaning in differential kinematics. Additionally, the existing studies rarely focus on the generalized kinematics analysis method applicable to hybrid mechanisms.

Conversely, screw theory [16], Lie groups, and Lie algebras [17] are useful mathematical tools and provide simplified symbolic representation that can be used to obtain geometric-intuitive kinematic analyses. Recently, in various extant studies, these mathematical tools were applied to robotic applications and the complicated methods were simplified. Li et al. [18] extended the method to kinematics analysis and derived the closed-solution of inverse kinematics for serial mechanisms. Dai et al. [19, 20] combined screw theory with Lie group algebra and summarized the related knowledge according to its relationship with mechanisms. Huang et al. [21] presented a systematic approach for the kinematic calibration of a 6-DOF hybrid polishing robot and formulated the linearized error model based on screw theory. Li et al. [22, 23] presented type synthesis of parallel mechanisms according to screw theory and Lie group. Sun et al. [24, 25] proposed a generalized method to solve inverse kinematics of serial and parallel mechanisms using a finite screw. Gabardi et al. [26] investigated the kinematics analysis of a 4-UPU fully parallel manipulator and performed the analysis of actuation Jacobian, constraint Jacobian, and singularity configurations via screw theory. Liu et al. [27, 28] analyzed the comprehensive interaction mechanism of motion-force transmissibility to the acceleration capacity of robots and used the performance atlases method to conduct parameters optimization for different types of parallel robots. Hence, it is feasible and tentative to propose a generalized method of kinematics analysis for hybrid mechanisms.

In our previous study [29], a novel 8-DOF hybrid manipulator is proposed to realize a kinematic function similar to that of the human arm, as shown in Figure 1. The humanoid shoulder joint (HSJ) adopts the spherical 5R parallel mechanism with 2-DOF, the humanoid elbow joint (HEJ) is a 3-DOF series mechanism, and the humanoid wrist joint (HWJ) adopts the spherical 3-RRP parallel mechanism with 3-DOF. The HSJ and HWJ realize the positioning of the upper limb, and the forearm and HWJ cooperate with the end manipulator to perform partial fine operations. Furthermore, a closed-form solution for the inverse displacement problem of the hybrid humanoid robotic arm (HRA) is derived. In this study, we focus on the application of screw theory, Lie groups, and Lie algebras in the field of kinematics analysis of hybrid mechanisms. This paper is organized as follows. In Section 2, the method of kinematics analysis is proposed for hybrid mechanisms. In Section 3, the method is illustrated via the example of the humanoid HRA. In Section 4, the accuracy of the proposed method is verified via a simulation experiment. Finally, the conclusions of the study are discussed in Section 5.

Figure 1

Three-dimensional model of the HRA (left arm)

Kinematics Analysis of Mechanisms

According to the kinematics analysis of serial mechanisms, the basic principles of Lie operations in dealing with spatial switching and differential operations of screw vectors are briefly explained. Then, the generalized kinematics analysis of parallel and hybrid mechanisms is established. The detailed descriptions of screw theory, Lie groups, and Lie algebras are reported in previous studies [16, 17, 20].

Kinematics Analysis of Serial Mechanisms

The basic principles for kinematics analysis based on screw theory, Lie groups, and Lie algebras are shown in Figure 2, and the detailed derivation of formula is shown below.

Figure 2

Relationship among screw theory, Lie groups, and Lie algebras

The Jacobian matrix of series kinematic chains can be obtained as follows:

$$\left\{ {\begin{array}{*{20}l} {{\varvec{J}}_{O} \left( {\varvec{\theta}} \right){ = }\left[ {\begin{array}{*{20}l} {{{\varvec{\xi}}}_{1} } & {{\varvec{\xi}_{2}^{\prime}}} & \cdots & {{\varvec{\xi}_{n}^{\prime}} } \\ \end{array} } \right],} \\ {\varvec{\xi}_{i}^{\prime} = {\varvec{Ad}}_{{\exp {\kern 1pt} \left( {{\hat{\varvec{\xi }}}_{1} ,\;\theta_{1} } \right) \cdots \exp {\kern 1pt} \left( {{\hat{\varvec{\xi }}}_{i - 1} ,\;\theta_{i - 1} } \right)}} {{\varvec{\xi}}}_{i} ,} \\ \end{array} } \right.$$

(1)

where ξ_i denotes the initial unit screw vector of the ith motion pair, ${\varvec{\xi}_{i}^{\prime}}$ denotes the real-time unit screw vector of the ith motion pair, Ad denotes the concomitant effect of Lie groups on Lie algebras, exp denotes exponential product formula.

The forward kinematics analysis of series kinematic chains can be derived as follows:

$${\varvec{V}}_{O} = {\varvec{J}}_{O} \left( {\varvec{\theta}} \right)\varvec{\dot{\theta } = }\left[ {\begin{array}{*{20}l} {{{\varvec{\omega}}}_{O} } \\ {{\varvec{v}}_{O} } \\ \end{array} } \right],$$

(2)

$${{\varvec{\varepsilon}}}_{O} = {\varvec{J}}_{O} \left( {\varvec{\theta}} \right)\varvec{\ddot{\theta } }{ + }\dot{\varvec{J}}_{O} \left( {\varvec{\theta}} \right)\dot{\varvec{\theta }},$$

(3)

where V_O denotes the velocity vector of the point on the end platform that coincides with the origin of the base coordinate system, ε_O denotes the acceleration vector of this point, ω_O denotes the orientation velocity vector of this point, ν_O denotes the linear velocity vector of this point.

The differential matrix of Jacobian matrix can be calculated as follows:

$$\left\{ {\begin{array}{*{20}l} {\dot{\varvec{J}}_{O} \left( {\varvec{\theta}} \right){ = }\left[ {\begin{array}{*{20}l} {{\dot{\varvec{\xi }}}_{1} } & {{\varvec{\dot{\xi}_{{\varvec{2}}}^{\prime}}} } & \cdots & {{\varvec{\dot{\xi}_{{\varvec{n}}}^{\prime}}} } \\ \end{array} } \right],} \hfill \\ {{\varvec{\dot{\xi}_{i}^{\prime}}} = \left( {\dot{\theta }_{1} \cdot {{\varvec{\xi}}}_{1} + \cdots + \dot{\theta }_{i - 1} \cdot {\varvec{\xi}_{i - 1}^{\prime}} } \right) \times {\varvec{\xi}_{i}^{\prime}} ,} \hfill \\ {\dot{\varvec{J}}_{O} \left( {\varvec{\theta}} \right)\dot{\varvec{\theta }} = \dot{\theta }_{1} \cdot {{\varvec{\xi}}}_{1} \times \left( {{\varvec{\xi}_{2}^{\prime}} \cdot \dot{\theta }_{2} + \cdots + {\varvec{\xi}_{n}^{\prime}} \cdot \dot{\theta }_{n} } \right)} \hfill \\ {\quad + \dot{\theta }_{2} \cdot {\varvec{\xi}_{2}^{\prime}} \times \left( {{\varvec{\xi}_{3}^{\prime}} \cdot \dot{\theta }_{3} + \cdots + {\varvec{\xi}_{n}^{\prime}} \cdot \dot{\theta }_{n} } \right)} \hfill \\ {\quad + \cdots + \dot{\theta }_{n - 1} \cdot {\varvec{\xi}_{n - 1}^{\prime}} \times {\varvec{\xi}_{n}^{\prime}} \cdot \dot{\theta }_{n} .} \hfill \\ \end{array} } \right.$$

(4)

Thus, Eq. (3) can be expressed as follows:

$${{\varvec{\varepsilon}}}_{O} = {\varvec{J}}_{O} \left( {\varvec{\theta}} \right)\varvec{\ddot{\theta } }{ + }\dot{\varvec{\theta }}^{{\text{T}}} {\varvec{H}}_{O} \left( {\varvec{\theta}} \right)\dot{\varvec{\theta }},$$

(5)

where ${\varvec{H}}_{O} \left( {{\varvec{\theta}}} \right) = \left\{ {\begin{array}{*{20}l} {{\varvec{\xi}_{m}^{\prime}} \times {\varvec{\xi}_{n}^{\prime}} ,} & {m < n,} \\ {{\varvec{0}}{,}} & {\text{other cases,}} \\ \end{array} } \right.$ m denotes the number of rows of the matrix, n denotes the number of columns of the matrix.

The forward kinematics analysis of series mechanisms can be derived as follows:

$${\varvec{V}}_{{\text{M}}} = \left[ {\begin{array}{*{20}l} {{{\varvec{\omega}}}_{{\text{M}}} } \\ {{\varvec{v}}_{{\text{M}}} } \\ \end{array} } \right] = \left[ {\begin{array}{*{20}l} {{{\varvec{\omega}}}_{O} } \\ {{\varvec{v}}_{O} + {{\varvec{\omega}}}_{O} \times {\varvec{P}}_{{\text{M}}} } \\ \end{array} } \right] = {\varvec{J}}_{{\text{M}}} \left( {\varvec{\theta}} \right)\dot{\varvec{\theta }}{,}$$

(6)

$${{\varvec{\varepsilon}}}_{{\text{M}}} = {\varvec{J}}_{{\text{M}}} \left( {\varvec{\theta}} \right)\varvec{\ddot{\theta } }{ + }\dot{\varvec{\theta }}^{{\text{T}}} {\varvec{H}}_{{\text{M}}} \left( {\varvec{\theta}} \right)\dot{\varvec{\theta }}{ + }{\varvec{c}}_{{\text{M}}} ,$$

(7)

where P_M denotes the position vector of the end-reference point, V_M denotes the velocity vector of this point, ε_M denotes the acceleration vector of this point, ω_M denotes the orientation velocity vector of this point, ν_M denotes the linear velocity vector of this point, c_M =$\left[ {\begin{array}{*{20}l} {{\varvec{0}}_{{{3} \times {1}}} } \\ {{{\varvec{\omega}}}_{{\text{M}}} \times {\varvec{v}}_{{\text{M}}} } \\ \end{array} } \right]$.

Evidently, in non-singular configurations, the inverse kinematics analysis of series mechanisms can be calculated as follows:

$$\dot{\varvec{\theta }} = {\varvec{J}}\left( {\varvec{\theta}} \right)_{{\text{M}}}^{ - 1} {\varvec{V}}_{{\text{M}}} ,$$

(8)

$$\varvec{\ddot{\theta }} = {\varvec{J}}\left( {\varvec{\theta}} \right)_{{\text{M}}}^{ - 1} \left( {{{\varvec{\varepsilon}}}_{{\text{M}}} - \dot{\varvec{\theta }}^{{\text{T}}} {\varvec{H}}_{{\text{M}}} \left( {\varvec{\theta}} \right)\dot{\varvec{\theta }} - {\varvec{c}}_{{\text{M}}} } \right).$$

(9)

Kinematics Analysis of Parallel Mechanisms

Due to the coupling effect of kinematic chains on the moving platform, the kinematics transfer matrices (J and H) cannot be directly obtained.

Velocity Analysis of Parallel Mechanisms

The forward velocity analysis of parallel mechanisms can be obtained as follows:

$${\varvec{V}}_{{\text{M}}} = {\varvec{J}}_{\phi }^{{\text{M}}} \dot{\varvec{\phi }} = \left[ {{\varvec{J}}_{\theta }^{{\text{M}}} {\dot{\varvec{\theta }}}} \right]^{\left( b \right)} ,$$

(10)

where ${\varvec{J}}_{\phi }^{{\text{M}}}$ denotes the Jacobian matrix of the end-platform based on active pairs, $\dot{\varvec{\phi }}$ denotes the velocity vector of active pairs, $\left[ {{\varvec{J}}_{\theta }^{{\text{M}}} } \right]^{\left( b \right)}$ denotes the Jacobian matrix of the bth kinematic chain, and ${\dot{\varvec{\theta }}}^{\left( b \right)}$ denotes the velocity vector of motion pairs of the bth kinematic chain.

Meanwhile, in the non-singular configurations, the inverse velocity analysis of parallel mechanisms can be derived as follows:

$$\left\{ {\begin{array}{*{20}l} {\dot{\varvec{\phi }} = {\varvec{J}}_{{\text{M}}}^{\phi } {\varvec{V}}_{{\text{M}}} ,} \\ {{\dot{\varvec{\theta }}}^{\left( b \right)} = \left[ {{\varvec{J}}_{{\text{M}}}^{\theta } } \right]^{\left( b \right)} {\varvec{V}}_{{\text{M}}} = \left[ {{\varvec{J}}_{\theta }^{{\text{M}}} } \right]^{ - 1\left( b \right)} {\varvec{V}}_{{\text{M}}} .} \\ \end{array} } \right.$$

(11)

Assuming that the first motion pair of each kinematic chain acts as the active pair, $\dot{\varvec{\phi }}$ can be expressed as follows:

$$\dot{\varvec{\phi }} = \left[ {\begin{array}{*{20}l} {\dot{\theta }_{1}^{(1)} } & {\dot{\theta }_{1}^{(2)} } & \cdots & {\dot{\theta }_{1}^{(b)} } \\ \end{array} } \right]^{{\text{T}}} .$$

(12)

According to Eq. (11), ${\varvec{J}}_{\phi }^{{\text{M}}}$ and ${\varvec{J}}_{{\text{M}}}^{\phi }$ can be calculated as follows:

$${\varvec{J}}_{\phi }^{{\text{M}}} = \left[ {{\varvec{J}}_{{\text{M}}}^{\phi } } \right]^{ - 1} ,$$

(13)

$${\varvec{J}}_{{\text{M}}}^{\phi } = \left[ {\begin{array}{*{20}l} {\left[ {{\varvec{J}}_{{\text{M}}}^{\theta } } \right]_{{1{\varvec{ :}}}}^{\left( 1 \right)} } & {\left[ {{\varvec{J}}_{{\text{M}}}^{\theta } } \right]_{{1{\varvec{ :}}}}^{{\left( {2} \right)}} } & \cdots & {\left[ {{\varvec{J}}_{{\text{M}}}^{\theta } } \right]_{{1{\varvec{ :}}}}^{\left( b \right)} } \\ \end{array} } \right]^{{\text{T}}} ,$$

(14)

where (1:) denotes the first row of matrices.

Acceleration Analysis of Parallel Mechanisms

Evidently, the forward acceleration analysis of parallel mechanisms can be obtained as follows:

$$\begin{aligned} {{\varvec{\varepsilon}}}_{{\text{M}}} & = {\varvec{J}}_{\phi }^{{\text{M}}} \varvec{\ddot{\phi } }{ + }\dot{\varvec{\phi }}^{{\text{T}}} {\varvec{H}}_{\phi }^{{\text{M}}} \dot{\varvec{\phi }}{ + }{\varvec{c}}_{{\text{M}}} \, \\ & = \left[ {{\varvec{J}}_{\theta }^{{\text{M}}} {\varvec{\ddot{\theta }}}{ + }{\dot{\varvec{\theta }}}^{{\text{T}}} {\varvec{H}}_{\theta }^{{\text{M}}} {\dot{\varvec{\theta }}}} \right]^{\left( b \right)} { + }{\varvec{c}}_{{\text{M}}} {. } \\ \end{aligned}$$

(15)

Meanwhile, the inverse acceleration analysis of parallel mechanisms can be derived as follows:

$$\left\{ {\begin{array}{*{20}l} {\varvec{\ddot{\phi }} = {\varvec{J}}_{{\text{M}}}^{\phi } \left( {{{\varvec{\varepsilon}}}_{{\text{M}}} - \dot{\varvec{\phi }}^{{\text{T}}} {\varvec{H}}_{\phi }^{{\text{M}}} \dot{\varvec{\phi }} - {\varvec{c}}_{{\text{M}}} } \right)} \\ { = {\varvec{J}}_{{\text{M}}}^{\phi } {{\varvec{\varepsilon}}}_{\phi }^{{\text{M}}} - \dot{\varvec{\phi }}^{{\text{T}}} {\varvec{H}}_{{\text{M}}}^{\phi } \dot{\varvec{\phi }} - {\varvec{J}}_{{\text{M}}}^{\phi } \left( {{\varvec{c}}_{{\text{M}}} } \right),} \\ {{\varvec{\ddot{\theta }}}^{\left( b \right)} = \left[ {{\varvec{J}}_{{\text{M}}}^{\theta } \left( {{{\varvec{\varepsilon}}}_{{\text{M}}} - {\dot{\varvec{\theta }}}^{{\text{T}}} {\varvec{H}}_{\theta }^{{\text{M}}} {\dot{\varvec{\theta }}} - {\varvec{c}}_{{\text{M}}} } \right)} \right]^{\left( b \right)} .} \\ \end{array} } \right.$$

(16)

According to Eqs. (12), (14), and (16), $\varvec{\ddot{\phi }}$ can be calculated as follows:

$$\varvec{\ddot{\phi }} = \left[ {\begin{array}{*{20}l} {\left[ {{\varvec{J}}_{{\text{M}}}^{\theta } } \right]_{{1{\varvec{ :}}}}^{\left( 1 \right)} } \\ {\left[ {{\varvec{J}}_{{\text{M}}}^{\theta } } \right]_{{1{\varvec{ :}}}}^{\left( 2 \right)} } \\ \vdots \\ {\left[ {{\varvec{J}}_{{\text{M}}}^{\theta } } \right]_{{1{\varvec{ :}}}}^{\left( b \right)} } \\ \end{array} } \right]{{\varvec{\varepsilon}}}_{{\text{M}}} - \left[ {\begin{array}{*{20}l} {\dot{\varvec{\phi }}^{{\text{T}}} \left[ {{\varvec{L}}_{1} } \right]^{\left( 1 \right)} \dot{\varvec{\phi }}} \\ {\dot{\varvec{\phi }}^{{\text{T}}} \left[ {{\varvec{L}}_{1} } \right]^{\left( 2 \right)} \dot{\varvec{\phi }}} \\ \vdots \\ {\dot{\varvec{\phi }}^{{\text{T}}} \left[ {{\varvec{L}}_{1} } \right]^{\left( b \right)} \dot{\varvec{\phi }}} \\ \end{array} } \right] - \left[ {\begin{array}{*{20}l} {\left[ {{\varvec{J}}_{{\text{M}}}^{\theta } } \right]_{{1{\varvec{ :}}}}^{\left( 1 \right)} } \\ {\left[ {{\varvec{J}}_{{\text{M}}}^{\theta } } \right]_{{1{\varvec{ :}}}}^{\left( 2 \right)} } \\ \vdots \\ {\left[ {{\varvec{J}}_{{\text{M}}}^{\theta } } \right]_{{1{\varvec{ :}}}}^{\left( b \right)} } \\ \end{array} } \right]{\varvec{c}}_{{\text{M}}} ,$$

(17)

where $\left[ {{\varvec{L}}_{1} } \right]^{\left( b \right)} = \left[ {\left[ {{\varvec{J}}_{\phi }^{\theta } } \right]^{{\text{T}}} \left[ {\left[ {\left[ {{\varvec{J}}_{{\text{M}}}^{\theta } } \right]_{{1{\varvec{ :}}}}^{{\text{T}}} } \right] * {\varvec{H}}_{\theta }^{{\text{M}}} } \right]{\varvec{J}}_{\phi }^{\theta } } \right]^{\left( b \right)} ,$ $\left[ {{\varvec{J}}_{\phi }^{\theta } } \right]^{\left( b \right)} = \left[ {{\varvec{J}}_{{\text{M}}}^{\theta } } \right]^{\left( b \right)} {\varvec{J}}_{\phi }^{{\text{M}}} ,$ where * indicates the generalized scalar product of matrices, and the matrix before * is equivalent to a constant.

Thus ${\varvec{H}}_{\phi }^{{\text{M}}}$ and ${\varvec{H}}_{{\text{M}}}^{\phi }$ can be expressed as follows:

$${\varvec{H}}_{\phi }^{{\text{M}}} = {\varvec{J}}_{\phi }^{{\text{M}}} * {\varvec{H}}_{{\text{M}}}^{\phi } ,$$

(18)

$${\varvec{H}}_{{\text{M}}}^{\phi } = \left[ {\begin{array}{*{20}l} {\left[ {\varvec{L}} \right]_{1}^{\left( 1 \right)} } & {\left[ {\varvec{L}} \right]_{1}^{\left( 2 \right)} } & \cdots & {\left[ {\varvec{L}} \right]_{1}^{\left( b \right)} } \\ \end{array} } \right]^{{\text{T}}} .$$

(19)

Kinematics Analysis of Hybrid Mechanisms

The realization of the conversion of parallel joints and equivalent series joints is the key to the kinematics analysis of hybrid mechanisms. In our previous study [29], the inverse displacement problem of hybrid mechanisms was solved based on the equivalent series mechanism. In general, the equivalent series manipulator can be obtained based on the DOF of hybrid mechanisms. Therefore, it is clear that the equivalent series joint exhibits the same kinematics characteristics as the parallel joint follows:

$${\varvec{V}}_{{\text{M}}} = {\varvec{J}}_{\psi }^{{\text{M}}} {\dot{\varvec{\psi }}} = {\varvec{J}}_{\phi }^{{\text{M}}} \dot{\varvec{\phi }} = \left[ {{\varvec{J}}_{\theta }^{{\text{M}}} {\dot{\varvec{\theta }}}} \right]^{\left( b \right)} ,$$

(20)

$$\begin{aligned} {\varvec{\varepsilon}}_{{\text{M}}} & = {\varvec{J}}_{\psi }^{{\text{M}}} {\varvec{\ddot{\psi }}}{ + }{\dot{\varvec{\psi }}}^{{\text{T}}} {\varvec{H}}_{\psi }^{{\text{M}}} {\dot{\varvec{\psi }}}{ + }{\varvec{c}}_{{\text{M}}} \\ & = \, {\varvec{J}}_{\phi }^{{\text{M}}} \varvec{\ddot{\phi }}{ + }\dot{\varvec{\phi }}^{{\text{T}}} {\varvec{H}}_{\phi }^{{\text{M}}} \dot{\varvec{\phi }}{ + }{\varvec{c}}_{{\text{M}}} \\ & = \left[ {{\varvec{J}}_{\theta }^{{\text{M}}} {\varvec{\ddot{\theta }}}{ + }{\dot{\varvec{\theta }}}^{{\text{T}}} {\varvec{H}}_{\theta }^{{\text{M}}} {\dot{\varvec{\theta }}}} \right]^{\left( b \right)} { + }{\varvec{c}}_{{\text{M}}} , \\ \end{aligned}$$

(21)

where ${\dot{\varvec{\psi }}} = \left[ {\begin{array}{*{20}l} {\dot{\theta }_{{{\text{E}}1}} } & {\dot{\theta }_{{{\text{E2}}}} } & \cdots & {\dot{\theta }_{{{\text{E}}i}} } \\ \end{array} } \right]^{{\text{T}}}$ indicates the motion pairs of the equivalent series manipulator.

The velocity and acceleration vectors of motion pairs of the equivalent series joints can be obtained as follows:

$${\dot{\varvec{\psi }}} = {\varvec{J}}_{{\text{M}}}^{\psi } {\varvec{J}}_{\phi }^{{\text{M}}} \dot{\varvec{\phi }}{,}$$

(22)

$${\varvec{\ddot{\psi }}} = {\varvec{J}}_{{\text{M}}}^{\psi } \left( {{\varvec{J}}_{\phi }^{{\text{M}}} \varvec{\ddot{\phi }}{ + }\dot{\varvec{\phi }}^{{\text{T}}} {\varvec{H}}_{\phi }^{{\text{M}}} \dot{\varvec{\phi }} - {\dot{\varvec{\psi }}}^{{\text{T}}} {\varvec{H}}_{\psi }^{{\text{M}}} {\dot{\varvec{\psi }}}} \right){.}$$

(23)

Forward Kinematics Analysis of Hybrid Mechanisms

According to the kinematics analysis of serial and parallel mechanisms, the generalized method for forward kinematics analysis of hybrid mechanisms is proposed. The flow diagram for this method is shown in Figure 3. Firstly, the velocity and acceleration vectors of motion pairs of the equivalent series joints can be calculated based on Eqs. (22) and (23). Then, by applying Eqs. (6) and (7), the kinematics characteristics of the end-platform can be obtained. In this paper, we consider the HRA, as an example, to demonstrate the method in Section 3.

Figure 3

Forward kinematics analysis of hybrid mechanisms

Inverse Kinematics Analysis of Hybrid Mechanisms

There are two similar methods for the inverse kinematics analysis of hybrid mechanisms. The flow diagram of the first method is shown in Figure 4. Firstly, the velocity and acceleration vectors of motion pairs of the equivalent series manipulator can be calculated based on Eqs. (8) and (9). Then, by applying Eqs. (20) and (21), the velocity and acceleration vectors of moving platform of the parallel joints can be obtained. Finally, the kinematics characteristics of all the motion pairs of the hybrid manipulator can be derived by applying Eqs. (11) and (16).

Figure 4

First method for the inverse kinematics analysis of hybrid mechanisms

When a certain kinematic chain of a parallel joint has the same DOF as the parallel joint, then this chain can replace the equivalent series joint. The flow diagram of this method is shown in Figure 5, and its solution procedure is similar to that of the first method. In this paper, we consider the HRA, as an example, to demonstrate the two methods in Section 3.

Figure 5

Second method for the inverse kinematics analysis of hybrid mechanisms

Kinematics Analysis of the Humanoid Robotic Arm

Structural Configuration

The humanoid shoulder joint (HSJ) is based on a spherical 5R parallel mechanism, as shown in Figure 6(a). The initial unit axis vectors of all the revolute pairs in the HSJ are shown in Figure 6(b). Let O-XYZ be a base reference frame attached at the center O, where Y and OA₂ axes are coincident. Let O-X₁Y₁Z₁ be a moving reference frame of the HSJ attached at center O, where X₁ and OC₂ axes are coincident and Z₁ and OC₁ axes are coincident.

Figure 6

Structural configuration of the HSJ

The humanoid elbow joint (HEJ) is based on a series 3-DOF kinematic chain RRR, as shown in Figure 7(a). The initial unit axis vectors of all the revolute pairs in the HEJ are shown in Figure 7(b). Let O₂-X₂Y₂Z₂ be a moving reference frame of the HEJ attached at the center O₂, where Z₂ and O₂D axes are coincident.

Figure 7

Structural configuration of the HEJ

The humanoid wrist joint (HWJ) is based on a spherical 3-RRP parallel mechanism, as shown in Figure 8(a). The initial unit axis vectors of all the motion pairs in the HWJ are shown in Figure 8(b). Let O₃-X₃Y₃Z₃ be a base reference frame of the HWJ attached at center O₃, where Z₃ and O₂F axes are coincident. The moving reference frame attached at center O₄, which coincides with point O₃, is O₄-X₄Y₄Z₄.

Figure 8

Structural configuration of the HWJ

The HRA can be equivalent to a series robotic arm, as shown in Figure 9. Specifically, β₁ and γ₁ denote the input of the equivalent series shoulder joint, and α₄, β₄, and γ₄ denote the input of the equivalent series wrist joint.

Figure 9

Mechanism diagram of the equivalent series robotic arm

Pre-processing of Parallel Joints

To clarify the kinematics analysis of the hybrid HRA, the Jacobian matrices of the parallel joints and corresponding equivalent series joints are calculated first.

Pre-processing of Humanoid Shoulder Joint

The HSJ exhibits only 2 degrees of rotational freedom. Hence, the Jacobian matrix of kinematics chain 1 can be obtained according to Eqs. (6) and (8) as follows:

$$\left\{ {\begin{array}{*{20}l} {\left[ {\left[ {{\varvec{J}}_{\omega } } \right]_{{\theta_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} } \right]^{1} = \left[ {\begin{array}{*{20}l} {{\varvec{S}}_{{{ A}_{1} }} } & {{\varvec{S}_{{B_{1} }}^{\prime}} } & {{\varvec{S}_{{C_{1} }}^{\prime}} } \\ \end{array} } \right],} \\ {\left[ {\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\theta_{{{\text{SJ}}}} }} } \right]^{1} { = }\left[ {\left[ {\left[ {{\varvec{J}}_{\omega } } \right]_{{\theta_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} } \right]^{1} } \right]^{ - 1} ,} \\ \end{array} } \right.$$

(24)

where ${\varvec{S}_{i}^{\prime}}$ denotes the real-time unit axis vector of the ith motion pair.

However, for the kinematic chain 2, a virtual revolute pair D₂ is added to make the Jacobian matrix a square matrix of the following form:

$$\left\{ {\begin{array}{*{20}l} {{{\varvec{\xi}}}_{{D_{{2}} }} = \left[ {\begin{array}{*{20}l} {{\varvec{S}}_{{D_{{2}} }} } & {{\varvec{S}}_{{D_{{2}} }}^{0} } \\ \end{array} } \right]^{{\text{T}}} ,} \\ {\theta_{{D_{{2}} }} = \dot{\theta }_{{D_{{2}} }} = \ddot{\theta }_{{D_{{2}} }} = 0,} \\ \end{array} } \right.$$

(25)

where ${\varvec{S}}_{{D_{{2}} }} = \left[ {\begin{array}{*{20}l} 0 & 0 & 1 \\ \end{array} } \right]^{{\text{T}}}$ and ${\varvec{S}}_{{D_{{2}} }}^{0} = \left[ {\begin{array}{*{20}l} 0 & 0 & 0 \\ \end{array} } \right]^{{\text{T}}}$.

Similarly, the Jacobian matrix of the kinematic chain 2 can be obtained according to Eqs. (6) and (8):

$$\left\{ {\begin{array}{*{20}l} {\left\{ {\begin{array}{*{20}l} {\left[ {\left[ {\overline{\varvec{J}}_{\omega } } \right]_{{\theta_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} } \right]^{2} = \left[ {\begin{array}{*{20}l} {{\varvec{S}}_{{{ A}_{2} }} } & {{\varvec{S}_{{C_{2} }}^{\prime}} } & {{\varvec{S}_{{D_{2} }}^{\prime}} } \\ \end{array} } \right],} \\ {\left[ {\left[ {{\varvec{J}}_{\omega } } \right]_{{\theta_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} } \right]^{2} = \left[ {\begin{array}{*{20}l} {{\varvec{S}}_{{{ A}_{2} }} } & {{\varvec{S}_{{C_{2} }}^{\prime}} } \\ \end{array} } \right],} \\ \end{array} } \right.} \\ {\left\{ {\begin{array}{*{20}l} {\left[ {\left[ {\overline{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\theta_{{{\text{SJ}}}} }} } \right]^{2} = \left[ {\left[ {\left[ {\overline{\varvec{J}}_{\omega } } \right]_{{\theta_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} } \right]^{2} } \right]^{ - 1} ,} \\ {\left[ {\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\theta_{{{\text{SJ}}}} }} } \right]^{2} = \left[ {\begin{array}{*{20}l} {\left[ {\left[ {\overline{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\theta_{{{\text{SJ}}}} }} } \right]_{{1{\varvec{ :}}}}^{{2}} } & {\left[ {\left[ {\overline{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\theta_{{{\text{SJ}}}} }} } \right]_{{{2}{\varvec{ :}}}}^{2} } \\ \end{array} } \right]^{{\text{T}}} ,} \\ \end{array} } \right.} \\ \end{array} } \right.$$

(26)

where (:1) denotes the first column of matrices.

According to Eqs. (13) and (14), the Jacobian matrix of the HSJ based on the active pairs can be obtained as follows:

$$\left\{ {\begin{array}{*{20}l} {\left\{ {\begin{array}{*{20}l} {\left[ {\overline{\varvec{J}}_{\omega } } \right]_{{\phi_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} = \left[ {\left[ {\overline{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\phi_{{{\text{SJ}}}} }} } \right]^{ - 1} ,} \\ {\left[ {{\varvec{J}}_{\omega } } \right]_{{\phi_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} = \left[ {\begin{array}{*{20}l} {\left[ {\left[ {\overline{\varvec{J}}_{\omega } } \right]_{{\phi_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} } \right]_{:1} } & {\left[ {\left[ {\overline{\varvec{J}}_{\omega } } \right]_{{\phi_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} } \right]_{:2} } \\ \end{array} } \right],} \\ \end{array} } \right.} \\ {\left\{ {\begin{array}{*{20}l} {\left[ {\overline{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\phi_{{{\text{SJ}}}} }} = \left[ {\begin{array}{*{20}l} {\left[ {\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\theta_{{{\text{SJ}}}} }} } \right]_{1:}^{1} } & {\left[ {\left[ {\overline{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\theta_{{{\text{SJ}}}} }} } \right]_{1:}^{2} } & {\left[ {\left[ {\overline{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\theta_{{{\text{SJ}}}} }} } \right]_{3:}^{2} } \\ \end{array} } \right]^{{\text{T}}} ,} \\ {\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\phi_{{{\text{SJ}}}} }} = \left[ {\begin{array}{*{20}l} {\left[ {\left[ {\overline{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\phi_{{{\text{SJ}}}} }} } \right]_{1:} } & {\left[ {\left[ {\overline{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\phi_{{{\text{SJ}}}} }} } \right]_{2:} } \\ \end{array} } \right]^{{\text{T}}} .} \\ \end{array} } \right.} \\ \end{array} } \right.$$

(27)

For the corresponding equivalent series joint, the Jacobian matrix can be obtained according to Eqs. (6) and (8) as follows:

$$\left\{ {\begin{array}{*{20}l} {\left[ {{\varvec{J}}_{\omega } } \right]_{{\psi_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} = \left[ {\begin{array}{*{20}l} {{\varvec{S}}_{{Y_{1} }} } & {{\varvec{S}_{{X_{1} }}^{\prime}} } \\ \end{array} } \right],} \\ {\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\psi_{{{\text{SJ}}}} }} { = }\left[ {\left[ {{\varvec{J}}_{\omega } } \right]_{{\psi_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} } \right]^{{\text{T}}} .} \\ \end{array} } \right.$$

(28)

Pre-processing of the Humanoid Wrist Joint

The HWJ has 3 degrees of rotational freedom. Hence, the Jacobian matrix of the kinematic chains can be obtained according to Eqs. (6) and (8) as follows:

$$\left\{ {\begin{array}{*{20}l} {\left[ {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{\theta_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} } \right]^{b} = \left[ {\begin{array}{*{20}l} {{}^{3}{\varvec{S}}_{{{ H}_{b} }} } & {{}^{3}{\varvec{S}_{{K_{b} }}^{\prime}} } & {{}^{3}{\varvec{S}_{{P_{b} }}^{\prime}} } \\ \end{array} } \right],} \\ {\left[ {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{WJ}}}}^{{\theta_{{{\text{WJ}}}} }} } \right]^{b} { = }\left[ {\left[ {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{\theta_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} } \right]^{b} } \right]^{ - 1} ,} \\ \end{array} } \right.$$

(29)

where label 3 in the upper left corner indicates that the calculation is performed in the O₃-X₃Y₃Z₃ coordinate system.

According to Eqs. (13) and (14), the Jacobian matrix of the HWJ is based on the active pairs and can be obtained as follows:

$$\left\{ {\begin{array}{*{20}l} {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{\phi_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} = \left[ {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{WJ}}}}^{{\phi_{{{\text{WJ}}}} }} } \right]^{ - 1} ,} \\ {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{WJ}}}}^{{\phi_{{{\text{WJ}}}} }} { = }\left[ {\begin{array}{*{20}l} {\left[ {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{WJ}}}}^{{\theta_{{{\text{WJ}}}} }} } \right]_{{1{\varvec{ :}}}}^{1} } & {\left[ {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{WJ}}}}^{{\theta_{{{\text{WJ}}}} }} } \right]_{{1{\varvec{ :}}}}^{2} } & {\left[ {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{WJ}}}}^{{\theta_{{{\text{WJ}}}} }} } \right]_{{1{\varvec{ :}}}}^{3} } \\ \end{array} } \right]^{{\text{T}}} .} \\ \end{array} } \right.$$

(30)

With respect to the corresponding equivalent series joint, the Jacobian matrix can be obtained according to Eqs. (6) and (8) as follows:

$$\left\{ {\begin{array}{*{20}l} {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{\psi_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} = \left[ {\begin{array}{*{20}l} {{}^{3}{\varvec{S}}_{{{ Z}_{4} }} } & {{}^{3}{\varvec{S}_{{Y_{4} }}^{\prime}} } & {{}^{3}{\varvec{S}_{{X_{4} }}^{\prime}} } \\ \end{array} } \right],} \\ {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{WJ}}}}^{{\psi_{{{\text{WJ}}}} }} { = }\left[ {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{\psi_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} } \right]^{ - 1} .} \\ \end{array} } \right.$$

(31)

Forward Kinematics Analysis of the Humanoid Robotic Arm

According to Eq. (22), the velocity vector of motion pairs of the corresponding equivalent series joint can be calculated as follows:

$$\left\{ {\begin{array}{*{20}l} {{\dot{\varvec{\psi }}}_{{{\text{SJ}}}} = \left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\psi_{{{\text{SJ}}}} }} \left[ {{\varvec{J}}_{\omega } } \right]_{{\phi_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} \dot{\varvec{\phi }}_{{\text{ SJ}}} ,} \\ {{\dot{\varvec{\psi }}}_{{{\text{WJ}}}} = {}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{WJ}}}}^{{\psi_{{{\text{WJ}}}} }} {}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{\phi_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} \dot{\varvec{\phi }}_{{\text{ WJ}}} .} \\ \end{array} } \right.$$

(32)

Meanwhile, according to Eq. (11), the velocity vectors of passive motion pairs of the corresponding parallel joint can be calculated as follows:

$$\left\{ {\begin{array}{*{20}l} {{\dot{\varvec{\theta }}}_{{{\text{SJ}}}}^{\left( b \right)} = \left[ {\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\theta_{{{\text{SJ}}}} }} } \right]^{\left( b \right)} \left[ {{\varvec{J}}_{\omega } } \right]_{{\phi_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} \dot{\varvec{\phi }}_{{\text{ SJ}}} ,} \\ {{\dot{\varvec{\theta }}}_{{{\text{WJ}}}}^{\left( b \right)} = \left[ {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{WJ}}}}^{{\theta_{{{\text{WJ}}}} }} } \right]^{\left( b \right)} {}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{\phi_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} \dot{\varvec{\phi }}_{{\text{ WJ}}} .} \\ \end{array} } \right.$$

(33)

Thus, according to Eqs. (18) and (19), $\left[ {{\varvec{H}}_{\omega } } \right]_{{\phi_{{{\text{SJ}}}} }}^{{{\text{SJ}}}}$ and ${}^{3}\left[ {{\varvec{H}}_{\omega } } \right]_{{\psi_{{{\text{WJ}}}} }}^{{{\text{WJ}}}}$ can be calculated. Then, according to Eq. (23), the acceleration vector of the corresponding equivalent series joint can be calculated as follows:

$$\left\{ {\begin{array}{*{20}l} {{\varvec{\ddot{\psi }}}_{{{\text{SJ}}}} = \left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\psi_{{{\text{SJ}}}} }} \left( {\left[ {{\varvec{J}}_{\omega } } \right]_{{\phi_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} \varvec{\ddot{\phi } }{ + }\dot{\varvec{\phi }}_{{\text{ SJ}}}^{{\text{ T}}} \left[ {{\varvec{H}}_{\omega } } \right]_{{\phi_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} \dot{\varvec{\phi }}_{{\text{ SJ}}} } \right.} \\ { \, \left. { - {\dot{\varvec{\psi }}}_{{{\text{SJ}}}}^{{\text{ T}}} \left[ {{\varvec{H}}_{\omega } } \right]_{{\psi_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} {\dot{\varvec{\psi }}}_{{{\text{SJ}}}} } \right),} \\ {{\varvec{\ddot{\psi }}}_{{{\text{WJ}}}} = {}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{WJ}}}}^{{\psi_{{{\text{WJ}}}} }} \left( {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{\phi_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} \varvec{\ddot{\phi } }{ + }\dot{\varvec{\phi }}_{{\text{ WJ}}}^{{\text{ T}}} {}^{3}\left[ {{\varvec{H}}_{\omega } } \right]_{{\phi_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} \dot{\varvec{\phi }}_{{\text{ WJ}}} } \right.} \\ { \, \left. { - {\dot{\varvec{\psi }}}_{{{\text{WJ}}}}^{{\text{ T}}} {}^{3}\left[ {{\varvec{H}}_{\omega } } \right]_{{\psi_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} {\dot{\varvec{\psi }}}_{{{\text{WJ}}}} } \right).} \\ \end{array} } \right.$$

(34)

Finally, according to Eqs. (6) and (7), the forward kinematics analysis of the HRA can be obtained as follows:

$$\left\{ {\begin{array}{*{20}l} {{\varvec{V}}_{{{\text{HRA}}}} = {\varvec{J}}_{\psi }^{{{\text{HRA}}}} {\dot{\varvec{\psi }}}_{{{\text{HRA}}}} ,} \\ {{{\varvec{\varepsilon}}}_{{{\text{HRA}}}} = {\varvec{J}}_{\psi }^{{{\text{HRA}}}} {\varvec{\ddot{\psi }}}_{{{\text{HRA}}}} { + }{\dot{\varvec{\psi }}}_{{{\text{HRA}}}}^{{\text{T}}} {\varvec{H}}_{\psi }^{{{\text{HRA}}}} {\dot{\varvec{\psi }}}_{{{\text{HRA}}}} { + }{\varvec{c}}_{{{\text{HRA}}}} ,} \\ \end{array} } \right.$$

(35)

where ${\varvec{J}}_{\psi }^{{{\text{HRA}}}} = \left[ {\begin{array}{*{20}l} {{{\varvec{\xi}}}_{{Y_{1} }} }{{\varvec{\xi}_{{X_{1} }}^{\prime}} }{{\varvec{\xi}_{D}^{\prime}} }{{\varvec{\xi}_{E}^{\prime}} }{{\varvec{\xi}_{F}^{\prime}} }{{\varvec{\xi}_{{Z_{4} }}^{\prime}} }{{\varvec{\xi}_{{Y_{4} }}^{\prime}} }{{\varvec{\xi}_{{X_{4} }}^{\prime}} } \\ \end{array} } \right]$, ${{\varvec{\psi}}}_{{{\text{HRA}}}} = \left[ {\begin{array}{*{20}l} {\psi_{{Y_{1} }} }{\psi_{{X_{1} }} }{\theta_{D} }{\theta_{E} }{\theta_{F} }{\psi_{{Z_{4} }} }{\psi_{{Y_{4} }} }{\psi_{{X_{4} }} } \\ \end{array} } \right]^{{\text{T}}}$, ${\varvec{H}}_{\psi }^{{{\text{HRA}}}} = \left\{ {\begin{array}{*{20}l} {{\varvec{\xi}_{m}^{\prime}} \times {\varvec{\xi}_{n}^{\prime}} ,} & {m < n,} \\ {0,} & {\text{other cases,}} \\ \end{array} } \right.$ $m,n = Y_{1} ,X_{1} ,D,E,F,Z_{4} ,Y_{4} ,X_{4}$.

Inverse Kinematics Analysis of the Humanoid Robotic Arm

The First Method

According to Eqs. (8) and (9), the velocity and acceleration vectors of the equivalent series manipulator can be calculated as follows:

$$\left\{ {\begin{array}{*{20}l} {{\dot{\varvec{\psi }}}_{{{\text{HRA}}}} = \left[ {{\varvec{J}}_{\psi }^{{{\text{HRA}}}} } \right]^{ - 1} {\varvec{V}}_{{{\text{HRA}}}} ,} \\ {{\varvec{\ddot{\psi }}}_{{{\text{HRA}}}} = \left[ {{\varvec{J}}_{\psi }^{{{\text{HRA}}}} } \right]^{ - 1} \left[ {{{\varvec{\varepsilon}}}_{{{\text{HRA}}}} - {\dot{\varvec{\psi }}}_{{{\text{HRA}}}}^{{\text{T}}} {\varvec{H}}_{\psi }^{{{\text{HRA}}}} {\dot{\varvec{\psi }}}_{{{\text{HRA}}}} - {\varvec{c}}_{{\text{M}}} } \right].} \\ \end{array} } \right.$$

(36)

According to Eqs. (20) and (21), the velocity and acceleration vectors of moving platforms of the parallel joints can be calculated as follows:

$$\left\{ {\begin{array}{*{20}l} {{\varvec{V}}_{{{\text{SJ}}}} = \left[ {{\varvec{J}}_{\omega } } \right]_{{\psi_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} {\dot{\varvec{\psi }}}_{{{\text{SJ}}}} ,} \\ {{{\varvec{\varepsilon}}}_{{{\text{SJ}}}} = \left[ {{\varvec{J}}_{\omega } } \right]_{{\psi_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} {\varvec{\ddot{\psi }}}_{{{\text{SJ}}}} { + }{\dot{\varvec{\psi }}}_{{{\text{SJ}}}}^{{\text{ T}}} \left[ {{\varvec{H}}_{\omega } } \right]_{{\psi_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} {\dot{\varvec{\psi }}}_{{{\text{SJ}}}} { + }{\varvec{c}}_{{{\text{SJ}}}} ,} \\ \end{array} } \right.$$

(37)

$$\left\{ {\begin{array}{*{20}l} {{}^{3}{\varvec{V}}_{{{\text{WJ}}}} = {}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{\psi_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} {\dot{\varvec{\psi }}}_{{{\text{WJ}}}} ,} \\ {{}^{3}{{\varvec{\varepsilon}}}_{{{\text{WJ}}}} = {}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{WJ}}}}^{{\psi_{{{\text{WJ}}}} }} {\varvec{\ddot{\psi }}}_{{{\text{WJ}}}} { + }{\dot{\varvec{\psi }}}_{{{\text{WJ}}}}^{{\text{ T}}} {}^{3}\left[ {{\varvec{H}}_{\omega } } \right]_{{\psi_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} {\dot{\varvec{\psi }}}_{{{\text{WJ}}}} { + }{}^{3}{\varvec{c}}_{{{\text{WJ}}}} .} \\ \end{array} } \right.$$

(38)

According to Eqs. (11) and (16), the velocity and acceleration vectors of all the motion pairs of the parallel joints can be obtained as follows:

$$\left\{ {\begin{array}{*{20}l} {{\dot{\varvec{\theta }}}_{{{\text{SJ}}}}^{\left( b \right)} = \left[ {\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\theta_{{{\text{SJ}}}} }} } \right]^{\left( b \right)} {\varvec{V}}_{{{\text{SJ}}}} ,} \\ {{\dot{\varvec{\theta }}}_{{{\text{WJ}}}}^{\left( b \right)} = \left[ {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{WJ}}}}^{{\theta_{{{\text{WJ}}}} }} } \right]^{\left( b \right)} {}^{3}{\varvec{V}}_{{{\text{WJ}}}} ,} \\ \end{array} } \right.$$

(39)

$$\left\{ {\begin{array}{*{20}l} {{\varvec{\ddot{\theta }}}_{{{\text{SJ}}}}^{\left( b \right)} = \left[ {\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{SJ}}}}^{{\theta_{{{\text{SJ}}}} }} \left( {{{\varvec{\varepsilon}}}_{{{\text{SJ}}}} - {\dot{\varvec{\theta }}}_{{{\text{SJ}}}}^{{\text{ T}}} \left[ {{\varvec{H}}_{\omega } } \right]_{{\theta_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} {\dot{\varvec{\theta }}}_{{{\text{SJ}}}} - {\varvec{c}}_{{{\text{SJ}}}} } \right)} \right]^{\left( b \right)} ,} \\ {{\varvec{\ddot{\theta }}}_{{{\text{WJ}}}}^{\left( b \right)} = \left[ {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{{\text{WJ}}}}^{{\theta_{{{\text{WJ}}}} }} \left( {{}^{3}{{\varvec{\varepsilon}}}_{{{\text{WJ}}}} - {\dot{\varvec{\theta }}}_{{{\text{WJ}}}}^{{\text{ T}}} {}^{3}\left[ {{\varvec{H}}_{\omega } } \right]_{{\theta_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} {\dot{\varvec{\theta }}}_{{{\text{WJ}}}} - {}^{3}{\varvec{c}}_{{{\text{WJ}}}} } \right)} \right]^{\left( b \right)} .} \\ \end{array} } \right.$$

(40)

The Second Method

According to the mobility analysis of the hybrid HRA, kinematic chain 2 of the HSJ and kinematic chain 1 (or 2, or 3) of the HWJ are selected to form the corresponding branch series of the robotic arm.

According to Eqs. (8) and (9), the velocity and acceleration vectors of the branch series manipulator can be calculated as follows:

$$\left\{ {\begin{array}{*{20}l} {{\dot{\varvec{\psi }}}_{{{\text{B}} - {\text{HRA}}}} = \left[ {{\varvec{J}}_{\psi }^{{{\text{B}} - {\text{HRA}}}} } \right]^{ - 1} {\varvec{V}}_{{{\text{HRA}}}} ,} \\ {{\varvec{\ddot{\psi }}}_{{{\text{B}} - {\text{HRA}}}} = \left[ {{\varvec{J}}_{\psi }^{{{\text{B}} - {\text{HRA}}}} } \right]^{ - 1} \left[ {{{\varvec{\varepsilon}}}_{{{\text{HRA}}}} - {\dot{\varvec{\psi }}}_{{{\text{B}} - {\text{HRA}}}}^{{\text{T}}} {\varvec{H}}_{\psi }^{{{\text{B}} - {\text{HRA}}}} {\dot{\varvec{\psi }}}_{{{\text{B}} - {\text{HRA}}}} - {\varvec{c}}_{{{\text{HRA}}}} } \right],} \\ \end{array} } \right.$$

(41)

where ${\varvec{J}}_{\psi }^{{{\text{B}} - {\text{HRA}}}} = \left[ {\begin{array}{*{20}l} {{{\varvec{\xi}}}_{{A_{2} }} }{{\varvec{\xi}^{{\prime}}_{{C_{2} }}} }{{\varvec{\xi}^{{\prime}}_{D}} }{{\varvec{\xi}^{{\prime}}_{E}} }{{\varvec{\xi}^{{\prime}}_{F}} }{{\varvec{\xi}^{{\prime}}_{{H_{1}} }} }{{\varvec{\xi}^{{\prime}}_{{K_{1} }}} }{{\varvec{\xi}^{{\prime}}_{{P_{1}} }} } \\ \end{array} } \right]$, ${{\varvec{\psi}}}_{{{\text{B}} - {\text{HRAHRA}}}} = \left[ {\begin{array}{*{20}l} {\theta_{{A_{2} }} }{\theta_{{C_{2} }} }{\theta_{D} }{\theta_{E} }{\theta_{F} }{\theta_{{H_{1} }} }{\theta_{{K_{1} }} }{\theta_{{P_{1} }} } \\ \end{array} } \right]^{{\text{T}}}$, ${\varvec{H}}_{\psi }^{{{\text{B}} - {\text{HRA}}}} = \left\{ {\begin{array}{*{20}l} {{\varvec{\xi}^{{\prime}}_{m}} \times {\varvec{\xi}^{{\prime}}_{n}} ,} & {m < n,} \\ {0,} & {\text{other cases,}} \\ \end{array} } \right.$ $m,n = A_{2} ,C_{2} ,D,E,F,H_{1} ,K_{1} ,P_{1} .$

According to Eqs. (20) and (21), the velocity and acceleration vectors of moving platforms of the parallel joints can be calculated as follows:

$$\left\{ {\begin{array}{*{20}l} {{\varvec{V}}_{{{\text{SJ}}}} = \left[ {\left[ {{\varvec{J}}_{\omega } } \right]_{{\theta_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} {\dot{\varvec{\theta }}}} \right]^{2} ,} \\ {{{\varvec{\varepsilon}}}_{{{\text{SJ}}}} = \left[ {\left[ {{\varvec{J}}_{\omega } } \right]_{{\theta_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} {\varvec{\ddot{\theta }}}{ + }{\dot{\varvec{\theta }}}^{{\text{ T}}} \left[ {{\varvec{H}}_{\omega } } \right]_{{\theta_{{{\text{SJ}}}} }}^{{{\text{SJ}}}} {\dot{\varvec{\theta }}}{ + }{\varvec{c}}_{{{\text{SJ}}}} } \right]^{2} ,} \\ \end{array} } \right.$$

(42)

$$\left\{ {\begin{array}{*{20}l} {{}^{3}{\varvec{V}}_{{{\text{WJ}}}} = \left[ {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{\theta_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} {\dot{\varvec{\theta }}}} \right]^{1} ,} \\ {{}^{3}{{\varvec{\varepsilon}}}_{{{\text{WJ}}}} = \left[ {{}^{3}\left[ {{\varvec{J}}_{\omega } } \right]_{{\theta_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} {\varvec{\ddot{\theta }}}{ + }{\dot{\varvec{\theta }}}^{{\text{ T}}} \left[ {{\varvec{H}}_{\omega } } \right]_{{\theta_{{{\text{WJ}}}} }}^{{{\text{WJ}}}} {\dot{\varvec{\theta }}}{ + }{}^{3}{\varvec{c}}_{{{\text{WJ}}}} } \right]^{1} .} \\ \end{array} } \right.$$

(43)

Similarly, according to Eqs. (39) and (40), the velocity and acceleration vectors of all the motion pairs of the parallel joints can be obtained.

Simulation Experiment

To verify the method of kinematics analysis, a verification scheme is proposed as shown in Figure 10. Firstly, according to the kinematics information of the target trajectory, the velocity and acceleration vectors of the active pairs are obtained based on the inverse kinematics analysis. Then, the kinematics information of the end-moving platform is obtained according to the forward kinematics analysis.

Figure 10

Verification scheme

In this paper, same dimensions of the HRA, target trajectory, and given redundant inputs, as used in our previous study [[29]], are selected, and the first set of solutions for the inverse displacement problem are used as position-orientation information for the HRA.

The target trajectory is as follows:

$${\varvec{g}}_{st} { = }\left[ {\begin{array}{*{20}l} {1} & {0} & {0} & {X_{st} (t)} \\ 0 & {0} & {1} & { - r_{5} - r_{6} } \\ {0} & { - {1}} & {0} & { - r_{4} + Z_{st} (t)} \\ {0} & {0} & {0} & {1} \\ \end{array} } \right]{,}\left\{ {\begin{array}{*{20}l} {X_{st} (t) = h_{1} \sin \left( {\frac{{2{\pi }t}}{T}} \right),} \hfill \\ {Z_{st} (t) = h_{1} - h_{1} \cos \left( {\frac{{2{\pi }t}}{T}} \right),} \hfill \\ {h_{1} = 80\;{\text{mm,}}} \hfill \\ {T = 10\;{\text{s}}{.}} \hfill \\ \end{array} } \right.$$

(44)

β₁ and F are selected as the given input variables:

$$\left\{ {\begin{array}{*{20}l} {\beta_{{1}} = - \frac{{h_{2} }}{{2{\pi }}}\sin \left( {\frac{{2{\pi }t}}{T}} \right) + h_{2} \frac{t}{T},\;h_{2} = 10^\circ ,} \\ {\theta_{F} = 0.} \\ \end{array} } \right.$$

(45)

Inverse Kinematics Analysis

According to the first method of inverse kinematics analysis, the velocity and acceleration vectors of the active inputs can be calculated, as shown in Figure 11.

Figure 11

First method of inverse kinematics analysis

Meanwhile, according to the second method of inverse kinematics analysis, the velocity and acceleration vectors of the active inputs can also be calculated, as shown in Figure 12. To verify whether the two methods are equivalent, the calculation errors between the two methods are obtained, as shown in Figure 13. Evidently, the calculation errors are almost equal to 0, and the two methods of inverse kinematics analysis are equivalent.

Figure 12

Second method of the inverse kinematics analysis

Figure 13

Errors between the two methods of the inverse kinematics analysis

Forward Kinematics Analysis

The first set of velocity and acceleration vectors of the active pairs are selected for the forward kinematics analysis. According to the method of forward kinematics analysis, the velocity and acceleration vectors of the end-moving platform can be calculated as shown in Figure 14 and 15.

Figure 14

Rotation of the end-moving platform

Figure 15

Translation of the end-moving platform

Evidently, the orientation of the end-moving platform remains unchanged. To verify the accuracy of the method for forward kinematics analysis, the calculation errors between the forward kinematics and target trajectory are obtained as shown in Figure 16.

Figure 16

Translational motion error between the forward kinematics and target trajectory

Clearly, the calculation errors are almost equal to 0, the motion of the end-moving platform are exactly the same as the target trajectory. Conversely, the simulation data obtained from our previous study [29] are used to verify the kinematics analysis method. Then, the calculation errors between the proposed method and simulation in the translation motion are shown in Figure 17.

Figure 17

Translational motion error between the proposed method and simulation

Similarly, the errors between the simulation results and theoretical calculation are acceptable, which is mainly due to the difference between the three-dimensional model and numerical solution. Therefore, the accuracy of the proposed methods is verified for forward kinematics analysis and inverse kinematics analysis.

Conclusions

• (1) When compared to other methods with respect to the kinematics analysis of hybrid mechanisms, the proposed methods, based on screw theory and Lie groups Lie algebras, exhibit evident physical significance, and the kinematic transfer matrices (J and H) can be expressed concisely and uniformly.

• (2) Additionally, the velocity and acceleration vectors of all the motion pairs can be easily obtained, which lays the groundwork for the establishment of dynamics model and design of front-negative feedback control system.

• (3) The equivalent series mechanism and branch series mechanism are equivalent in dealing with the inverse kinematics analysis. Although the physical significance of transfer matrices based on the two methods are inconsistent, they do not change the transfer properties of the hybrid mechanism.