摘要

设计了一种新型的胶囊驱动机器人,用于控制胶囊在胃肠道内的运动和定位。首先,建立胶囊驱动机器人的三维数字化模型;其次,利用齐次变换矩阵来确定驱动机器人运动过程中的位姿,同时利用D-H坐标系法进行运动学正逆解的相关计算;最后,利用MATLAB软件完成运动学建模与仿真,进行驱动机器人的工作空间分析及运动学验证。结果表明,通过控制五自由度的驱动机器人,能在平面任何方向上引导胶囊穿过胃肠道。