Hostname: page-component-78c5997874-ndw9j Total loading time: 0 Render date: 2024-11-17T23:30:05.874Z Has data issue: false hasContentIssue false

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

Published online by Cambridge University Press:  02 July 2019

Mingjie Dong
Affiliation:
College of Mechanical Engineering and Applied Electronics Technology, Beijing University of Technology, Beijing, People’sRepublic of China. E-mails: dongmj@bjut.edu.cn; zhangleiyu@bjut.edu.cn
Guodong Yao
Affiliation:
Institute of Electrical Engineering, Chinese Academy of Sciences, Beijing, People’sRepublic of China. E-mail: jellyyao@126.com
Jianfeng Li*
Affiliation:
College of Mechanical Engineering and Applied Electronics Technology, Beijing University of Technology, Beijing, People’sRepublic of China. E-mails: dongmj@bjut.edu.cn; zhangleiyu@bjut.edu.cn
Leiyu Zhang
Affiliation:
College of Mechanical Engineering and Applied Electronics Technology, Beijing University of Technology, Beijing, People’sRepublic of China. E-mails: dongmj@bjut.edu.cn; zhangleiyu@bjut.edu.cn
*
*Corresponding author. E-mail: lijianfeng@bjut.edu.cn

Summary

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.

Type
Articles
Copyright
© Cambridge University Press 2019 

Access options

Get access to the full version of this content by using one of the access options below. (Log in options will check for institutional or personal access. Content may require purchase if you do not have access.)

References

Neubauer, M. and Muller, A., “Smooth Orientation Path Planning with Quaternions Using B-splines,” IEEE/RSJ International Conference on Intelligent Robots and Systems (2015) pp. 20872092.Google Scholar
Lee, H. and Hogan, N., “Energetic passivity of the human ankle joint,IEEE Trans. Neural Syst. Rehabil. Eng. 24(12), 14161425 (2016). A Publication of the IEEE Engineering in Medicine & Biology Society.CrossRefGoogle Scholar
Hussain, S., Jamwal, P. K. and Ghayesh, M. H., “State-of-the-art robotic devices for ankle rehabilitation: Mechanism and control review,Proc. Inst. Mech. Eng. Part H: J. Eng. Med. 231(12), 12241234 (2017).CrossRefGoogle Scholar
Niyetkaliyev, A., Hussain, S., Ghayesh, M. and Alici, G., “Review on design and control aspects of robotic shoulder rehabilitation orthoses,IEEE Trans. Hum.-Mach. Syst. 47(6), 11341145 (2017).CrossRefGoogle Scholar
Or, K., Tomura, M., Schmitz, A., Funabashi, S. and Sugano, S., “Position-Force Combination Control with Passive Flexibility for Versatile In-hand Manipulation Based on Posture Interpolation,” IEEE/RSJ International Conference on Intelligent Robots and Systems (2016).CrossRefGoogle Scholar
Fang, B., Sun, F., Liu, H. and Di, G., “A novel data glove using inertial and magnetic sensors for motion capture and robotic arm-hand teleoperation,Ind. Rob. 44(2), 155165 (2017).CrossRefGoogle Scholar
Biagiotti, L., Moriello, L. and Melchiorri, C., “A repetitive Control Scheme for Industrial Robots Based on B-spline Trajectories,” IEEE/RSJ International Conference on Intelligent Robots and Systems (2015) pp. 54175422.Google Scholar
Ceriani, S., Sanchez, C., Taddei, P., Wolfart, E. and Sequeira, V., “Pose Interpolation Slam for Large Maps Using Moving 3D Sensors,” IEEE/RSJ International Conference on Intelligent Robots and Systems (2015) pp. 750757.Google Scholar
Chang, S. W., Chiang, Y. T. and Chang, F. R., “Slerp-Based Optimal Triad Algorithm,” Proceedings of Sice Conference 2010 (2010) pp. 331335.Google Scholar
Jin-Su, A., Won-Jee, C. and Chang-Doo, J., “Realization of orientation interpolation of 6-axis articulated robot using quaternion,J. Cent. South Univ. 19(12), 34073414 (2012).Google Scholar
Park, J., “Interpolation and Tracking of Rigid Body Orientations,International Conference on Control Automation and Systems (2010) pp. 668673.Google Scholar
Dam, E. B., Koch, M. and Lillholm, M., Quaternions, Interpolation and Animation Technical Report (1998).Google Scholar
Siciliano, B. and Khatib, O., Springer Handbook of Robotics, vol. 56, no. 8 (Springer, Berlin, Heidelberg, 2007) pp. 9871008.Google Scholar
Ken, S., “Animating rotation with quaternion curves,ACM SIGGRAPH Comput. Graphics 19(3), 245254 (1985).Google Scholar
Ge, W., Huang, Z. and Wang, G., Interpolating Solid Orientations with a C 2-Continuous B-Spline Quaternion Curve (Springer, Berlin, Heidelberg, 2007).CrossRefGoogle Scholar
Kong, M. X., Ji, C., Chen, Z. S. and Li, R. F., “Application of Orientation Interpolation of Robot Using Unit Quaternion,” IEEE International Conference on Information and Automation (2014) pp. 384389.Google Scholar
Jiang, X., Barnett, E. and Gosselin, C., “Dynamic point-to-point trajectory planning beyond the static workspace for six-dof cable-suspended parallel robots,IEEE Trans. Rob . 34(3), 781793 (2018).CrossRefGoogle Scholar