蛇形管道机器人设计与轨迹跟踪算法实现
Design of Snake Robot in Pipeline and Implementation of Trajectory Tracking Algorithm
于阳光 1吉爱红 1邱镓辉 1刘亚红 1秦国栋1
作者信息
- 1. 南京航空航天大学 机电学院,江苏 南京 210016
- 折叠
摘要
蛇形机器人模仿蛇的身体结构与运动机理,具有体积小、自由度多等特点,在复杂环境中表现出优秀的运动性能.设计一种适用于狭小管道环境的蛇形机器人,采用模块化的构型,机器人共拥有 5 个自由度.利用 Denavit-Hartenberg方法对机器人进行运动学分析,基于从机器人尾部到头部的前向轨迹跟踪控制算法,建立机器人的轨迹跟踪运动控制方法;设计实验样机并开展运动控制实验和实际管道转弯实验,验证了机器人结构设计的合理性、逆运动学的正确性和运动控制方法的有效性.
Abstract
Snake robot,imitating the body structure and motion mechanism of snake,small in size and multiple with degrees of freedom,displays excellent motion performance in complex environment.A snake robot suitable for narrow pipe environment was proposed.With modular configuration,the proposed robot had 5 degrees of freedom,and kinematics analysis was conducted by Denavit-Hartenberg method.Based on the forward trajectory tracking control algorithm from the tail to the head of the robot,the trajectory tracking motion control method of the robot was established.The experimental prototype was designed and the experiments on motion control and actual pipe turning were carried out,which verified the rationality of the robot structure design,the correctness of the inverse kinematics and the effectiveness of the motion control method.
关键词
蛇形机器人/轨迹跟踪/运动学/管道环境应用Key words
snake robot/trajectory tracking/kinematics/pipeline application引用本文复制引用
基金项目
国家重点研发计划项目(2019YFB1309604)
国家自然科学基金资助项目(51861135306)
国家自然科学基金资助项目(51875281)
出版年
2024