Realization of orientation interpolation of 6-axis articulated robot using quaternion

Abstract

In general, the orientation interpolation of industrial robots has been done based on Euler angle system which can result in singular point (so-called Gimbal Lock). However, quaternion interpolation has the advantage of natural (specifically smooth) orientation interpolation without Gimbal Lock. This work presents the application of quaternion interpolation, specifically Spherical Linear IntERPolation (SLERP), to the orientation control of the 6-axis articulated robot (RS2) using LabVIEW® and RecurDyn®. For the comparison of SLERP with linear Euler interpolation in the view of smooth movement (profile) of joint angles (torques), the two methods are dynamically simulated on RS2 by using both LabVIEW® and RecurDyn®. Finally, our original work, specifically the implementation of SLERP and linear Euler interpolation on the actual robot, i.e. RS2, is done using LabVIEW® motion control tool kit. The SLERP orientation control is shown to be effective in terms of smooth joint motion and torque when compared to a conventional (linear) Euler interpolation.

Keywords

quaternion / spherical linear interpolation (SLERP) / Euler angle / linear Euler interpolation / 6-axis articulated robot

References

[1] FuK. S., GonzalezR. C., LeeC. S. G.Robotics: Control, sensing, vision and intelligence [M], 1987New YorkMcGraw-Hill22

[2] HoagD.Apollo guidance and Navigation: Considerations of apollo imu gimbal lock [M], 1963CanbridgeMIT Instrumentation Laboratory1-64

[3] JONES E M, FJELD P. Gimbal Angles, Gimbal Lock, and a Fourth Gimbal for Christmas [EB/OL]. http://www.hq.nasa.gov/office/pao/History/alsj/gimbals.html, 2002.

[4] PURWAR A, JIN Z, GE Q J. Computer aided synthesis of piecewise rational motions for spherical 2R and 3R robot arms [C]// Annual Mechanisms and Robotics Conference, Las Vegas, 2006: 1209–1222.

[5] AHLERS S G, McCARTHY J M. The clifford algebra of double quaternions and the optimization of Ts robot design, applications of clifford algebras in computer science and engineering [M], Birkhauser Inc, 2000.

[6] CHUNG W J, KIM K J, KIM S H. Steering control algorithm of an inter-block locomotion robot using a quaternion with spherical cubic interpolation [J]. Systemics Cybernetics and Informatics 2005: 374–379.

[7] DamE. B., KochM., LillholmM.Quaternions, interpolation and animation. DIKU-TR9815 [R], 1998Copenhagendepartment of Computer Science, University of Copenhagen

[8] AHN J S, CHUNG W J. On design prototype and gain optimization for heavy duty handling articulated manipulator (hdham) with 6 DOF [C]// The 14th World Multi-Conference on Systemics, Cybernetics and Informatics: WMSCI 2010, Orlando, 2010: 174–179.

[9] SpongM., VidyasagarM.Robot dynamics and control [M], 1989HobokenJohn Wiley and Sons20-70

[10] AHN J S, CHUNG W J. A Study on 6-axis articulated robot using a quaternion interpolation [C]// KSMTE of Spring Conference 2010, Seoul, 2010: 294–300.

[11] SHOEMAKE K. Animating rotation with quaternion curves [C]// Proceedings of the 12th Annual Conference on Computer Graphics and Interactive Techniques, San Francisco, 1985: 245–254.

[12] MEBIUS J E. Derivation of the Euler-rodrigues formula for three-dimensional rotations from the general formula for four-dimensional rotations [J]. arXiv General Mathematics, 2007: 0701659vl.