并联机器人逆动力学建模的几何代数方法

doi:10.3901/JME.2022.07.001

机械工程学报 ›› 2022, Vol. 58 ›› Issue (7): 1-11.doi: 10.3901/JME.2022.07.001

• 机器人及机构学 • 下一篇

扫码分享

并联机器人逆动力学建模的几何代数方法

徐灵敏^1,2, 叶伟², 李秦川²

1. 上海交通大学机械系统与振动国家重点实验室上海 200240;2. 浙江理工大学机械与自动控制学院杭州 310018

收稿日期:2021-09-26 修回日期:2022-01-18 出版日期:2022-04-05 发布日期:2022-05-20
通讯作者: 李秦川(通信作者),男,1975年出生,博士,教授。主要研究方向为并联机器人机构学和应用技术。E-mail:lqchuan@zstu.edu.cn
作者简介:徐灵敏,男,1993年出生,博士,博士后。主要研究方向为并联机器人运动学和动力学分析。E-mail:lmxu93@sjtu.edu.cn;叶伟,男,1988年出生,博士,副教授。主要研究方向为并联机器人机构学。E-mail:wye@zstu.edu.cn
基金资助:
国家自然科学基金(51935010)和中国博士后科学基金(2021M702123)资助项目

Geometric Algebra-based Method for Inverse Dynamic Modeling of Parallel Robots

XU Lingmin^1,2, YE Wei², LI Qinchuan²

1. State Key Laboratory of Mechanical Systems and Vibration, Shanghai Jiao Tong University, Shanghai 200240;2. Faculty of Mechanical Engineering and Automation, Zhejiang Sci-Tech University, Hangzhou 310018

Received:2021-09-26 Revised:2022-01-18 Online:2022-04-05 Published:2022-05-20

摘要/Abstract

摘要： 逆动力学建模是并联机器人动力学性能评估和实际控制的基础。以几何代数为数学工具，提出并联机器人的解析逆动力学建模通用方法。根据几何代数的外积性质，可直接确定并联机器人中各分支的关节速度和加速度幅值，建立机器人驱动速度和被动速度之间的映射关系，并推导出并联机器人分支中各杆件的速度和加速度。结合虚功原理建立并联机器人的逆动力学模型，并确定驱动力/力矩的解析表达式。关节速度和加速度计算不需要判断几何关系、进行求导或求偏微分，并且整个计算过程中仅涉及加法和乘法，无需求解符号线性方程组，提高计算效率。以六自由度并联机器人6-UPS和三自由度并联机器人2PUR-PRU为例(U：虎克铰，P：移动副，S：球铰，R：转动副)，得到在给定轨迹下两个机器人驱动力的理论结果，通过与ADAMS软件仿真结果对比验证所提方法的正确性。同时，通过与基于牛顿-欧拉方程的自然正交补法进行计算效率对比，证明该方法具有计算高效的优点，可替代ADAMS仿真和原先方法用于并联机器人逆动力学建模及分析。

关键词: 动力学建模, 并联机器人, 几何代数, 虚功原理

Abstract: Inverse dynamic modeling is the basis of dynamic performance evaluation and actual control of parallel robots. Using geometric algebra as a mathematical tool, a general method for the analytical inverse dynamic modeling of parallel robots is proposed. Based on the property of outer product, the intensities of velocities and accelerations of joints in the limbs can be directly determined, and then the mapping relationship between the actuated and passive velocities of robots is developed, followed by the derivation of velocities and accelerations of centers of mass of links. Combined with the principle of virtual work, the inverse dynamic modeling of parallel robots can be established, and then analytical expressions of actuated forces/torques can be obtained. No judgment of geometric relations, and no derivations or partial derivations are involved in the calculation of joint velocities and accelerations. In addition, only the addition and multiplication are involved in the whole calculation process, and there is no need to solve the symbolic linear equations, which significantly improves the calculation efficiency. Taken two parallel robots, 6-UPS with six degrees of freedom (DOFs) and 2PUR-PRU with three DOFs (where U denotes a universal joint, P denotes a prismatic joint, S denotes a spherical joint, and R denotes a revolute joint), as examples, the actuated forces of two parallel robots in the given trajectories can be obtained, and the correctness of the proposed theoretical method is verified by the simulations of ADAMS software. Meantime, by comparing the calculation efficiency with the natural orthogonal complement method based on the Newton-Euler equation, it is proved that the proposed method has the advantage of high efficiency, and can be chosen as an alternative to ADAMS simulation and original theoretical methods for the inverse dynamic modeling and analysis of parallel robots.

Key words: dynamic modeling, parallel robot, geometric algebra, principle of virtual work

