介入机器人运动学及轨迹规划研究-机电工程.PDFVIP

第31卷第6期 机 电 工 程 Vol. 31 No. 6 2014年6月 JournalofMechanicalElectricalEngineering Jun. 2014 DOI：10.3969/j.issn.1001-4551.2014.06.001 介入机器人运动学及轨迹规划研究* 陈 华，刘 龙，曹 彤* （北京科技大学 机械工程学院，北京 100083） 摘要：针对介入机器人运动学和轨迹规划问题，基于D-H坐标系理论建立了血管介入主端机器人的运动学方程，并对该方程进行了 求解；其次，在关节空间内采用五次多项式插值方法，结合介入机器人运动参数对关节轨迹进行了插值计算，实现了对血管介入机器 人关节空间的PTP轨迹规划；最后，利用Matlab机器人工具箱建立了该机器人的三维仿真模型，并且对机器人运动学、轨迹规划进行 了仿真验证。研究结果表明：该机器人连杆参数设计合理，活动空间适应手术要求，运动学方程准确可靠，在关节空间内利用五次多 项式进行轨迹规划保证了机器人运动连续平滑。目前该技术已应用于血管介入手术临床试验中。 关键词：血管介入机器人；运动学；轨迹规划；Matlab；D-H理论 中图分类号：TH113.2；TP242.2 文献标志码：A 文章编号：1001-4551（2014）06-0679-05 Studyofkinematicsandtrajectoryplanning forinterventionrobot CHENHua，LIULong，CAOTong （SchoolofMechanicalEngineering，UniversityofScienceandTechnologyBeijing，Beijing 100083，China） Abstract：Aimingatsolvingtheproblemsofrobotkinematicsandtrajectoryplanning，thekinematicsequationsofvascularintervention robotwerebuilttoanalyzerobotkinematicsproblemswhichwerebasedonD-Hcoordinatesystemtheory.Secondly，inthejointspace， quinticpolynomialinterpolationmethodwasinvolvedinthejointtrajectoryinterpolationcalculation，whichcombinedtheparametersof the robot. PTP trajectory planning of vascular intervention robot was realized in joint space. Finally，the model of the robot was established to simulate the robot kinematics and trajectory planning via Matlab toolbox.The results indicate that robot parameter is reasonable，andquinticpolynomialtrajectoryplanninginjointspaceensurethecontinuousandsmoothmotionofrobot.Atpresent，the technologyhavebeenusedinclinicaltrialsofvascularinterventionalprocedures. Keywords：vascularinterventionrobot；kinematics；trajectoryplanning；Matlab；D-Htheory 制末端执行器的位姿、速