计算机集成制造系统 ›› 2016, Vol. 22 ›› Issue (第10期): 2434-2441.DOI: 10.13196/j.cims.2016.10.018

• 产品创新开发技术 • 上一篇    下一篇

基于Lagrange方程的3RPS/UPS冗余驱动并联机构柔顺控制

崔学良1,陈五一2,韩先国2,祝锡晶1,王建青1,成全1   

  1. 1.中北大学机械与动力工程学院
    2.北京航空航天大学机械工程及自动化学院
  • 出版日期:2016-10-31 发布日期:2016-10-31
  • 基金资助:
    国家自然科学基金资助项目(51275490)。

Active compliant control strategy of 3RPS/UPS parallel machine with redundant actuating leg based on lagrange equation

  • Online:2016-10-31 Published:2016-10-31
  • Supported by:
    Project supported by the National Natural Science Foundation,China(No.51275490).

摘要: 并联机构增加冗余驱动支链可提高其力学和运动学性能,但增加了其控制复杂程度。为实现冗余驱动并联机构的有效控制,推导了3RPS/UPS冗余驱动并联机构各支链的运动协调性方程。基于虚功原理,推导了3RPS并联机构Lagrange动力学方程,由此建立了机构的鲁棒性轨迹跟踪控制模型。确立了冗余驱动支链的动力学方程,由此建立其目标阻抗控制模型。采用模糊PID控制策略对冗余驱动支链目标阻抗模型进行实时内力跟踪,保证支链的内力控制在合理范围之内,实现了对冗余驱动并联机构的柔顺性控制。通过仿真分析验证了控制策略的有效性。

关键词: 冗余驱动, 运动协调方程, 鲁棒性轨迹跟踪, 柔顺性控制

Abstract: The equations of kinematical compatibility between redundant actuating leg and non-redundant actuating legs of 3RPS/UPS PKM were deduced.Based on the principle of virtual work,Lagrange dynamical equation of 3RPS PKM was derived,consequently the robust trajectory tracking control model was established.The dynamical equation of redundant actuating leg was presented,and the target impedance control model was built up.By using the fuzzy PID method,the appropriate force working on the redundant actuating leg was automatically tracked,so that the internal force of machine was maintained within a reasonable range,and the compliant control strategy of redundantly actuating leg was implemented.The availability of the compliance control model was verified through simulation analysis.

Key words: redundant actuation, kinematical compatible equation, robust trajectory tracking, compliance control

中图分类号: