Journal of Robotics

Volume 2014, Article ID 296250, 13 pages

http://dx.doi.org/10.1155/2014/296250

## Kinematics and Dynamics of an Asymmetrical Parallel Robotic Wrist

Department of Mechanical and Manufacturing Engineering, Aalborg University, 9220 Aalborg, Denmark

Received 24 July 2014; Accepted 1 November 2014; Published 1 December 2014

Academic Editor: Gordon R. Pennock

Copyright © 2014 Guanglei Wu. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

#### Abstract

This paper introduces an asymmetrical parallel robotic wrist, which can generate a decoupled unlimited-torsion motion and achieve high positioning accuracy. The kinematics, dexterity, and singularities of the manipulator are investigated to visualize the performance contours of the manipulator. Using the method of Lagrange multipliers and considering all the mobile components, the equations of motion of the manipulator are derived to investigate the dynamic characteristics efficiently. The developed dynamic model is numerically illustrated and compared with its simplified formulation to show its computation accuracy.

#### 1. Introduction

The parallel typed wrist mechanisms, also called spherical parallel manipulators (SPMs), have found their applications in camera-orientating [1], minimally invasive surgery [2] and wrist joint [3] thanks to their large orientation workspace and high payload capacity. Since the SPM can generate three pure rotations, another potential application is that it can function as a tool head for complicated surface machining. However, the general SPM only can produce a limited torsion motion with a prescribed tilt angle, whereas an unlimited torsion is necessary in some common material processing such as milling. The coaxial input SPM reported in [3] can achieve unlimited torsion, whereas its unique structure introduces a complex input mechanism. Moreover, the general SPMs result in low positioning accuracy [4] without a ball-and-socket joint as the center of rotation. In this paper, an asymmetrical parallel robotic wrist is proposed, which can generate an unlimited-torsion motion with enhanced positioning accuracy. This manipulator adopts a universal joint as the center of rotation supported by an input shaft at the center, which simplifies the manipulator architecture.

The SPMs have been extensively studied on many aspects, such as workspace [5, 6], dexterity [7–9], singularity [10], stiffness [4, 11], and type synthesis [12–14]. These performance criteria can be classified into two groups: one relates to the kinematic performance of the manipulator while the other relates to the kinetostatic/dynamic performance of the manipulator [15]. In the kinematic considerations, the quality of the workspace that reflects the shape, size, and presence of singularities is of primary importance in the manipulator design. Another utmost important concern is the dexterity, which is usually evaluated by means of the conditioning number of the kinematic Jacobian matrix. On the other hand, the dynamics of SPMs received relatively less attention. When the wrist mechanisms are used to develop active spherical joints, the dynamic characteristics are of importance in their design and applications. The most used approaches to derive the equations of motion include recursive Newton-Euler approach and the Lagrange equations [16–18], which have been applied to different parallel robotics. The recursive Newton-Euler method consists of two steps: the first step is an outward recursion to calculate velocity and acceleration from the base to the end link; the second step is an inward recursion to calculate the forces and torques at joints from the end link to the base. By virtue of the principle of virtual work, Staicu [19] used this method to derive the inverse dynamics of the Agile Wrist [11]. The equations of motion for a manipulator can also be formulated with Lagrangian method, which includes two types: one with dependent coordinates and the other with independent coordinates [20]. This paper adopts the first type to develop a dynamic model with the approach of Lagrange multipliers.

This paper introduces an asymmetrical parallel robotic wrist and presents the kinematic/dynamic analysis. The isocontours of the dexterity over workspace are visualized to show an image of the overall performance and singularity is analyzed. Using the method of Lagrange multipliers and considering all the mobile components, the equations of motion of the manipulator are derived to compute the power consumption efficiently. The developed dynamic model is numerically illustrated and compared with its simplified model.

#### 2. Manipulator under Study

The proposed asymmetrical wrist mechanism is displayed in Figure 1(a), whose mobile platform (MP) is composed of an outer and inner ringer via bearing. The orientation of the outer ring is determined by two * *__R__RR (throughout this paper, R, U, and P stand for revolute, universal, and prismatic joints, resp., and an underlined letter indicates an actuated joint) legs and constrained in a vertical plane by a fully passive RRU leg or an alternative RPU one. Through a U-joint, the decoupled rotation of the inner ringer is driven by the center shaft that supports the MP to improve the positioning accuracy. This manipulator can generate an unlimited torsion, which can be used in milling and work as an active spherical joint.