中图分类号:

TG156

徐灵敏, 叶伟, 李秦川. 并联机器人逆动力学建模的几何代数方法[J]. 机械工程学报, 2022, 58(7): 1-11.

XU Lingmin, YE Wei, LI Qinchuan. Geometric Algebra-based Method for Inverse Dynamic Modeling of Parallel Robots[J]. Journal of Mechanical Engineering, 2022, 58(7): 1-11.

参考文献

[1] DASGUPTA B,MRUTHYUNJAYA T S. A Newton-Euler formulation for the inverse dynamics of the Stewart platform manipulator[J]. Mechanism and Machine Theory,1998,33(8):1135-1152.
[2] DONG Chenlin,LIU Haitao,XIAO Juliang,et al. Dynamic modeling and design of a 5-DOF hybrid robot for machining[J]. Mechanism and Machine Theory,2021,165:104438.
[3] XU Lingmin,CHAI Xinxue,LI Qinchuan,et al. Design and experimental investigation of a new 2R1T overconstrained parallel kinematic machine with actuation redundancy[J]. Journal of Mechanisms and Robotics,2019,11(3):031016.
[4] SHEN Xudong,XU Lingmin,LI Qinchuan. Motion/force constraint indices of redundantly actuated parallel manipulators with over constraints[J]. Mechanism and Machine Theory,2021,165:104427.
[5] SICILIANO B,KHATIB O. Springer handbook of robotics[M]. Berlin,Heidelberg:Springer,2016.
[6] CHEN Genliang,YU Weidong,LI Qinchuan,et al. Dynamic modeling and performance analysis of the 3-PRRU 1T2R parallel manipulator without parasitic motion[J]. Nonlinear Dynamics,2017,90(1):339-353.
[7] CHEN Miao,ZHANG Qing,QIN Xianrong,et al. Kinematic,dynamic,and performance analysis of a new 3-DOF over-constrained parallel mechanism without parasitic motion[J]. Mechanism and Machine Theory,2021,162:104365.
[8] CHEN Zhengsheng,XU Lingmin,ZHANG Weizhong,et al. Closed-form dynamic modeling and performance analysis of an over-constrained 2PUR-PSR parallel manipulator with parasitic motions[J]. Nonlinear Dynamics,2019,96:517-534.
[9] 刘善增,余跃庆,侣国宁,等. 3自由度并联机器人的运动学与动力学分析[J]. 机械工程学报,2009,45(8):11-17. LIU Shanzeng,YU Yueqing,SI Guoning,et al. Kinematic and dynamic analysis of a three-degree-of-freedom parallel manipulator[J]. Journal of Mechanical Engineering,2009,45(8):11-17.
[10] LI Yanbiao,ZHENG Huang,CHEN Bo,et al. Dynamic modeling and analysis of 5-PSS/UPU parallel mechanism with elastically active branched chains[J]. Chinese Journal of Mechanical Engineering,2020,33:118-129.
[11] YAO Jiantao,GU Weidong,FENG Zongqiang,et al. Dynamic analysis and driving force optimization of a 5-DOF parallel manipulator with redundant actuation[J]. Robotics and Computer-Integrated Manufacturing,2017,48:51-58.
[12] LIU Haitao,MEI Jiangping,ZHAO Xueman,et al. Inverse dynamics and servomotor parameter estimation of a 2-DOF spherical parallel mechanism[J]. Science in China Series E-Technological Sciences,2008,51(3):288-301.
[13] WU Jun,WANG Jinsong,WANG Liping. Identification of dynamic parameter of a 3DOF parallel manipulator with actuation redundancy[J]. Journal of Manufacturing Science and Engineering,2008,130(4):041012.
[14] ZHANG Huizhen,CHANG Gang,SHAN Xianlei,et al. Singularity-free path optimization of the parallel test mechanism for artificial hip joints[J]. Journal of Mechanical Science and Technology,2018,32(4):1775-1786.
[15] GALLARDO J,RICO J M,FRISOLI A,et al. Dynamics of parallel manipulators by means of screw theory[J]. Mechanism and Machine Theory,2003,38(11):1113-1131.
[16] GALLARDO J,RODRÍGUEZ R,DELOSSANTOS P. Kinematics and dynamics of a 4-PRUR Schönflies parallel manipulator by means of screw theory and the principle of virtual work[J]. Mechanism and Machine Theory,2018,122:347-360.
[17] HESTENSE D. New foundations for classical mechanics[M]. 2nd ed. New York:Kluwer Academic Publishers,1999.
[18] LI Qinchuan,CHAI Xinxue,XIANG Jinan. Mobility analysis of limited-degrees-of-freedom parallel mechanisms in the framework of geometric algebra[J]. Journal of Mechanism and Robotics,2017,8(4):041005.
[19] XU Lingmin,LI Qinchuan,TONG Junhua,et al. Tex3:An 2R1T parallel manipulator with minimum DOF of joints and fixed linear actuators[J]. International Journal of Precision Engineering and Manufacturing,2018,19(2):227-238.
[20] HUANG Zhen,LI Qinchuan. Type synthesis of symmetrical lower mobility parallel mechanisms using the constraint-synthesis method[J]. International Journal of Robotics Research,2017,22(1):59-79.
[21] HESTENSE D,LI Hongbo,ROCKWOOD A. New algebraic tools for classical geometry[M]. Heidelberg:Springer,2001.
[22] PERWASS C. Geometric algebra with applications in engineering[M]. Heidelberg:Springer,2009.
[23] ANGELES J,LEE S K. The formulation of dynamical equations of holonomic mechanical systems using a natural orthogonal complement[J]. Journal of Applied Mechanics,1988,55(1):243-244.

