华南理工大学学报(自然科学版) ›› 2019, Vol. 47 ›› Issue (2): 1-8.doi: 10.12141/j.issn.1000-565X.180061

• 电子、通信与自动控制 • 上一篇    下一篇

基于旋量理论的蛇形机器人运动学建模

魏武 李艳杰 廖志鹏 张晶    

  1. 华南理工大学 自动化科学与工程学院,广东 广州 510640
  • 收稿日期:2018-02-01 修回日期:2018-06-29 出版日期:2019-02-25 发布日期:2019-01-02
  • 通信作者: 魏武( 1970-) , 男,博士,教授,主要从事机器人控制技术、智能控制技术、模式识别与人工智能研究 E-mail:weiwu@scut.edu.cn
  • 作者简介:魏武( 1970-) , 男,博士,教授,主要从事机器人控制技术、智能控制技术、模式识别与人工智能研究
  • 基金资助:
     国家自然科学基金资助项目( 61573148) ; 广东省科技计划项目( 2016A040403012, 2015B010919007, 2017B090901043) ;广州市科技计划项目( 201604016014, 201604046015) ;广州市高校创新创业教育平台项目( 2017271201) 

Kinematics Modeling of Snakelike Robot Based on Screw Theory
 

 WEI Wu LI Yanjie LIAO Zhipeng ZHANG Jing    

  1.   School of Automation Science and Engineering,South China University of Technology,Guangzhou 510640,Guangdong,China
  • Received:2018-02-01 Revised:2018-06-29 Online:2019-02-25 Published:2019-01-02
  • Contact: 魏武( 1970-) , 男,博士,教授,主要从事机器人控制技术、智能控制技术、模式识别与人工智能研究 E-mail:weiwu@scut.edu.cn
  • About author:魏武( 1970-) , 男,博士,教授,主要从事机器人控制技术、智能控制技术、模式识别与人工智能研究
  • Supported by:
      Supported by the National Natural Science Foundation of China ( 61573148) and the Science and Technology Planning Project of Guangdong Province ( 2016A040403012, 2015B010919007, 2017B090901043) 

摘要: 针对传统的 D-H 参数法需在每个关节上建立局部坐标系、建模过程复杂、几何意 义不明确且求逆解易产生增根等不足,文中对具有关节多、结构冗余度高的蛇形机器人运 动学建模展开研究,提出了基于旋量理论的蛇形机器人运动学建模方法,证明了 D-H 参 数法与基于旋量理论的建模方法的等价性,并基于旋量理论的指数积公式求解了蛇形机 器人的速度雅可比矩阵,建立了蛇形机器人速度模型. 使用 Adams 软件对蛇形机器人进 行运动仿真,测量所得的末端执行器线速度和角速度曲线与 Matlab 计算所得的末端执行 器线速度和角速度曲线一致,结果表明了旋量理论建模方法的正确、简捷和有效性. 

关键词: 蛇形机器人, 旋量理论, 运动学, 雅可比矩阵, 速度模型 

Abstract:  In view of the traditional D-H parameter method has many disadvantages,such as the local coordinate system needs to be established on every joint, the modeling process is complex, the geometric meaning is not clear and the inverse solution leads to the rooting problem, the kinematics modeling of snakelike robot which has many joints and high structural redundancy was studied,and the method of the snakelike robot’s position modeling based on screw theory was proposed. Meanwhile,the equivalence between the D-H parameter method and the screw theory modeling method were proved,and the velocity Jacobi matrices of snakelike robot were solved by using the exponential product formula based on screw theory,establishing the speed model of the snakelike robot. The motion simulation of the snakelike robot was carried out by using Adams software. The measured linear velocity and angular velocity curves of the end effecter are consistent with the linear velocity and angular velocity curves of the end effecter calculated by Matlab. The results show that screw theory modeling method is correct, simple and effective. 

Key words: snakelike robot, screw theory, kinematics, Jacobian matrices, speed model

中图分类号: