搬运机器人的轨迹规划.pdf

《搬运机器人的轨迹规划.pdf》由会员上传分享，免费在线阅读，更多相关内容在行业资料-天天文库。

1、2010年第5期·控制与检测·文章编号：1001—2265(2010)05—0083—03搬运机器人的轨迹规划李伟光，许阳钊(华南理工大学机械与汽车工程学院，广州510640)摘要：用五段三次多项式方法对一种搬运机器人的运行轨迹进行规划，并利用Matlab工具对该方法进行仿真分析。结果表明该方法能使运动轨迹的位置和速度都连续，尤其是加速度也连续，并且能够使机器人按照规定路径运动，保证机器人运行平稳不抖动，顺利避开障碍物，满足设计要求。关键词：三次多项式；搬运机器人；轨迹规划；关节空间中图分类号：TG65；TP242文献标识码：ATheTrajectoryPlanningofTran

2、sportRobotLIWei—guang，XUYang—zhao(SchoolofMechanical＆AutomotiveEngineering，SouthChinaUniversityofTechnology，Guangzhou510640，China)Abstract：Thetrajectoryofatransportrobotwasplannedbyusingthemethodoffivecubicpolynomia1．TheemulationalresultofthetrajectoryplanningwasanalyzedusingMatlabtools．Theres

3、ultshowsthatthismeth-odcanmakeacontinuouslysmoothmovingtrajectoryofpositionandvelocityandespeciallyacceleration，makingtherobotrunsmoothlyinaccordancewithapredeterminedpathwithoutjitterandavoidobstaclesSUC。cessfully，meetingdesignrequirements．Keywords：cubicpolynomial；transportrobot；trajectorypla

4、nning；jointspace流程中位姿变化的路径、取向及其速度和加速度变化O引言过程的设定，是运动学反解的实际应用。机器人轨迹规划的研究始于20世纪60年代1．1机器人运动路径描述末⋯，轨迹规划大致可分为两种：笛卡尔坐标空间的轨迹规划和关节空间的轨迹规划。前者虽然概念直机器人运动路径定义为机器人位形的一个特定序观便于理解，可控制机器人在不同点沿一定的轨迹运列，运动路径的定义是机器人轨迹规划的前提。5自由行，但此方法涉及大量的笛卡尔坐标空问和关节空间度搬运机器人结构包括腰部fn、大臂z。、小臂z：、手腕z、的转换和矩阵求逆，计算量大。而后者由于规划函数手指Z(末端执行器)五部分，

5、如图1所示。腰部fn和手生成的就是关节值，可直接用于控制机器人运动且关腕Z分别绕关节1和关节4做回转运动，大臂Z．、小臂节轨迹易于规划，有许多不同阶次多项式函数及抛物z，、手指Z分别绕关节2、关节3和关节5做俯仰运动。线过渡的线性函数来实现。本文研究的5自由度搬运机器人采用点到点控制方法，要求完成将电镦机电镦成形后高温的蒜头状气门毛坯从电镦机取出后放人摩擦压力机模具内完成冲3压成型的动作，运行过程要求动作连续平滑且能够顺利避开障碍物。为此，必须定义一个连续的且一阶导数和二阶导数均连续的函数。本文采用五段三次多项式方法进行基于关节空间的轨迹规划。l轨迹规划轨迹规划是根据作业要求，对末

6、端执行器在工作图15自由度搬运机器人运动简图收稿日期：2009—11—19作者简介：李伟光(1958一)，男，华南理T大学教授，博士生导师，研究方向为数控技术、制造业自动化与机电一体化，(E—mail)xuyangzhao2008@yahoo．corn．cn。·控制与检测·组合机床与自动化加工技术根据应用要求定义机器人运动路径如图1所示。机器人的运动过程为：没有工作时，处于初始位置S；工作时，沿着轨迹sA运动到电镦等待点A，接着进入如下循环：由A—，到达电镦位置，夹取蒜头状气门毛坯；完成夹取后，沿B—A退回A点；接着由A—C运动到摩擦压力机模具正上方c，由c—D将气门毛坯放入模具内

7、；待气门压力成型完成后将气门取走并沿D—c—A原路退回A处。本文只针对曰一A—C—D段的轨迹规划做研究。O^t2f3t．t1．2五段三次多项式方法图2五段三次多项式轨迹的边界条件对于—A—c—D段的轨迹，不仅指定了起点和给定了初始点和终止点的位置、速度和加速度，第终点，还指定了两个中间点，为此可以通过匹配前个运一段轨迹和末段轨迹的多项式h。(t)和h(t)就完全确动段的末端与下个运动段的始端的位置、速度和加速定了。一旦算出这两个多项式，就可用位置约束和速度来规划出一条