The coordinate system for the manipulator is built as shown in Figure 1(b), of which the origin is located at the center of rotation, namely, point . The axes of the three revolute joints in the th * *__R__RR leg are parallel to unit vectors , , and , respectively. Both of these two legs have identical proximal and distal curved links defined by and . The base platform is defined by and , and the connection joint on the mobile platform is defined by .

#### 3. Kinematics of the Manipulator

The orientation of the outer ring of the mobile platform is presented by Euler angles , for which the rotation matrix is expressed as . Hence, the orientation of the inner ring can be described with Cardan angles which yields the rotation matrix , and its output axis is denoted by , where .

Under the prescribed coordinate system, unit vector is derived as

Unit vector of the axis of the intermediate revolute joint in the th leg is expressed as where and stand for the sine and cosine functions, respectively.

Unit vector of the top revolute joint in the th leg is a function of the outer ring orientation: where is the unit vector for the axis of the top revolute joint of the th leg when the mobile platform is at its home configuration.

##### 3.1. Inverse Geometry

Following the kinematic constraint equations below,
The spherical trigonometry equation for the th * *__R__RR legs is written as
with

The input angle displacements can be solved as Solving (5), the inverse geometry problem has four solutions corresponding to the four working modes, which is characterized by the sign of . Here, the mode is selected as the working mode.

According to the motion of U-joint [21], the input angle of the center shaft is derived as follows:

##### 3.2. Kinematic Jacobian Matrix

Differentiating (4) and (8) with respect to time, the relationship between the angle rates and the input velocity is derived as with

Since the angle rates can be transformed into the angular velocity, namely, The kinematic Jacobian matrix of the manipulator is expressed as

Equation (9) or relates the motions of the inner ring of the mobile platform to the input angular velocities.

##### 3.3. Motions of the Manipulator

This section presents the velocity equations for the mobile bodies of the manipulator and the acceleration equations can be derived by differentiating the velocity equations with respect to time.

###### 3.3.1. Outer Ring of MP

Due to the decoupled motion of the outer ring of the mobile platform, its angle rates can be extracted from (9) as follows: On the other hand, the angular velocity of the outer ring can be found upon the differentiation of (4) with respect to time, namely, In accordance with (11), the following relationship exists:

###### 3.3.2. Active Leg

Referring to Figure 2(a), the velocity of the intermediate joint in th leg is found by making use of the following equation: To eliminate and , dot-multiplying equation (16) on both sides with yields The angular velocity of the distal link in the th leg in the reference frame is found as which can be cast in the local frame by the following transformation matrix:

###### 3.3.3. Passive Leg

As the motion of the passive leg is confined in the vertical plane, the passive leg is considered as a planar four-bar linkage as shown in Figure 2(b), whose input/output (I/O) equation can be written in the nondimensional form [22]: with Differentiating (20) with respect to time leads to with

After knowing the , , , and , the linear and angular velocities of the coupler link and can be found.

#### 4. Workspace, Dexterity, and Singularity of the SPM

The workspace (WS) is one of the most important design issues as it defines the working volume of the robot/manipulator and determines the area that can be reached by a reference frame located on the moving platform or end-effector [23, 24]. The size and shape of the workspace are of primary importance for the global geometric performance evaluations of the manipulators [25]. The workspace size can be defined by its geometric shape parameters like the radius of a cylindrical/spherical workspace or the sides of the cube for a cubic workspace. In the scope of the paper, a spherical cap defined with and in Figure 3 is considered as the regular workspace (RWS).

##### 4.1. Dexterity Analysis

Dexterity is another utmost important concern, which is usually evaluated by the condition number of the kinematic Jacobian matrix. The studies on the SPMs show that smaller angles can achieve better dexterity [6, 9]. Figure 4 demonstrates the distribution of the inverse of the condition number of Jacobian matrix based on 2-norm over the workspace, where , . These performance contours indicate the dexterous WS region for the manipulator with different designs.

To evaluate the kinematic performance over the regular workspace, a commonly used index is the global conditioning index (GCI) [7]. The GCI is defined over the workspace , which is calculated through a discrete approach in practice, namely, where is the discrete number. The index obtained through the above equation is an arithmetic mean, which can be replaced with a quadratic mean for a better indication of the dexterity; subsequently, GCI is redefined as As a consequence, GCI for the six designs in Figure 4 is computed in Table 1, from which it is seen that the fourth design has the largest value of GCI.

##### 4.2. Singularity Analysis

From Figure 4, it is seen that the smallest value of the isocontours occurs in the workspace center region except Figure 4(e), which implies the possible singularities. Since the input/output of the center shaft is decoupled, which does not have influence on the singular configuration, the singularity is analyzed by means of the forward/backward Jacobians in (14), namely,

For Type I singularity, it occurs when at least one of the diagonal elements in matrix is equal to zero; that is, the proximal and distal links in a leg are coplanar, leading to where . By comparison to (3) and solving the three (overdetermined) equations for each leg, the input angle and Euler angles and can be calculated to describe the singular configuration. Taking the sets of parameters in Figure 4 as examples, the singularity of case does not exist; for the case , it is found that the solutions of and corresponding to the th leg are definite and is subject to its motion range when , or , and , as shown in Figure 5.

From the forward Jacobian matrix, it is seen that the SPM is at Type II singularity when the normals to the planes of the distal links are linearly dependent, that is, the two distal links and the mobile platform being coplanar, which yields By the same token, in comparison to (2), the angles , , and can be found by solving the six overdetermined equation systems. Figure 6 illustrates two examples of Type II singularity, where this type of singularity does not exist in the workspace for the second design.

Based on the above analysis, although the set of parameters in Figure 4(e) results in low GCI of the SPM, the regular workspace free of singularity is much larger than other designs. This means that smaller and larger can make the manipulator have better performance of the workspace.

#### 5. Dynamic Modeling of the Manipulator

In order to compute the power consumption effectively, all the mobile bodies will be taken into account for the dynamic modeling. The dynamics of the SPM under study can be solved by using the Lagrange equations [20] below: where is the Lagrangian of the system, including the mobile platform and the three legs, and . Moreover, is the vector of external forces and vector characterizes the actuator torques. Matrix is the system’s constraint Jacobian, which can be found from the velocity equation (9), namely, Therefore, the matrix of constraints is found as . Moreover, is a vector of Lagrange multipliers.

##### 5.1. Lagrangian of the Mobile Platform

Due to the decoupled rotation between the inner and outer rings of the mobile platform, the Lagrangian of the mobile platform includes two parts as follows: where and denote the mass moment of inertia of the inner and outer rings.

##### 5.2. Lagrangian of the Active Leg

Since all the mobile bodies of SPMs rotate about the center of rotation, from the motions of the active leg derived in Section 3.3.2, the Lagrangian of the th leg is derived as follows: with where is the proximal link’s mass moment of inertia about and is the distal link’s mass moment of inertia about point . Moreover, and indicate the centers of the mass of the proximal and distal links, respectively, and and .

Let be the moment of inertia of the center shaft, and its Lagrangian is expressed as

##### 5.3. Lagrangian of the Passive Leg

The Lagrangian of the passive leg is derived as where , and , are the mass and moment of inertia for link and , respectively.

Substituting the previous Lagrangian into (29), the terms in the equation of motion for this dynamic system [20] can be derived. With an external moment vector , the actuator torques are expressed as

#### 6. Numerical Simulation

In accordance with Section 4, dynamic characteristics of the manipulator with parameters of Figure 4(d) will be presented through simulation, where the dimensions and mass properties are listed below: Based on the kinematic and dynamic models, the inverse dynamic simulation is conducted with low/high-speed motions defined by the following two trajectories: where the velocities and accelerations of the mobile platform and the actuators for the two trajectories are displayed in Figures 7(a) and 7(b), respectively. Through comparison, it is found that the difference of the input velocities will reduce when the manipulator is at high-speed motion. Hence, the input requirements on the actuators will be more isotropic.

The corresponding simulation results, with the comparison of a simplified model where passive and distal links are not considered, are illustrated with Figures 8 and 9. It is seen that the gravity and inertial forces of the passive and distal links strongly influence the output torques and powers of the two parallel actuators, especially in the region with poor dexterity. At some orientations, the magnitudes of the actuator torque/power of the completed model are smaller than the simplified one, and the reason is that the torque applied to the actuator caused by the links’ gravity has the same direction with the accelerations. On the other hand, the gravity and inertial forces have less influence on the third actuator due to the decoupled mobility.

Figure 10 demonstrates the actuator torques/powers when the manipulator tracks the second trajectory with an external moment in the Cartesian space exerted on the mobile platform. It says that the torques/powers profiles are quite close; hence, the simplified model can be used to approximate the manipulator’s dynamic characteristics when the external moment has much more influence than the inertial forces. All the three cases result in the smallest torque requirement on the third actuator but its output power is the highest among the three actuators.

#### 7. Conclusion

This paper introduces an asymmetrical parallel robotic wrist which admits a large orientation workspace. Its unique structure allows that the manipulator can generate a decoupled unlimited-torsion rotation and ensures high positioning accuracy. This proposed manipulator can be used as a tool head in the complicated surface machining, such as milling, and also can work as an active spherical joint.

The kinematic performance of the proposed manipulator is studied and performance contours of the dexterity over the workspace are visualized for the optimum design in the further study. Moreover, the singularity is analyzed by solving the geometric constraint equations. Using the classical method of Lagrange multipliers, the equations of motion for the manipulator under study were derived. All the moving bodies are taken into account to describe this dynamic system effectively and clearly. Numerical simulations show that some simplified models that neglect the weight of intermediate bodies cannot characterize the dynamics of the system appropriately. The developed dynamic model can be used for the actuation selection or dynamics evaluation. In the future, the optimal design of the manipulator will be conducted for improvement of dexterity and reduction of energy consumption.

#### Nomenclature

: | The Lagrangian of the robotic system |

, , : | The angular velocities of the inner/outer rings and the th distal link |

: | Vector of the actuator torque |

: | Output angle of the four-bar linkage of the passive leg |

: | The angle rates of the inner ring |

, | Forward and backward kinematic Jacobians of the inner ring |

: | Constraint Jacobian matrix |

Kinematic Jacobian matrix | |

, : | Forward and backward kinematic Jacobians of the outer ring |

, | Rotation matrix of the outer and inner rings of the mobile platform |

: | Transformation matrix of the th distal link |

: | Unit vector of the input axis in the th leg |

: | Unit vector of the intermediate revolute joint in the th leg |

: | Unit vector of the top revolute joint in the th leg |

: | The th input angle. |

#### Conflict of Interests

The author declares that there is no conflict of interests regarding the publication of this paper.

#### References

- C. M. Gosselin and J. F. Hamel, “The Agile Eye: a high-performance three-degree-of-freedom camera-orienting device,” in
*Proceedings of the IEEE International Conference on Robotics and Automation*, vol. 1, pp. 781–786, San Diego, Calif, USA, May 1994. View at Publisher · View at Google Scholar - T. Li and S. Payandeh, “Design of spherical parallel mechanisms for application to laparoscopic surgery,”
*Robotica*, vol. 20, no. 2, pp. 133–138, 2002. View at Publisher · View at Google Scholar · View at Scopus - H. Asada and J. Granito, “Kinematic and static characterization of wrist joints and their optimal design,” in
*Proceedings of the IEEE International Conference on Robotics and Automation*, pp. 244–250, 1985. - G. Wu, S. Bai, and J. Kepler, “Mobile platform center shift in spherical parallel manipulators with flexible limbs,”
*Mechanism and Machine Theory*, vol. 75, pp. 12–26, 2014. View at Publisher · View at Google Scholar · View at Scopus - C. M. Gosselin and J. Angeles, “The optimum kinematic design of a spherical three-degree-of-freedom parallel manipulator,”
*Journal of Mechanical Design*, vol. 111, no. 2, pp. 202–207, 1989. View at Publisher · View at Google Scholar - S. Bai, “Optimum design of spherical parallel manipulators for a prescribed workspace,”
*Mechanism and Machine Theory*, vol. 45, no. 2, pp. 200–211, 2010. View at Publisher · View at Google Scholar · View at Scopus - C. Gosselin and J. Angeles, “Global performance index for the kinematic optimization of robotic manipulators,”
*Journal of Mechanical Design*, vol. 113, no. 3, pp. 220–226, 1991. View at Google Scholar · View at Scopus - S. Bai, M. R. Hansen, and T. O. Andersen, “Modelling of a special class of spherical parallel manipulators with Euler parameters,”
*Robotica*, vol. 27, no. 2, pp. 161–170, 2009. View at Publisher · View at Google Scholar · View at Scopus - G. Wu, “Multiobjective optimum design of a 3-RRR spherical parallel manipulator with kinematic and dynamic dexterities,”
*Modeling, Identification and Control*, vol. 33, no. 3, pp. 111–121, 2012. View at Publisher · View at Google Scholar - I. A. Bonev and C. M. Gosselin, “Singularity loci of spherical parallel mechanisms,” in
*Proceedings of the IEEE International Conference on Robotics and Automation*, pp. 2957–2962, April 2005. View at Publisher · View at Google Scholar · View at Scopus - F. Bidault, C. P. Teng, and J. Angeles, “Structural optimization of a spherical parallel manipulator using a two-level approach,” in
*Proceedings of the ASME Design Engineering Technical Conference and Computers and Information in Engineering Conference*, pp. 215–224, Pittsburgh, Pa, USA, September 2001. View at Scopus - X. Kong and C. M. Gosselin, “Type synthesis of three-degree-of-freedom spherical parallel manipulators,”
*The International Journal of Robotics Research*, vol. 23, no. 3, pp. 237–245, 2004. View at Publisher · View at Google Scholar · View at Scopus - G. Gogu, “Fully-isotropic three-degree-of-freedom parallel wrists,” in
*Proceedings of the IEEE International Conference on Robotics and Automation (ICRA '07)*, pp. 895–900, Roma, Italy, April 2007. View at Publisher · View at Google Scholar · View at Scopus - M. Karouia and J. M. Hervé, “Asymmetrical 3-dof spherical parallel mechanisms,”
*European Journal of Mechanics: A/Solids*, vol. 24, no. 1, pp. 47–57, 2005. View at Publisher · View at Google Scholar · View at Scopus - S. Caro, D. Chablat, R. Ur-Rehman, and P. Wenger, “Multiobjective design optimization of 3-PRR planar parallel manipulators,” in
*Global Product Development*, A. Bernard, Ed., pp. 373–383, Springer, Berlin, Germany, 2011. View at Google Scholar - R. N. Murray, Z. X. Li, and S. S. Sastry,
*A Mathematical Introduction to Robotic Manipulation*, CRC Press, 1994. View at MathSciNet - R. Featherstone and D. Orin, “Robot dynamics: equations and algorithms,” in
*Proceedings of the IEEE International Conference on Robotics and Automation (ICRA '00)*, pp. 826–834, April 2000. View at Scopus - J. Angeles,
*Fundamentals of Robotic Mechanical Systems: Theory, Methods, and Algorithms*, Springer, New York, NY, USA, 2007. View at Publisher · View at Google Scholar · View at MathSciNet - S. Staicu, “Recursive modelling in dynamics of Agile Wrist spherical parallel robot,”
*Robotics and Computer-Integrated Manufacturing*, vol. 25, no. 2, pp. 409–416, 2009. View at Publisher · View at Google Scholar · View at Scopus - J. G. de Jalon and E. Bayo,
*Kinematic and Dynamic Simulation of Multibody Systems: The Real-Time Challenge*, Springer, New York, NY, USA, 1994. - http://en.wikipedia.org/wiki/Universal_joint.
- F. Freudenstein, “Approximate synthesis of four-bar linkages,”
*Resonance*, vol. 15, no. 8, pp. 740–767, 2010. View at Google Scholar - R. E. Stamper, L.-W. Tsai, and G. C. Walsh, “Optimization of a three DOF translational platform for well-conditioned workspace,” in
*Proceedings of the IEEE International Conference on Robotics and Automation*, vol. 4, pp. 3250–3255, Albuquerque, NM, USA, 1997. View at Publisher · View at Google Scholar - X.-J. Liu, J. Wang, K.-K. Oh, and J. Kim, “A new approach to the design of a DELTA robot with a desired workspace,”
*Journal of Intelligent and Robotic Systems*, vol. 39, no. 2, pp. 209–225, 2004. View at Publisher · View at Google Scholar · View at Scopus - P. Wenger and D. Chablat, “Kinematic analysis of a new parallel machine tool: the Orthoglide,” in
*Advances in Robot Kinematics*, J. Lenarčič and M. M. Stanišić, Eds., pp. 305–314, Springer, Amsterdam, The Netherlands, 2000. View at Google Scholar