Smooth Orientation Planner for Manipulators Based on Quaternion and B-spline

LIU Song-guo,ZHU Shi-qiang,WANG Xuan-yin,WANG Hui-fang

DOI: https://doi.org/10.3785/j.issn.1008-973x.2009.07.004

2009-01-01

Abstract:A smooth orientation planner for manipulators was proposed to accomplish smooth orientation adjustment. Quaternion was adopted to represent orientation instead of the traditional homogeneous matrix, and conversion of them was deduced. The smooth orientation trajectory was generated by interpolating key orientations with the spherical spline quaternion interpolation method, and key joint positions were solved with the inverse kinematics algorithm according to discrete orientations sampled with specific positioning accuracy of the end-effect, and then smooth joint trajectories with stable start-stop motion and continuous jerk were obtained through interpolating key joint positions with B-spline of five degrees. Experimental results showed that, the proposed orientation planner supplied manipulators with smooth adjustment of orientation and stable movement of joints, as well as enhancement of trajectory tracking accuracy, which made it an effective solution for the smooth orientation planning problem of manipulators.