基于倍矩阵的1P5R串联机械手逆运动学分析

doi:10.13190/j.jbupt.2021-098

北京邮电大学学报 ›› 2022, Vol. 45 ›› Issue (1): 33-38.doi: 10.13190/j.jbupt.2021-098

基于倍矩阵的1P5R串联机械手逆运动学分析

张英, 黄起能, 魏世民, 廖启征

北京邮电大学现代邮政学院, 北京 100876

收稿日期:2021-05-24 出版日期:2022-02-28 发布日期:2021-12-16
作者简介:张英(1987—),女,副教授,硕士生导师,邮箱:graduate_yingzh@bupt.edu.cn
基金资助:
国家自然科学基金项目（51605036）

The Inverse Kinematic Analysis of Spatial 1P5R Serial Manipulators Based on The Double Matrix

ZHANG Ying, HUANG Qineng, WEI Shimin, LIAO Qizheng

School of Modern Post, Beijing University of Posts and Telecommunications, Beijing 100876, China

Received:2021-05-24 Online:2022-02-28 Published:2021-12-16

摘要/Abstract

摘要： 将倍矩阵引入到串联机械手运动学分析的建模中，结合四维旋转矩阵，提出了一种空间1P5R串联机械手逆运动学分析的新方法。基于倍矩阵和四维旋转矩阵对空间1P5R串联机械手进行运动学建模，直接得到14个逆运动学约束方程；将14个方程通过线性消元和Sylvester结式消元，得到只含1个关节变量的一元16次方程。通过数字实例求解和SolidWorks软件仿真验证了所提方法的正确性。所提方法最大的优势在于可直接获得14个逆运动学约束方程，不需要进行矢量运算或者投影等，为空间其他串联机械手的逆运动学建模提供了一种新思路。

关键词: 1P5R串联机械手, 逆运动学分析, 倍矩阵, 四维旋转矩阵, Sylvester结式消元

Abstract: Introducing the double-matrix into the kinematic analysis of serial manipulators, and combined with the four-dimensional rotation matrix, a novel method for the inverse kinematic analysis of spatial 1P5R serial manipulators is proposed. Fourteen kinematic constraint equations for the inverse kinematic analysis are readily obtained by applying the proposed method. A univariate 16th-degree polynomial equation is derived by the linear elimination and Sylvester resultant elimination from the aforementioned fourteen equations. A numerical example and the corresponding 3D configuration based on SolidWorks are provided to verify the correctness. A signficant advantage of the proposed method lies in that 14 inverse kinematic constraint equations can be readily obtained without vector operation and projection operation, and it also provides a new insight for the modeling to the inverse kinematic analysis of other serial manipulators.

Key words: 1P5R serial manipulators, inverse kinematic analysis, double matrix, 4D rotation matrix, Sylvester resultant

中图分类号:

TH112.1

张英, 黄起能, 魏世民, 廖启征. 基于倍矩阵的1P5R串联机械手逆运动学分析[J]. 北京邮电大学学报, 2022, 45(1): 33-38.

ZHANG Ying, HUANG Qineng, WEI Shimin, LIAO Qizheng. The Inverse Kinematic Analysis of Spatial 1P5R Serial Manipulators Based on The Double Matrix[J]. Journal of Beijing University of Posts and Telecommunications, 2022, 45(1): 33-38.

参考文献

[1] LENG S, WU K, JU H H. A survey of kinematics mode-ling and solving methods of manipulator[J]. Journal of Astronautics, 2019, 40(11):1262-1273. 冷舒, 吴克, 居鹤华. 机械臂运动学建模及解算方法综述[J]. 宇航学报, 2019, 40(11):1262-1273.
[2] DENAVIT J, HARTENBERG R S. A kinematic notation for lower-pair mechanisms based on matrices[J]. Journal of Applied Mechanics, 1955, 22:215-221.
[3] MURRAY R M, LI Z, SASTRY S S, et al. A mathema-tical introduction to robotic manipulation[M]. Boca Raton:CRC Press, 1994.
[4] PARK F C. Computational aspects of the product-of-exponentials formula for robot kinematics[J]. IEEE Transactions on Automatic Control, 1994, 39(3):643-647.
[5] YANG A T. Displacement analysis of spatial five link mechanism using 3×3 matrices with dual number elements[J]. ASME Journal of Engineering for Industry, 1969, 91(1):152-156.
[6] 廖启征. 空间机构(无球面副)位移分析的酉交矩阵法[D]. 北京:北京航空航天大学, 1987.
[7] GAN D M, LIAO Q Z, WEI S M, et al. Dual quater-nion-based inverse kinematics of the general spatial 7R mechanism[J]. Proceedings of the Institution of Mechani-cal Engineers-Part C:Journal of Mechanical Engineering Science, 2008, 222(8):1593-1598.
[8] QIAO S G, LIAO Q Z, WEI S M, et al. Inverse kinematic analysis of the general 6R serial manipulators based on double quaternions[J]. Mechanism and Machine Theory, 2010, 45(2):193-199.
[9] HUSTY M L, PFURNER M, SCHROCKER H P. A new and efficient algorithm for the inverse kinematics of a general serial 6R manipulator[J]. Mechanism and Machine Theory, 2007, 42(1):66-81.
[10] HUANG X G, LIU C C, HUANG X, et al. Displacement analysis of spatial linkage mechanisms based on conformal geometric algebra[J]. Journal of Mechanical Engineering, 2021, 57(9):39-50. 黄昔光, 刘聪聪, 黄旭, 等. 空间连杆机构位移分析的共形几何代数方法[J]. 机械工程学报, 2021, 57(9):39-50.
[11] RAGHAVAN M, ROTH B. Inverse kinematics of the general 6R manipulator and related linkages[J]. Journal of Mechanical Design, 1990, 115(3):228-235.
[12] KONLI D, OSVATIC M. Inverse kinematics of general 6R and 5R, P serial manipulators[J]. Journal of Mechanical Design, 1993, 115(4):922-931.
[13] YU Y Q, LIAO Q Z. An algorithm on inverse kinema-tics of 1P5R surgical robot[J]. Journal of Beijing University of Posts and Telecommunications, 2004, 27(5):31-35. 于艳秋, 廖启征. 1P5R医用机器人的反解算法研究[J]. 北京邮电大学学报, 2004, 27(5):31-35.
[14] 黄起能. 基于倍矢量和倍矩阵的机构运动学分析研究[D]. 北京:北京邮电大学, 2021.

基于倍矩阵的1P5R串联机械手逆运动学分析

The Inverse Kinematic Analysis of Spatial 1P5R Serial Manipulators Based on The Double Matrix

RichHTML

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 1

编辑推荐

Metrics

本文评价