留言板

尊敬的读者、作者、审稿人, 关于本刊的投稿、审稿、编辑和出版的任何问题, 您可以本页添加留言。我们将尽快给您答复。谢谢您的支持!

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

二自由度并联机械手动力学控制方法

闫寒 王浩 张舵 闫学佳 吴明坤 梅江平

闫寒, 王浩, 张舵, 闫学佳, 吴明坤, 梅江平. 二自由度并联机械手动力学控制方法[J]. 机械科学与技术, 2020, 39(1): 1-9. doi: 10.13433/j.cnki.1003-8728.20190073
引用本文: 闫寒, 王浩, 张舵, 闫学佳, 吴明坤, 梅江平. 二自由度并联机械手动力学控制方法[J]. 机械科学与技术, 2020, 39(1): 1-9. doi: 10.13433/j.cnki.1003-8728.20190073
Yan Han, Wang Hao, Zhang Duo, Yan Xuejia, Wu Mingkun, Mei Jiangping. Dynamic Control Method of Parallel Manipulator with two Degrees of Freedom[J]. Mechanical Science and Technology for Aerospace Engineering, 2020, 39(1): 1-9. doi: 10.13433/j.cnki.1003-8728.20190073
Citation: Yan Han, Wang Hao, Zhang Duo, Yan Xuejia, Wu Mingkun, Mei Jiangping. Dynamic Control Method of Parallel Manipulator with two Degrees of Freedom[J]. Mechanical Science and Technology for Aerospace Engineering, 2020, 39(1): 1-9. doi: 10.13433/j.cnki.1003-8728.20190073

二自由度并联机械手动力学控制方法

doi: 10.13433/j.cnki.1003-8728.20190073
基金项目: 

国家科技重大专项项目 2017ZX04013-001

详细信息
    作者简介:

    闫寒(1995-), 硕士研究生, 研究方向为机器人控制及自动化生产线, yh95218@126.com

    通讯作者:

    梅江平, 研究员, 博士生导师, ppm@tju.edu.cn

  • 中图分类号: TP242

