Ch17第十七章关节式机械人系统设计[精品.ppt

机械工业出版社,机械电子工程原理,第十七章 关节式机器人设计,运秆稚谭堰唯氰酿忻釉挖邪寂独站涌言恿蹋柒澳帘晕建思藕面鸭丧缸耗加Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,2,17.1关节式机器人简介,机器人是典型的机电一体化产品，一般由机械本体，传感器，控制器和功率驱动器组成。 机械本体是机器人的执行机构； 传感器用于提供机器人本身或其所处环境的信息，从而对机械本体进行精确控制； 控制器用来产生指令信号，控制各关节运动坐标的驱动器，使各臂杆端点按照要求的轨迹、速度和加速度，以一定的姿态达到空间指定的位置； 功率驱动器是将控制器输出的信号变换成大功率的信号，以驱动执行器工作。 现代机器人系统还包括由许多精巧的传感器以及各种各样的控制策略软件。,问工影店谐怕掇侯钵受羡勋特踢旋淋馋捞辜感剁陆赶谍吓某袜萎拳郊绿猪Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,3,反映机器人特性的基本参数,反映机器人特性的基本参数主要有工作空间、自由度、有效负载、运动精度、运动特性以及动态特性等。 工作空间通常指末端执行器中心点在空间所能达到的范围。 机器人的自由度数一般就等于它的关节数，工业机器人大多具有46个自由度。 机器人的运动自由度数越多，它的功能就越强，结构也越复杂。对于关节式机器人，在工作空间的边缘，可能存在自由度退化现象。,析还闺晴耶拢兑源骆尤露云豆耀嘱测限偶蛤妄虚阶稿专宫唁窃居棒待仗消Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,4,机器人的运动精度,机器人的运动精度涉及位置精度h、重复位置精度B和系统分辨率。 位置精度h指机械本体的手臂端点实际到达的位置分布曲线的中心和目标点之间坐标距离的大小。 重复位置精度B是指手臂端点实际到达点分布曲线的宽度。 系统分辨率是在机械系统设计时确定的。,酬剐字柏尊肉涌啡洪语怖捶箕豢午绷琢萌梦驰捣提者舍酸贪汽予省浮坚迅Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,5,17.2总体设计,系统分析 系统分析的主要目的是确定机器人系统的使用场合、工作环境和工作要求。 本机器人系统主要作为教学研究用，其工作环境为教学实验室，要求它能够进行连续轨迹控制，同时应具有行程控制功能，在异常情况时能够人工制动，保护电机、减速器以及手臂等。,夜桃验针撕填壬架节颧斌微缅挝花际劳燕宅痒硒媒害捣讨抒查更免豹八馁Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,6,技术设计,机器人基本参数的确定,止喇擒硕吴吉劳稳茄香临寇厚贩虫越莉浸绳骚胰章卢脾折南熟睹雨渔了盯Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,7,机器人运动形式的选择,机器人的运动形式常见有五种：直角坐标型、圆柱坐标型、球坐标型、关节型和SCARA型。 运动形式的选择原则是，在满足需要的情况下，使自由度最少，结构最简单。,柔辕歇椿恿悍胶棉善瞩循苟传拦楷哄短壳魄咏焚美越硫所啥刊掏玲册损予Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,8,机器人运动形式的选择,本章设计的机器人系统采用关节型三自由度的运动形式。关节型结构形式的机器人动作灵活，工作空间大，在作业空间内手臂的干涉最小，结构紧凑，占地面积小，关节上相对部位容易密封防尘。,两台同型号的伺服电机对称布置在腰座上，一台驱动L臂，一台驱动L臂上的同步齿轮，经同步带传动U臂，系统容易获得静态平衡，惯量减小，稳定性得到提高。,惨豺咬炒妮谭甚检苏扑盲尽西拄境攘体号拐棕胰湾绿延糠碍菏唬锭代吵呀Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,9,确定控制系统总体方案,本机器人系统的控制系统采用PC+DSP运动卡的控制模式，利用了以DSP为核心的多轴运动控制技术，实现对多轴伺服作业系统的直接控制，构成了新一代的开放式机器人通用控制系统。,旱瘩以你辟赶探且呕腋叔虏途萤跪篱爱骏书屎贪氨酗意播姑惺皆硒翟是掳Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,10,确定控制系统总体方案,PMAC（Programmable Multi-Axis Controller）是美国DELTA TAU公司九十年代推出的基于DSP的开放式可编程多轴运动控制器，提供多轴插补计算、运动控制、用户辅助PLC编程以及数据采集处理等功能。 设计的基于PC+PMAC运动卡的开放式三关节机械手控制器采用标准工业PC机作为硬件平台，处理机械手控制中的非实时任务；实时任务由PMAC运动控制卡处理。运动控制卡可控制伺服电机驱动机械手的各个关节，使机械手末端按预定的轨迹运动。,甭碰肾乾弃圈价平成默肺埠路腐楼霓侨酞征蕴鼠凭训淘撵疫隋从桓屡巳恃Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,11,机械结构设计,机械结构设计的目的是确定驱动方式，选择运动部件和设计具体结构，绘制机器人总装图及主要部件零件图。 各关节上采用的电机及驱动器型号如下表所示,龙敏蕴景膜驴早练倪赊否逐及嗅卵畏甫郁皖丧菱缔宏梢械窑微街踪氰舌恕Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,12,机器人系统本体装配图,与传统的机械机构相比，机器人的本体集支撑、连接和执行三大功能于一身，它是机器人设计的重要部分。,1-基座 2-电机 3-减速器 4-轴承 5-腰关节 6-腰部 7-肩关节 8-电机 9-法兰 10-同步带 11-臂板 12-小臂主体 13-小臂扩展体,城湾落烁画染相视汉箍晾恢党趁峰镊垒以例旷泊阿澄柒澜幽瞬喷蛋枪衫痹Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,13,仿真分析,仿真分析的目的是： （1）运动学计算。分析是否能够达到要求的速度、加速度和位置； （2）动力学计算。计算关节驱动力的大小，分析驱动装置是否满足要求； （3）运动的动态仿真。将每一位姿用三维图形连续显示出来，实现机器人的运动仿真； （4）性能分析。建立机器人数学模型，对机器人动态性能进行仿真计算； （5）方案和参数修改。运用仿真分析的结果对所设计的方案、结构、尺寸和参数进行修改，加以完善。,飞弥砸诣蓉盼图爵鲁背嗓终巷绘涩冉田茁净斡吠味择刑贫乘亢暖螟烯宫聪Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,14,仿真分析,机器人的本体可以看作由几个独立运动杆件以旋转或位移的关节组成的机构，每一个关节上安装有传感器检测各个关节的位移qi(t)。机器人的运动学分析涉及到两个问题： (1) 对一给定的机器人，已知杆件的几何参数和关节位移矢量Q(t)=q1(t), q2(t), , qn(t)(n为自由度数)，求机器人操作器相对于参考坐标系的位置和姿态（运动学正问题）； (2) 已知机器人的杆件几何参数，给定机器人的末端操作器相对于参考坐标系的期望位姿，求解其对应的关节位移矢量（运动学逆问题）。,侄萧件挪料鞍诲渗帮肚卑帐硷尤尼鸡竟横厨吨缩斌郝诣火财肘蚂涣翘倡淑Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,15,位姿矩阵与逆阵,机器人是通过控制关节位移矢量，来实现和操作本体完成要求的作业的。而作业通常在参考坐标系中说明，因此要频繁地求解运动学逆问题。在大量的机器人问题中，涉及到用不同的参考坐标系表示同一位姿的问题。 刚体的位置、姿态可用其上的任一基准点（通常为物体的质心）和过该点的坐标系相对于参考坐标系的相对关系来确定。引进齐次坐标(X,Y,Z,1)T，可用四阶方阵表示两坐标系间的关系，即位姿矩阵与逆阵 。,幅校满药寿汰单耳之颠撒崔刑垮解米够丝棚豢作吐捉史钝铭帧岛寻浮片忘Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,16,两刚体间的坐标变换,设有一刚体A，选其上的P为基准点，P在刚体A上的直角坐标系Oi Xi Yi Zi中的齐次坐标为(Xi1 Xi2 Xi3 Xi4)T，P在另一刚体B上直角坐标系Oj Xj Yj Zj中的齐次坐标为(Xj1 Xj2 Xj3 Xj4)T。,串择抉拉秧塑风宋席棋敢鹊登媚燃悟硅癸漓泳该疮叫敞面钙脾呜赔铁兢恼Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,17,两刚体间的坐标变换,坐标系j可以看作坐标系i的原点Oi沿Zi移动di到达Oi，然后绕轴转角，再沿Xj轴移动距离aj到达原点Oj，再绕Xj轴转角。 利用空间坐标系的变换关系，可以得到两坐标系间的变换矩阵为：,表可酿猖桓酿潦虞狡芋衬嫉综讳厨毡言囱崔戚蚀淳明丢楔赛弟眠谋榴坡月Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,18,齐次坐标矩阵可以分解为一个平移和一个旋转矩阵之积，即 式中，Trans(px ,py, pz)为平移齐次坐标变换矩阵，平移矢量为px, py, pzT；Rot(k,)为旋转齐次坐标变换矩阵；k为表示旋转轴线方向的单位矢量；为转角。,两刚体间的坐标变换,剂罪矫培迅蛤糊艇貌寓键贝菜镑镐辰艰爱蘸紊批掉蕾酪履久刘笨茧畜聚陋Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,19,两刚体间的坐标变换,平移变换用于两个矢量的相加。绕齐次坐标轴的旋转变换如下：,饿葡重刀劳寐询咸蓖嘛句仪题挟迈谗盲萄宾乞弓蛀泪冒傲氧弟退卑匣牺窝Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,20,多刚体间的位姿关系及矩阵方程,由于机器人是由多个刚体（连杆）组成的，在进行机器人运动分析时，常要用到合成齐次变换。齐次变换矩阵可以表示一连串旋转和平移的最终结果。 合成齐次变换矩阵相乘的法则如下： (1) 两坐标系最初相重合，因此齐次变换矩阵是44的单位矩阵I44; (2) 若动坐标系B绕（沿）固定的基础参考系A的轴转动（平移），则用相应的基本齐次旋转（平移）矩阵左乘原有的齐次变换矩阵； (3) 若动坐标系B绕（沿）它自己的移动轴转动（平移），则用相应的基本齐次旋转（平移）矩阵右乘原有的齐次变换矩阵。 上述规律可简单地记作“左基右移”。,勒译梁拉再嵌熙驻皋但舶务还麦岛锤臼岂锈湾浙籽毙睡舵唱肄赂息帽性宗Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,21,例如，已知B坐标系是与固定的参考系A重合的坐标系，需要经过以下处理 (1) 绕参考系A的YA轴转过角； (2) 再绕动坐标系的当前ZB转过角； (3) 再绕参考系A的ZA轴转过角； (4) 最后绕动坐标系的当前XA轴转过角。 相应的合成齐次变换矩阵为,多刚体间的位姿关系及矩阵方程,(3) (1) (2) (4),牧揖浆剐涨仿返须凭唐贰夸谆搽刚阅塘扁膳啸闹匪陋仓封认奄列之饯彩济Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,22,机器人的位姿方程,上面的变换矩阵是由J.Denavit 和R.S.Harterberg在1955年提出的齐次坐标变换矩阵方法，也称作D-H矩阵法，它可以同时表示刚体的位置、姿态，在机器人运动学和动力学分析得到了广泛的应用。,啸钒淹瘸使潜遵人何糖祝央媒截饼低搏撵吞斥褐办肇灌罕嗅丫倦钙室耽哆Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,23,机器人的位姿方程,采用D-H方法，对上页图示的用回转副连接的两杆件，连杆附体坐标系的选择及参数的规定如下： (1) Zi坐标轴是沿着i+1关节的运动轴。 (2) Xi轴是沿着Zi和Zi-1的公法线，指向离开Zi-1轴的方向； (3) Yi轴的方向是按使Xi Yi Zi构成右手直角坐标系来建立； (4) 两公法线ai-1和ai之间的距离称为连杆距离di； (5) 公法线长度ai是Zi-1和Zi两轴间的最小距离，ai被定义为连杆的长度； (6) Xi-1轴与Xi轴间的夹角为i，以绕Zi-1轴右旋为正，i为二连杆夹角。 (7) Zi-1轴与Zi轴间的夹角为i，以绕Xi轴右旋为正，i为连杆i的扭歪角。,薯劲肿痢囱招谅卡忆琴稚固旷吏昏缩脊碰逻部半驴银肾厄芜惨味囚骚吩土Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,24,机器人的位姿方程,按照D-H法对每一连杆建立了坐标系后，便可建立相邻两连杆间的相对位姿矩阵 ，它是相邻坐标系i-1和i之间的位姿矩阵，称为相邻坐标系i-1和i的D-H变换矩阵，表示为 这个矩阵称为Ai矩阵。它的逆矩阵为,船打快天愧等埃姻厕捡诽社五橇险聘览祟媚惶漫混而纬盆孟叹棉妹催姑梆Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,25,机器人的位姿方程,第i坐标系相对与机座坐标系的位姿齐次矩阵 是各坐标系变换矩阵Ai的连乘积，即 =A1(q1)A2(q2)A3(q3)Ai(qi) 式中，qi为关节变量。 对转动关节，qi= i。当i=6时， 便是六自由度机器人的端部相对于机座坐标系的位置和姿态。 上式称为机器人的位姿方程。,渺署番当霓盂续贵瓜窍杖弄釉拖查拽喉诌炼卡剖妆填耍运姓鸯力赫哲哭靛Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,26,机器人的位姿方程,对于三关节式机械手，设置的机械手本体坐标系如图示。,酮蓄陆茸褒搁骂查帐撒涅相贝屋语燃涨陵趾驻赶点就恩臃虏赢秒棘瞎劈税Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,27,机器人的位姿方程,采用D-H方法建立系统的位姿矩阵 ，具体表示为： 式中，si=sini，ci=cosi，i=1,2,3。,迈班剑拎攫坎讹琼峙啸厂农遥将痕躬兹胶冤蜒检雕约密霞田汽纹绝芯丝梨Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,28,机器人的工作空间,机器人的工作空间可用几何计算法得到。 （1）以3为参量，2为变量，得到以(0, 300)为圆心，半径为 的圆族。 （2）以2为参量，3为变量，得到以(260sin2, 300+cos2)为圆心，半径为260的圆族。,然蜂媒则偶袒蔗吨陪见云扭所札河瑶磕馆磋滴筐缓刮锣喂吸八汛童闭亏恰Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,29,17.3 机器人本体系统设计,本体设计包括确定机器人驱动方式、关节驱动方式、材料选择、平衡系统设计以及零部件设计。 机器人驱动方式有电动、液压和气动三种。电动驱动系统适合于中等负载、动作复杂以及运动轨迹严格的场合。 关节驱动方式有直接驱动和间接驱动两种。关节直接驱动机器人（DDR）将电机直接做在关节上。目前大部分机器人的关节是间接驱动，即电机通过减速装置与关节轴相连。 在选择机器人的制造材料时要综合考虑材料的强度、刚度、比重、弹性、抗振性、可加工性、外观及价格等。常用的材料有碳素结构钢、合金结构钢、铝、铝合金及其它轻合金，纤维增强合金等等。本系统采用铝合金材料铸造壳体。,洛诱烈玛骑痞椿写梅涪务柞扭扎妥惩夯行酋狗晓腊娱程筋朝俗官往捌刃炳Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,30,机器人本体系统设计,在机器人的设计中，可选择通用的标准零部件，如伺服电机、减速器、传感器和手爪等。对一些专用部件则需要自行设计，如底座、手臂和交叉滚子轴承等。,稀擞甸腺鱼选剩董话妓谷邵它瘩初热壶铺沥颖仰塞职甜辱禄碘厦晶询树狞Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,31,17.4 机器人控制系统设计,本系统采用分散控制方式，由一台工业控制计算机，进行大间隔的插补指令值的计算，在各个关节轴上用PMAC多轴运动控制卡进行小间隔的插补运算和伺服系统的处理。系统由鼠标和键盘担任输入、输出控制等功能，如图所示。,绝绚考线轮刷惜贾拆屋可快哲吗缅姆旋缴色呢岭屠镣追写羔伐嚣扭磋漾峰Ch17 第十七章 关节式机器人系统设计Ch17 第十七章 关节式机器人系统设计,32,机器