Dynamic control of a cable-driven humanoid-shoulder joint based on backstepping technique
-
摘要: 针对并联式绳驱动机器人建模困难、控制复杂等问题,采用拉格朗日动力学建模方法,推导得到便于控制器设计的标准动力学方程,考虑绳驱动的冗余特性和绳索的单方向受力性,提出基于最小预紧力的张力分配算法,求解出各绳索的驱动力.针对机器人轨迹跟踪控制问题,设计了基于后推技术的系统模型控制律.仿真结果表明:后推技术法在收敛速度方面明显优于计算力矩法,且各绳索的驱动力皆能满足其张紧所需的最小张力.Abstract: Aiming at the problems that cable-driven parallel manipulator is difficult to create model and control, the dynamic model of the humanoid-shoulder joint was built by using Lagrange dynamics method so as to obtain the standard form of dynamic equation. Taking into account the redundant actuation and single-direction force for the cable, tension distribution algorithm based on the minimum pre-tightening force was proposed to calculate driving force of each cable. Based on backstepping technique, the control law of the system model was designed for the robot trajectory tracking control problem. The results of simulation show backstepping-based control method is superior in convergence speed, and the driving force of each cable is more than the required minimum tension to keep the cable tensional.
-
Key words:
- cable-driven /
- humanoid-shoulder joint /
- dynamic /
- backstepping technique /
- tension distribution
-
[1] 钱锡康.BUAA-RR七自由度机器人机械结构设计[J].北京航空航天大学学报,1998,24(3):354-357 Qian Xikang.Structure design for 7-DOF BUAA-RR manipulator [J].Journal of Beijing University of Aeronautics and Astronautics,1998,24(3):354-357 (in Chinese) [2] Jeong J W,Kim S H,Kwak Y K.Kinematics and workspace analysis of a parallel wire mechanism for measuring a robot pose [J].Mechanism and Machine Theory,1999,34:825-841 [3] Alp A B,Agrawal S K.Cable suspended robots:design,planning and control //Proceedings of IEEE Conf.on Robotics and Automation.Washington,DC,USA:IEEE,2002:4275-4280 [4] Yang Guilin,Lin Wei,Mustafa S K,et al.Kinematic design of a 7-DOF cable-driven humanoid arm:a solution-in nature approach //Proceedings of the International Conference on Advanced Intelligent Mechatronics.California,USA:IEEE,2005:444-449 [5] 陈伟海,陈泉柱,张建斌,等.线驱动拟人臂机器人逆向运动学分析[J].机械工程学报,2007,43(4):12-20 Chen Weihai,Chen Quanzhu,Zhang Jianbin,et al.Inverse kinematic analysis for cable-driven humanoid arm [J].Chinese Journal of Mechanical Engineering,2007,43(4):12-20 (in Chinese) [6] Elizabeth A B,Ying M,Sunil K A,et al.Dynamics and control of a 4-DOF wearable cable-driven upper arm exoskeleton //Proceedings of the International Conference on Robots and Automation.Kobe,Japan:IEEE,2009:2300-2305 [7] 陈泉柱,陈伟海,刘荣,等.具有关节角反馈的绳驱动拟人臂机器人机构设计与张力分析[J].机械工程学报,2010,46(13):83-90 Chen Quanzhu,Chen Weihai,Liu Rong,et al.Mechanism design and tension analysis of a cable-driven humanoid-arm manipulator with joint angle feedback [J].Chinese Journal of Mechanical Engineering,2010,46(13):83-90 (in Chinese) [8] Geng Z,Haynes L S,Lee J D,et al.On the dynamic model and kinematic analysis of a class of stewart platforms [J].Robotics and Autonomous Systems,1992,9(4):237-254 [9] Liu K,Lewis F,Lebret G,et al.The singularities and dynamics of a stewart platform manipulator [J].Journal of Intelligent and Robotic Systems,1993,8(3):287-308 [10] Lebret G,Liu K,Lewis F.Dynamic analysis and control of a stewart platform manipulator [J].Journal of Robotic Systems,1993,10(5):629-655 [11] 理查德·莫雷,李泽湘,夏恩卡·萨斯特里.机器人操作的数学导论[M].北京:机械工业出版社,1998 Murray M,Li Zexiang,Sastry S.A mathematical introduction to robotic manipulator [M].Beijing:Mechanical Industry Press,1998 (in Chinese) [12] Buhler M,Koditschek D E.A prelude to juggling .Conference Presentation:26th IEEE Conference on Decision and Control,Los Angeles,California,USA: ,1987
点击查看大图
计量
- 文章访问数: 1577
- HTML全文浏览量: 133
- PDF下载量: 590
- 被引次数: 0