Dynamic Control Method of Parallel Manipulator with two Degrees of Freedom

  • 摘要: 本文针对一种二自由度并联机械手高速运动状态下的动力学控制方法展开研究。通过对并联机械手简化刚体动力学模型的建模误差进行溯源分析,提出了一种基于双系数补偿分配策略的建模方法,对机械手的简化刚体动力学模型进行了优化,并基于该简化模型建立了机械手的动力学前馈控制方法。为进一步提高控制过程的鲁棒性,结合H控制方法提出了一种H+动力学前馈的控制方法。在建立机械手整机机电联合仿真系统的基础上,对所提出的两种控制方法进行了详细的仿真和对比。仿真结果表明,本文提出的控制方法可以减少力矩扰动对伺服电机输出带来的影响,大大减小了机械手末端的定位误差,提高了机械手的控制精度。
  • 图  1  Diamond机械手实体造型

    图  2  Diamond机械手简图

    图  3  机械手运行轨迹示意图

    图  4  单抓取周期内从动臂各力学分量变化

    图  5  不同简化方法对比

    图  6  前馈控制原理框图

    图  7  单轴伺服系统控制模型框图

    图  8  闭环反馈系统示意图

    图  9  引入H控制器后的机械手控制框图

    图  10  H控制Simulink仿真结构图

    图  11  PID控制仿真结果

    图  12  PID+前馈控制仿真结果

    图  13  PID+ H控制仿真结果

    图  14  调整增益后PID+ H控制仿真结果

    表  1  公式(2)符号释义表

    符号 含义 表达式
    θ1 主动臂转角 θ1=(θ11   θ12)T
    θ2 从动臂转角 θ2=(θ21   θ22)T
    rdi 从动臂质心位置 rdi=(xdi   ydi)T
    τ 主动关节转矩 τ=(τ1   τ2)T
    动平台质心加速度
    m 动平台总质量 m=mplatform+mload
    IA 主动臂等效到转轴的转动惯量 IA=Iarm+n2Igearbox+mbracketl12
    mArA 主动臂等效到转轴的质径积 mArA=marmrarm+mbracketl12
    τAg 主动臂对其转轴的重力矩 τAg=mArAg(cosθ11   cosθ12)T
    fsi 从动臂连杆的惯性力和重力之和
    Mrodi 从动臂连杆的惯性力矩
    注:Iarm为主动臂自身对其转轴的转动惯量; Igearbox为减速器的转动惯量; n为减速器减速比; marmrarm为主动臂关于其转轴的质径积; mrod, Irod分别为从动臂的质量和相对其主轴坐标系的惯性张量; mbracket, mplatform, mload分别为肘架、动平台和负载的质量。
    下载: 导出CSV

    表  2  机械手参数

    参数 数值
    l1 0.35 m
    l2 0.90 m
    H 0.70 m
    e 0.15 m
    D 1.0 m
    h 0.25 m
    mplatform 0.7 kg
    l1 20:1
    Iarm 0.025 2 kg·m2
    Irod 0.081 5 kg·m2
    Igearbox 0.47×10-4kg·m2
    mload 0.2 kg
    marm 1.285 kg
    mbracket 0.545 kg
    mrod 0.789 kg
    marmrarm 0.146 kg·m
    下载: 导出CSV

    表  3  机械手运动轨迹参数

    轨迹高度H 轨迹长度B 最大加速度amax
    0.1 m 0.8 m 98.1 m/s2
    下载: 导出CSV

    表  4  驱动电机伺服参数

    参数 数值
    电流环比例增益Ki/(V·A-1) 17.28
    电流环积分时间常数Ti/ms 3.6
    逆变器时间常数Tpwm/s 6.25×10-5
    电枢绕组电阻R 1
    电枢绕组电感L/mH 3.6
    力矩常数Kt/(N·m·A-1) 1.55
    等效转动惯量I/(kg·m2) 6×10-4
    反电动势系数Ke/(V·s·rad-1) 0.898
    减速比η 20
    下载: 导出CSV
  • [1] Clavel R. Dispositif pour le deplacement et le positionnement d'un element dans l'espace: Switzerland, CH1985005348856[P]. 1985
    [2] 黄田, 李曚, 李占贤.仅含转动副的二自由度平动并联机器人机构: 中国, CN1355087A[P].2002-06-26

    Huang T, Li M, Li Z X. Two-freedom translational parallel robot mechanism containing only rotating sets: China, CN1355087A[P]. 2002-06-26(in Chinese)
    [3] Huang T, Li Z X, Li M, et al. Conceptual design and dimensional synthesis of a novel 2-DOF translational parallel robot for pick-and-place operations[J]. Journal of Mechanical Design, 2004, 126(3):449-455 doi: 10.1115/1.1711822
    [4] Li Y M, Xu Q S. Kinematics and inverse dynamics analysis for a general 3-PRS spatial parallel mechanism[J]. Robotica, 2005, 23(2):219-229 doi: 10.1017/S0263574704000797
    [5] Codourey A. Dynamic modelling and mass matrix evaluation of the Delta parallel robot for axes decoupling control[C]//Proceedings of 1996 IEEE/RSJ International Conference on Intelligent Robots and Systems. Osaka: IEEE, 1996: 1211-1218 http://www.researchgate.net/publication/3681152_Dynamic_modelling_and_mass_matrix_evaluation_of_the_DELTA_parallelrobot_for_axes_decoupling_control
    [6] Codourey A. Dynamic modeling of parallel robots for computed-torque control implementation[J]. The International Journal of Robotics Research, 1998, 17(2):1325-1336 http://www.wanfangdata.com.cn/details/detail.do?_type=perio&id=10.1177/027836499801701205
    [7] Huang T, Liu S T, Mei J P, et al. Optimal design of a 2-DOF pick-and-place parallel robot using dynamic performance indices and angular constraints[J]. Mechanism and Machine Theory, 2013, 70:246-253 doi: 10.1016/j.mechmachtheory.2013.07.014
    [8] Pierrot F, Benoit M, Dauchez P, et al. High speed control of a parallel robot[C]//IEEE International Workshop on Intelligent Robots and Systems, Towards a New Frontier of Applications. Ibaraki, Japan: IEEE, 1990 https://www.researchgate.net/publication/3496177_High_speed_control_of_a_parallel_robot
    [9] Choi H B, Company O, Pierrot F, et al. Design and control of a novel 4-DOFs parallel robot H4[C]//Proceedings of 2003 IEEE International Conference on Robotics and Automation. Taipei, Taiwan, China: IEEE, 2003: 1185-1191 http://www.researchgate.net/publication/29634313_Design_and_Control_of_a_Novel_4-DOFs_Parallel_Robot_H4
    [10] Choi H B, Konno A, Uchiyama M. Design, implementation, and performance evaluation of a 4-DOF parallel robot[J]. Robotica, 2010, 28(1):107-118 doi: 10.1017/S0263574709005621
    [11] Huang T, Mei J P, Li Z X, et al. A method for estimating servomotor parameters of a parallel robot for rapid pick-and-place operations[J]. Journal of Mechanical Design, 2005, 127(4):596-601 doi: 10.1115/1.1898343
    [12] Zhang L M, Mei J P, Zhao X M, et al. Dimensional synthesis of the delta robot using transmission angle constraints[J]. Robotica, 2011, 30(3):343-349
    [13] 梅江平, 贺莹, 臧家炜, 等.Delta并联机械手刚体动力学模型简化方法[J].机械科学与技术, 2018, 37(3):329-336 doi: 10.13433/j.cnki.1003-8728.2018.0301

    Mei J P, He Y, Zang J W, et al. Simplified method for rigid body dynamic models of delta parallel manipulator[J]. Mechanical Science and Technology for Aerospace Engineering, 2018, 37(3):329-336(in Chinese) doi: 10.13433/j.cnki.1003-8728.2018.0301
    [14] Lee S H, Song J B, Choi W C, et al. Position control of a fast parallel robot[C]//Proceedings of 1995 IEEE International Conference on Robotics and Automation. USA: IEEE, 1995, 1: 1178-1183
    [15] Zames G, Francis B A. Feedback, minimax sensitivity, and optimal robustness[J]. IEEE Transactions on Automatic Control, 1983, 28(5):585-601 doi: 10.1109/TAC.1983.1103275
    [16] 解学书, 钟宜生.H控制理论[M].北京:清华大学出版社, 1994

    Xie X S, Zhong Y S. H-infinity control theory[M]. Beijing:Tsinghua University Press, 1994(in Chinese)
    [17] 吴旭东, 解学书.H鲁棒控制中的加权阵选择[J].清华大学学报, 1997, 37(1):27-30 doi: 10.3321/j.issn:1000-0054.1997.01.001

    Wu X D, Xie X S. Weighting function matrix selection in H robust control[J]. Journal of Tsinghua University, 1997, 37(1):27-30(in Chinese) doi: 10.3321/j.issn:1000-0054.1997.01.001
    [18] Verma M, Jonckheere E A. L-compensation with mixed sensitivity as a broadband matching problem[J]. Systems & Control Letters, 1984, 4(3):125-129 http://www.researchgate.net/publication/222752198_L-compensation_with_mixed_sensitivity_as_a_broadband_matching_problem
  • 加载中
图(14) / 表(4)
计量
  • 文章访问数:  353
  • HTML全文浏览量:  173
  • PDF下载量:  53
  • 被引次数: 0
出版历程
  • 收稿日期:  2018-11-06
  • 刊出日期:  2020-01-05

目录

    /

    返回文章
    返回