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

›› 2014, Vol. 50 ›› Issue (13): 22-34.

• 论文 • 上一篇    下一篇

扫码分享

WT轮椅机器人攀爬楼梯过程动力学建模与控制

王剑;王挺;姚辰;李小凡;吴成东   

  1. 中国科学院沈阳自动化研究所机器人学国家重点实验室;中国科学院大学;东北大学信息科学与工程学院
  • 发布日期:2014-07-05

Dynamic Modeling and Control for WT Wheelchair Robot during the Stair-climbing Process

WANG Jian;WANG Ting;YAO Chen;LI Xiaofan;WU Chengdong   

  1. State Key Laboratory of Robotics, Shenyang Institute of Automation, Chinese Academy of Sciences; University of Chinese Academy of Sciences; School of Information Science & Engineering, Northeastern University
  • Published:2014-07-05

摘要: 分析出WT轮椅机器人与楼梯环境相互作用的特点,归纳出攀爬过程中轮椅机器人可能出现的模式和确定所处模式的判据。针对WT轮椅机器人较复杂且带有完整约束的混联机构,提出了具有对称的独立广义坐标和对称的完整约束的机构化简定理和一种设计完整或非完整机器人系统控制律的思路,给出了WT轮椅机器人在攀爬楼梯过程中各模式下的Lagrange动力学方程以及保持轮椅座椅水平的各关节广义坐标的规划轨迹,并结合计算力矩法设计出WT轮椅机器人的主动张紧力控制,即在对各关节变量参考输入曲线跟踪的同时,实现了对完整约束的约束反力参考输入曲线的跟踪。最后应用Matlab中的STATEFLOW模块对WT轮椅机器人攀爬楼梯过程的动力学模型和控制律进行仿真,并通过样机试验验证其有效性。

关键词: 轮椅机器人;楼梯攀爬;完整系统;动力学;控制律

Abstract: The characteristics of interaction between WT wheelchair robot and stair environments is analyzed and possible patterns of WT wheelchair robot during the stair-climbing process are summarized, with the criterion to determine the pattern of the wheelchair robot proposed. Aiming at wheelchair robot^s complicated hybrid mechanism with holonomic constraints, the theorems of simplification for the mechanism with symmetric independent generalized coordinates and symmetric holonomic constraints are proposed, as well as a novel control law designed for holonomic or nonholonomic robot systems. The Lagrange equation of WT wheelchair robot in each pattern during the stair-climbing process and the generalized coordinate curve of each joint when keeping wheelchair^s seat horizontal are obtained. Combined with the computed torque method, a so called active tension control law for WT wheelchair robot, which can track the reference input curve of holonomic constraint force when tracking reference input curve of each joint, is obtained. STATEFLOW module in Matlab is used to simulate the whole stair-climbing process for WT wheelchair robot. Finally, there is an experiment verifying the dynamic model and the control law.

Key words: wheelchair robot;stair-climbing process;holonomic system;dynamics;control law

中图分类号: