Research on Attitude Interpolation and Tracking Control Based on Improved Orientation Vector SLERP Method

In order to make the end of the three-axis platform follow the control command and achieve stable control of the end attitude, an improved orientation vector spherical linear interpolation (SLERP) method is proposed for the requirements, which specifically handles the position of the gimbal lock, so that the platform can move smoothly around the gimbal lock position. A three-axis platform with a camera at the end is set up for the validity of the proposed algorithm. At first, an adaptive speed measurement method based on incremental encoder is introduced, which can automatically adapt to high and low speed, and estimate the ultra-low speed to realize the speed measurement of large dynamic range, and this is used for the motion control of the three-axis platform. Then, the SLERP method for the quaternion interpolation on the starting and ending attitudes represented in quaternion is introduced in detail, and it is continuously improved in response to its existing problems for the platform. Finally, an orientation vector SLERP method is proposed, which uses viscosity factor and rejection factor to adjust the algorithm near the platform’s gimbal lock position. A tracking experiment was designed using the red ball as the following target detected by the designed target tracking algorithm using the camera, which verified the effectiveness of the attitude tracking control based on the proposed improved orientation vector SLERP.

[1]  Prashant K Jamwal,et al.  State-of-the-art robotic devices for ankle rehabilitation: Mechanism and control review , 2017, Proceedings of the Institution of Mechanical Engineers. Part H, Journal of engineering in medicine.

[2]  W. Chung,et al.  Realization of orientation interpolation of 6-axis articulated robot using quaternion , 2012 .

[3]  Hyunglae Lee,et al.  Energetic Passivity of the Human Ankle Joint , 2016, IEEE Transactions on Neural Systems and Rehabilitation Engineering.

[4]  Chen Ji,et al.  Application of orientation interpolation of robot using unit quaternion , 2013, 2013 IEEE International Conference on Information and Automation (ICIA).

[5]  Fuchun Sun,et al.  A novel data glove using inertial and magnetic sensors for motion capture and robotic arm-hand teleoperation , 2017, Ind. Robot.

[6]  Clément Gosselin,et al.  Dynamic Point-to-Point Trajectory Planning Beyond the Static Workspace for Six-DOF Cable-Suspended Parallel Robots , 2018, IEEE Transactions on Robotics.

[7]  Zhangjin Huang,et al.  Interpolating Solid Orientations with a C 2-Continuous B-Spline Quaternion Curve , 2007, Edutainment.

[8]  Claudio Melchiorri,et al.  A repetitive control scheme for industrial robots based on b-spline trajectories , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[9]  Shigeki Sugano,et al.  Position-force combination control with passive flexibility for versatile in-hand manipulation based on posture interpolation , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[10]  Gursel Alici,et al.  Review on Design and Control Aspects of Robotic Shoulder Rehabilitation Orthoses , 2017, IEEE Transactions on Human-Machine Systems.

[11]  ShoemakeKen.  Animating rotation with quaternion curves , 1985 .

[12]  Erik B. Dam,et al.  Quaternions, Interpolation and Animation , 2000 .

[13]  Andreas Müller,et al.  Smooth orientation path planning with quaternions using B-splines , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[14]  Fan-Ren Chang,et al.  SLERP-based optimal TRIAD algorithm , 2010, Proceedings of SICE Annual Conference 2010.

[15]  Oussama Khatib,et al.  Springer Handbook of Robotics , 2007, Springer Handbooks.