并联机器人逆动力学建模的几何代数方法

Geometric Algebra-based Method for Inverse Dynamic Modeling of Parallel Robots

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	张俊, 吴成阳, 方汉良, 孙载超, 王凯龙, 汤腾飞. Z4型冗余驱动并联操作器的驱动特性研究[J]. 机械工程学报, 2024, 60(7): 66-78.
[2]	商德勇, 黄欣怡, 黄云山, 张天佑. 基于Kane方程的Delta并联机器人刚柔耦合动力学研究[J]. 机械工程学报, 2024, 60(7): 124-133.
[3]	商德勇, 黄云山, 黄欣怡, 潘崭. 基于奇异摄动的刚柔耦合Delta机器人非线性混合控制[J]. 机械工程学报, 2024, 60(5): 95-106.
[4]	王敏, 孙景健, 丁基恒, 孙翊, 彭艳, 蒲华燕, 罗均, 谢少荣. 基于D-H参数与拉格朗日联立方程的仿生水蛇机器人运动学分析及动力学建模[J]. 机械工程学报, 2024, 60(15): 134-148.
[5]	王明昊, 汪满新. 一种新型五自由度混联机器人动力学建模与性能评价[J]. 机械工程学报, 2023, 59(9): 63-75.
[6]	赵睿英, 余进, CHEN Y H, 冯艳丽, 曹学鹏. 机械系统动力学Rosenberg嵌入法的扩展与解耦：一阶约束与二阶约束的整合[J]. 机械工程学报, 2023, 59(9): 101-115.
[7]	褚宏鹏, 祁柏, 王慧奇, 邱雪松, 周玉林. 六自由度轮式并联机器人及其构型方法[J]. 机械工程学报, 2023, 59(3): 46-53.
[8]	张英, 冯征征, 李剑, 魏世民, 廖启征. 基于CGA的7自由度冗余机械臂逆运动学臂型角参数化方法[J]. 机械工程学报, 2023, 59(23): 68-75.
[9]	朱子俊, 朱祥龙, 董志刚, 康仁科, 鲍岩. 磨削加工颤振稳定性研究综述[J]. 机械工程学报, 2023, 59(21): 15-33.
[10]	于曰伟, 赵雷雷, 谭迪, 周长城. 考虑牵引电机振动的列车-轨道系统垂向耦合动力学分析[J]. 机械工程学报, 2023, 59(16): 379-389.
[11]	马光同, 曾靖淞, 冯丕极, 闫兆盈, 张伟海. 超导电动磁悬浮列车次级悬挂混合阻尼半主动减振控制研究[J]. 机械工程学报, 2023, 59(10): 236-249.
[12]	徐向阳, 李龙, 任博, 朱才朝. 空间轴交角人字行星齿轮系统动态特性研究[J]. 机械工程学报, 2023, 59(1): 141-150.
[13]	卢浩, 郭士杰, 杨志强, 陈力, 邓飞, 王洪波. 2R耦合驱动关节动力学建模与参数辨识[J]. 机械工程学报, 2022, 58(23): 51-64.
[14]	胡波, 高俊林, 霍焱, 张达, 曾达幸, 卢文娟. 基于共形几何代数的两种6自由度串并混联机构位置逆解分析[J]. 机械工程学报, 2022, 58(21): 60-68.
[15]	雷声, 毛宽民, 田微, 孔德龙. 基于模型修正的螺栓结合部虚拟材料参数识别及应用[J]. 机械工程学报, 2022, 58(21): 274-284.