• CN:11-2187/TH
  • ISSN:0577-6686

机械工程学报 ›› 2015, Vol. 51 ›› Issue (13): 203-211.doi: 10.3901/JME.2015.13.203

• 机构学及机器人学研究进展——纪念张启先院士诞辰九十周年专辑 • 上一篇    下一篇

平面4自由度欠驱动机器人的位置和姿态控制

余跃庆, 梁浩, 张卓   

  1. 北京工业大学机械工程与应用电子技术学院
  • 出版日期:2015-07-05 发布日期:2015-07-05
  • 基金资助:
    国家自然科学基金(50875002, 51175006)和高校博士点基金资助课题(20111103110002)资助项目

Position and Orientation Control of a 4-DOF Planar Underactuated Robot

YU Yueqing, LIANG Hao, ZHANG Zhuo   

  1. College of Mechanical Engineering and Applied Electronics Technology, Beijing University of Technology
  • Online:2015-07-05 Published:2015-07-05

摘要: 基于模糊控制理论,研究水平运动的4自由度欠驱动机器人位置和姿态控制问题。平面4自由度欠驱动机器人是具有冗余度和欠驱动双重特征的复杂二阶非完整系统,利用主动关节和被动关节加速度之间的耦合作用控制被动关节的运动,同时实现机械臂末端的轨迹跟踪和末杆的姿态控制。根据分层控制思想,提出双模态模糊PID复合控制算法,针对两个子任务分别设计控制器。通过Matlab和ADAMS的联合仿真验证算法的有效性,在基于可编程多轴运动控制卡的试验台上实现平面4自由度欠驱动机器人的位置和姿态控制试验。仿真和试验结果表明,所设计的模糊PID复合控制器对平面4自由度欠驱动机器人末杆的位置和姿态控制是可行、有效的。

关键词: 4自由度, 模糊控制, 欠驱动机器人, 位置和姿态控制

Abstract: Based on the fuzzy control theory, the position and orientation control of a 4-DOF planar underactuated robot is investigated. The 4-DOF planar underactuated robot is a complex second order non-holonomic system with redundancy and underactuation. Using the coupling effect between the acceleration of passive joint and that of active joints, the motion of the passive joint is controlled. The trajectory tracking of end point and the orientation control of end link of robot are achieved simultaneously. A double fuzzy-PID compound controller is designed for the two subtasks based on the hierarchical control idea. The controller is verified by the co-simulation in Matlab and ADAMS. The experiment of the position and orientation control of the 4-DOF planar underactuated robot is realized on the experimental test bed based on PMAC controller. The results of simulation and experiment indicate that the fuzzy-PID compound controller is feasible and effective for the position and orientation control of 4R horizontal underactuated robot.

Key words: 4-DOF, fuzzy control, position and orientation control, underactuated robot

中图分类号: