基于Udwadia-Kalaba方法的平面冗余并联机器人建模与轨迹跟踪控制

韩江; 汪鹏; 董方方; 夏链; 陈珊; 卢磊

doi:10.21656/1000-0887.400363

基于Udwadia-Kalaba方法的平面冗余并联机器人建模与轨迹跟踪控制

doi: 10.21656/1000-0887.400363

合肥工业大学机械工程学院, 合肥 230009

基金项目: 国家重点研发计划（2018YFB1308400）;国家自然科学基金（51905140）;安徽省科技重大专项（17030901036）

详细信息

作者简介:
韩江（1963—），男，教授,博士生导师(E-mail: jianghan@hfut.edu.cn);汪鹏（1995—），男，硕士生(E-mail: 1549122090@qq.com);董方方（1988—），男，副教授，硕士生导师(通讯作者. E-mail: fangfangdong@hfut.edu.cn).

中图分类号: TH113
计量
- 文章访问数: 1176
- HTML全文浏览量: 215
- PDF下载量: 371
- 被引次数: 0
出版历程
- 收稿日期: 2019-11-29
- 修回日期: 2020-03-01
- 刊出日期: 2020-11-01

Modeling and Control of Planar Redundant Parallel Robots Based on the Udwadia-Kalaba Method

School of Mechanical Engineering, Hefei University of Technology,Hefei 230009, P.R.China

Funds: The National Key R&D Program of China（2018YFB1308400）;The National Natural Science Foundation of China（51905140）

摘要

摘要: 以平面冗余驱动并联机器人为研究对象，利用Udwadia-Kalaba（U-K）方法，将并联机构的物理连接抽象成系统约束，建立了平面2自由度冗余驱动并联机器人的闭链运动方程.首先，将2自由度冗余驱动并联机器人分割成3个无约束开链子系统，子系统的动力学方程由Lagrange法获得；然后，采用运动学约束来描述各子系统和末端执行器、子系统与基座之间的物理连接.对约束进行微分，并转化为二阶Pfaffian标准微分形式，通过应用U-K方程，可以获得满足该物理约束的约束力的解析解.根据U-K理论，将该约束力附加到无约束开链系统方程即可建立平面冗余驱动并联机器人的动力学模型.在轨迹跟踪控制器设计中，将期望的位置或者速度轨迹抽象成虚拟约束，并将约束条件转化为Pfaffian标准微分形式，再通过U-K方程求解各驱动关节满足给定轨迹约束所需要的输出力矩.该方法不需要Lagrange乘子或伪广义速度等辅助变量，并可以同时处理完整约束和非完整约束.数值模拟和分析结果表明，该建模与控制方法能够高效、系统、快速地建立平面2自由度冗余驱动并联机器人的动力学解析解耦模型，实现给定轨迹的高精度跟踪控制.
- Udwadia-Kalaba方法 /
- 冗余驱动 /
- 并联机器人 /
- 动力学建模 /
- 轨迹跟踪控制
Abstract: The redundantly driven parallel robots were considered. The Udwadia-Kalaba (U-K) method was used to formulate the physical connections of the parallel mechanism as system constraints, and the closed-chain motion equations for the planar 2-DOF redundantly driven parallel robot were established. Firstly, the 2-DOF robot was divided into 3 unconstrained open-chain subsystems. The dynamic equations for the subsystems were obtained with the Lagrangian method. Then, the kinematic constraints were used to describe the physical connections between each subsystem and the end effector, and between each subsystem and the base. The constraint was differentiated and transformed into a 2nd-order Pfaffian standard differential form. With the U-K equations, the analytical solution satisfying the physical constraints was given. According to the U-K theory, the constraints can be added to the unconstrained open-chain system equations to establish the dynamics model for the planar redundantly driven parallel robot. In the trajectory tracking controller design, the desired position or velocity trajectory was formulated as a virtual constraint, and the constraint condition was transformed into a standard Pfaffian differential form. Then the U-K equations were used to solve the output torque required for each driving joint to satisfy a given trajectory constraint. This method does not require auxiliary variables such as Lagrangian multipliers or pseudo-generalized speeds, and can handle both holonomic and non-holonomic constraints. The numerical simulation and analysis results show that, the modeling and controlling method can effectively, systematically and quickly establish the dynamic analytical decoupling model for the planar 2-DOF redundantly driven parallel robot, and realize the high-precision tracking control along a given trajectory.
- Udwadia-Kalaba method /
- redundant drive /
- parallel robot /
- dynamics model /
- trajectory tracking control

HTML全文

参考文献(17)

[1]	姜峣, 李铁民, 王立平. 过约束并联机构动力学建模方法[J]. 机械工程学报, 2013,49(17): 123-129.(JIANG Yao, LI Tiemin, WANG Liping. Research on the dynamic model of an over-constrained parallel mechanism[J]. Chinese Journal of Mechanical Engineering,2013,49(17): 123-129.(in Chinese))
[2]	白志富, 韩先国, 陈五一. 基于Lagrange方程三自由度并联机构动力学研究[J]. 北京航空航天大学学报, 2004,30(1): 51-54.(BAI Zhifu, HAN Xianguo, CHEN Wuyi. Study of a 3-DOF parallel manipulator dynamics based on Lagrange’s equation[J]. Journal of Beijing University of Aeronautics and Astronautics,2004,30(1): 51-54.(in Chinese))
[3]	YIU Y K, CHENG H, XIONG Z H, et al. On the dynamics of parallel manipulators[C]//IEEE International Conference on Robotics & Automation.Seoul, 2001.
[4]	CHENG H, YIU Y K, LI Z X. Dynamics and control of redundantly actuated parallel manipulators[J]. IEEE/ASME Transactions on Mechatronics,2003,8(4): 483-491.
[5]	GEIKE T, MCPHEE J. Inverse dynamic analysis of parallel manipulators with full mobility[J]. Mechanism and Machine Theory,2003,38(6): 549-562.
[6]	WU J, WANG J S, WANG L P. Dynamics and control of a planar 3-DOF parallel manipulator with actuation redundancy[J]. Mechanism and Machine Theory,2009,44(4): 835-849.
[7]	WANG L P, WU J, WANG J S. Dynamic formulation of a planar 3-DOF parallel manipulator with actuation redundancy[J]. Robotics and Computer-Integrated Manufacturing,2010,26(1): 67-73.
[8]	张国伟, 宋伟刚. 并联机器人动力学问题的Kane方法[J]. 系统仿真学报, 2004,16(7): 1386-1391.(ZHANG Guowei, SONG Weigang. A Kane formulation for the inverse dynamic of stewart platform manipulator[J]. Journal of System Simulation,2004,16(7): 1386-1391.(in Chinese))
[9]	杨建新, 汪劲松, 郁鼎文. 空间并联机构运动学与动力学逆解的模块化计算方法[J]. 机械工程学报, 2005,41(5): 104-107.(YANG Jianxin, WANG Jingsong, YU Dingwen. Modular calculation method for kinematics and dynamics inverse solution of spatial parallel mechanism[J]. Journal of Mechanical Engineering,2005,41(5): 104-107.(in Chinese))
[10]	李永泉, 宋肇经, 郭菲. 多能域过约束并联机器人系统动力学建模方法[J]. 机械工程学报, 2016,52(21): 17-20.(LI Yongquan, SONG Zhaojing, GUO Fei. Dynamic modeling method for overconstrained multi-energy domain parallel manipulator[J]. Chinese Journal of Mechanical Engineering,2016,52(21): 17-20.(in Chinese))
[11]	李永泉, 单张兵, 王立捷. 4-DOF混联机器人多能域动力学全解模型及试验[J]. 机械工程学报, 2017,53(23): 92-100.(LI Yongquan, SHAN Zhangbing, WANG Lijie. Multi-energy domain dynamic full solution model and experiment for the 4-DOF hybrid robot[J]. Chinese Journal of Mechanical Engineering,2017,53(23): 92-100.(in Chinese))
[12]	UDWADIA F E, KALABA R E. Analytical Dynamics: a New Approach [M]. New York: Cambridge University Press, 1996.
[13]	赵韩, 赵晓敏, 姜建满. 基于Udwadia-Kalaba理论的Hamel嵌入法研究[J]. 应用数学和力学, 2017,38(6): 696-707.(ZHAO Han, ZHAO Xiaoming, JIANG Jianman. Study on Hamel’s embedding method via the Udwadia-Kalaba theory[J]. Applied Mathematics and Mechanics,2017,38(6): 696-707.(in Chinese))
[14]	ZHAO X M, CHEN Y H, ZHAO H. Udwadia-Kalaba equation for constrained mechanical systems: formulation and applications[J]. Chinese Journal of Mechanical Engineering,2018,31(6): 11-24.
[15]	ZHAO H, ZHEN S C, CHEN Y H. Dynamic modeling and simulation of multi-body systems using the Udwadia-Kalaba theory[J]. Chinese Journal of Mechanical Engineering,2013,26(5): 839-850.
[16]	张新荣, CHEN Y H, 平昭琪. 基于Udwadia和Kalaba方程的机械臂轨迹跟踪控制[J]. 长安大学学报(自然科学版), 2014, 34(1): 115-119.(ZHANG Xinrong, CHEN Y H, PING Zhaoqi. Mechanic manipulator tracking control based on Udwadia and Kalaba equation[J]. Journal of Chang’an University (Natural Science Edition),2014, 34(1): 115-119.(in Chinese))
[17]	SUN H, ZHAO H, ZHEN S C, et al. Application of the Udwadia-Kalaba approach to tracking control of mobile robots[J]. Nonlinear Dynamics,2015,83(1/2): 1-12.DOI: 10.1007/s11071-015-2335-3.

施引文献

资源附件(0)

访问统计

点击查看大图

计量

文章访问数: 1176
HTML全文浏览量: 215
PDF下载量: 371
被引次数: 0

姓名
邮箱
手机号码
标题
留言内容
验证码

留言板

基于Udwadia-Kalaba方法的平面冗余并联机器人建模与轨迹跟踪控制

doi: 10.21656/1000-0887.400363

作者简介:
韩江（1963—），男，教授,博士生导师(E-mail: jianghan@hfut.edu.cn);汪鹏（1995—），男，硕士生(E-mail: 1549122090@qq.com);董方方（1988—），男，副教授，硕士生导师(通讯作者. E-mail: fangfangdong@hfut.edu.cn).

计量

Modeling and Control of Planar Redundant Parallel Robots Based on the Udwadia-Kalaba Method

计量

目录

留言板

基于Udwadia-Kalaba方法的平面冗余并联机器人建模与轨迹跟踪控制

doi: 10.21656/1000-0887.400363

作者简介: 韩江（1963—），男，教授,博士生导师(E-mail: jianghan@hfut.edu.cn);汪鹏（1995—），男，硕士生(E-mail: 1549122090@qq.com);董方方（1988—），男，副教授，硕士生导师(通讯作者. E-mail: fangfangdong@hfut.edu.cn).

计量

出版历程

Modeling and Control of Planar Redundant Parallel Robots Based on the Udwadia-Kalaba Method

计量

出版历程

目录

作者简介:
韩江（1963—），男，教授,博士生导师(E-mail: jianghan@hfut.edu.cn);汪鹏（1995—），男，硕士生(E-mail: 1549122090@qq.com);董方方（1988—），男，副教授，硕士生导师(通讯作者. E-mail: fangfangdong@hfut.edu.cn).