Orientation planning in task space using quaternion polynomials

This paper introduces a computationally fast method for orientation trajectory planning in point-to-point motion tasks when the angular velocity and acceleration at the endpoints are constrained. Addressing such a problem with existing spherical-interpolation-based methods (in the context of unit quaternion) is not straightforward, since the inherent complexities of spherical curves necessitate task-specific tunings for satisfying all the boundary conditions. To tackle such a difficulty, we propound an interpolation function on the basis of standard polynomials in time with quaternion coefficients. We introduce a novel algorithm to determine varying polynomial coefficients in a way that the unit length of interpolated quaternion can be guaranteed. The performance of the developed planning algorithms is illustrated through a functional analysis and via simulation experiments on an anthropomorphic robotic arm. The results corroborate the merits of the presented approach especially in respecting arbitrary boundary conditions.

[1]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

[2]  D. Koks,et al.  Explorations in Mathematical Physics: The Concepts Behind an Elegant Language , 2006 .

[3]  F. Park,et al.  Cubic spline algorithms for orientation interpolation , 1999 .

[4]  K. Spring Euler parameters and the use of quaternion algebra in the manipulation of finite rotations: A review , 1986 .

[5]  K. Doty,et al.  On-Line Polynomial Trajectories for Robot Manipulators , 1985 .

[6]  Jörn Malzahn,et al.  Development of a human size and strength compliant bi-manual platform for realistic heavy manipulation tasks , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[7]  G. Oriolo,et al.  Robotics: Modelling, Planning and Control , 2008 .

[8]  Nikolaos G. Tsagarakis,et al.  Inverse dynamics control of bimanual object manipulation using orthogonal decomposition: An analytic approach , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[9]  G. Nielson Smooth Interpolation of Orientations , 1993 .

[10]  Frank Chongwoo Park,et al.  Smooth invariant interpolation of rotations , 1997, TOGS.

[11]  Ken Shoemake,et al.  Animating rotation with quaternion curves , 1985, SIGGRAPH.

[12]  John F. Hughes,et al.  Smooth interpolation of orientations with angular velocity constraints using quaternions , 1992, SIGGRAPH.

[13]  Jun Morimoto,et al.  Orientation in Cartesian space dynamic movement primitives , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[14]  Leiba Rodman,et al.  Topics in Quaternion Linear Algebra , 2014 .

[15]  Jun Nakanishi,et al.  Operational Space Control: A Theoretical and Empirical Comparison , 2008, Int. J. Robotics Res..