机器人技术第三章优秀PPT.ppt
机器人技术第三章你现在浏览的是第一页，共64页Robotics 运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.0 A矩阵和T矩阵机械手可以看成由一系列关节连接起来的连杆组构成.用A矩阵描述连杆坐标系间相对平移和旋转的齐次变换.A1表示第一连杆对基坐标的位姿A2表示第二连杆对第一连杆位姿则第二连杆对基坐标的位姿为你现在浏览的是第二页，共64页Robotics运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.1 运动姿态和方向角1.运动方向接近矢量a a:夹持器进入物体的方向;Z轴方向矢量o:o:指尖互相指向;Y轴法线矢量n:n:指尖互相指向;X轴你现在浏览的是第三页，共64页Robotics运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.1 运动姿态和方向角2.用旋转系列表示运动姿态欧拉角:绕Z轴转,再绕新Y轴转,绕最新Z轴转.(3-3)注意:坐标变换是右乘.即后面的变换乘在右边.(绕新轴转,连乘)你现在浏览的是第四页，共64页你现在浏览的是第五页，共64页Robotics运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.1 运动姿态和方向角3.用滚仰偏转表示运动姿态横滚:绕Z轴转,俯仰:绕Y轴转,偏转:绕X轴转.(3-5)注意:左乘.你现在浏览的是第六页，共64页Robotics运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.2 运动位置和坐标1.用柱面坐标表示末端运动位置由于上述绕Z轴的旋转,使末端执行器的姿态出现变化,若要执行器姿态不变,则需将其绕执行器Z轴反向旋转.(3-8)你现在浏览的是第七页，共64页Robotics运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.2 运动位置和坐标2.用球面坐标表示末端运动位置沿Z平移r,绕Y轴转,绕Z轴转.(3-10)你现在浏览的是第八页，共64页Robotics运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.2 运动位置和坐标表示物体的位置:笛卡尔坐标、柱面坐标、球面坐标1.用柱面坐标表示末端运动位置沿X平移r,绕Z轴转,沿Z轴平移z.(绕原坐标系运动,左乘)(3-7)你现在浏览的是第九页，共64页Robotics运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.2 运动位置和坐标2.用球面坐标表示末端运动位置沿Z平移r,绕Y轴转,绕Z轴转.(3-10)你现在浏览的是第十页，共64页Robotics运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.2 运动位置和坐标2.用球面坐标表示末端运动位置由于上述两个旋转,使执行器姿态发生变化.为保持姿态,执行器要绕其自身Y和Z轴反向旋转.(3-11)你现在浏览的是第十一页，共64页Robotics运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.3 连杆变换矩阵1.广义连杆(D-H坐标)全为转动关节:Zi坐标轴;Xi坐标轴;Yi坐标轴;连杆长度ai;连杆扭角i;两连杆距离di;两杆夹角i你现在浏览的是第十二页，共64页Robotics运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.3 连杆变换矩阵1.广义连杆全为转动关节:Zi坐标轴:沿着i+1关节的运动轴;Xi坐标轴:沿着Zi和Zi-1的公法线,指向离开Zi-1轴的方向;Yi坐标轴:按右手直角坐标系法则制定;连杆长度ai;Zi和Zi-1两轴心线的公法线长度;连杆扭角i:Zi和Zi-1两轴心线的夹角;两连杆距离di:相邻两杆三轴心线的两条公法线间的距离;两杆夹角i:Xi和Xi-1两坐标轴的夹角;你现在浏览的是第十三页，共64页Robotics运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.3 连杆变换矩阵1.广义连杆(D-H坐标)含移动关节:Zi坐标轴;Xi坐标轴;Yi坐标轴;连杆长度ai=0;连杆扭角i;两连杆距离di;两杆夹角i你现在浏览的是第十四页，共64页Robotics运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.3 连杆变换矩阵1.广义连杆含移动关节:Zi坐标轴:沿着i+1关节的运动轴;Xi坐标轴:沿着Zi和Zi-1的公法线,指向离开Zi-1轴的方向;Yi坐标轴:按右手直角坐标系法则制定;连杆长度ai;Zi和Zi-1两轴心线的公法线长度;连杆扭角i:Zi和Zi-1两轴心线的夹角;两连杆距离di:相邻两杆三轴心线的两条公法线间的距离;两杆夹角i:Xi和Xi-1两坐标轴的夹角;你现在浏览的是第十五页，共64页Robotics运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.3 连杆变换矩阵2.广义变换矩阵建立D-H坐标系后,可通过两个旋转、两个平移建立相邻连杆i-1和i间的相对关系。1。绕Zi-1轴转i角，使Xi-1转到与Xi同一平面内；2。沿Zi-1轴平移di，把Xi-1移到与Xi同一直线上；3。沿i轴平移ai-1,把连杆i-1的坐标系移到使其原点与 连杆i的坐标系原点重合的位置；4。绕Xi-1轴转i-1角，使Zi-1转到与Zi同一直线上；这四个齐次变换叫Ai矩阵：你现在浏览的是第十六页，共64页Robotics运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.3 连杆变换矩阵2.广义变换矩阵对旋转关节:(3-13)对棱柱关节:(3-14)你现在浏览的是第十七页，共64页Robotics运动学运动学3.1 3.1 机器人运动方程的表示机器人运动方程的表示3.1.3 连杆变换矩阵3.用A矩阵表示T矩阵T6:机械手末端对其基座Z:机械手基座对参考坐标系E:端部工具对机械手末端X:端部工具对参考坐标系你现在浏览的是第十八页，共64页Robotics运动学运动学3.2 3.2 机械手运动方程的求解机械手运动方程的求解1)问题:已知手部位姿,求各关节位置2)意义:是机械手控制的关键3)没有一种算法可以通用,需要几何设置引导本节介绍上节的几种特殊变换下的求解算法.你现在浏览的是第十九页，共64页Robotics运动学运动学3.2 3.2 机械手运动方程的求解机械手运动方程的求解3.2.1欧拉变换解1.基本隐式方程的解若上式中T矩阵的各元素已知，即 （3-24）对应项相等，有你现在浏览的是第二十页，共64页Robotics运动学运动学3.2 3.2 机械手运动方程的求解机械手运动方程的求解3.2.1欧拉变换解 arccos:符号不定；特殊点不准确；0或180时，后 （3-25/33）两式没定义。你现在浏览的是第二十一页，共64页Robotics运动学运动学3.2 3.2 机械手运动方程的求解机械手运动方程的求解3.2.1欧拉变换解2.用显式方程求各角度 (3-37)(3-39)你现在浏览的是第二十二页，共64页Robotics运动学运动学3.2 3.2 机械手运动方程的求解机械手运动方程的求解3.2.1欧拉变换解其中 (3-40)你现在浏览的是第二十三页，共64页Robotics运动学运动学3.2 3.2 机械手运动方程的求解机械手运动方程的求解3.2.1欧拉变换解由 有:即 (3-42/43)这样,由 ,得 (3-44)再由 ,得 (3-45)你现在浏览的是第二十四页，共64页Robotics运动学运动学3.2 3.2 机械手运动方程的求解机械手运动方程的求解3.2.2 滚、仰、偏变换解由 （3-47）f定义同前。你现在浏览的是第二十五页，共64页Robotics运动学运动学3.2 3.2 机械手运动方程的求解机械手运动方程的求解3.2.2 滚、仰、偏变换解由 得 （3-48）这样，由可得：（3-50）再由得 （3-51）你现在浏览的是第二十六页，共64页Robotics运动学运动学3.2 3.2 机械手运动方程的求解机械手运动方程的求解3.2.3 球面变换解右列相等：（3-53）你现在浏览的是第二十七页，共64页Robotics运动学运动学3.2 3.2 机械手运动方程的求解机械手运动方程的求解3.2.3 球面变换解由第二行有：（3-54）（3-56）用 的右列相等，可得：（3-57）你现在浏览的是第二十八页，共64页Robotics运动学运动学3.3 PUMA6003.3 PUMA600机器人运动方程机器人运动方程3.3.1 运动分析 已知转角，求各杆位姿你现在浏览的是第二十九页，共64页Robotics运动学运动学3.3 PUMA6003.3 PUMA600机器人运动方程机器人运动方程3.3.1 运动分析1。确定D-H坐标系全为转动关节:Zi坐标轴:沿着i+1关节的运动轴;Xi坐标轴:沿着Zi和Zi-1的公法线,指向离开Zi-1轴的方向;Yi坐标轴:按右手直角坐标系法则制定;连杆长度ai;Zi和Zi-1两轴心线的公法线长度;连杆扭角i:Zi和Zi-1两轴心线的夹角;两连杆距离di:相邻两杆三轴心线的两条公法线间的距离;两杆夹角i:Xi和Xi-1两坐标轴的夹角;你现在浏览的是第三十页，共64页Robotics运动学运动学3.3 PUMA6003.3 PUMA600机器人运动方程机器人运动方程3.3.1 运动分析2。确定各连杆D-H参数和关节变量你现在浏览的是第三十一页，共64页Robotics运动学运动学3.3 PUMA6003.3 PUMA600机器人运动方程机器人运动方程3.3.1 运动分析你现在浏览的是第三十二页，共64页Robotics运动学运动学3.3 PUMA6003.3 PUMA600机器人运动方程机器人运动方程3.3.1 运动分析3。求出两杆间的位姿矩阵你现在浏览的是第三十三页，共64页Robotics运动学运动学3.3 PUMA6003.3 PUMA600机器人运动方程机器人运动方程3.3.1 运动分析你现在浏览的是第三十四页，共64页Robotics运动学运动学3.3 PUMA6003.3 PUMA600机器人运动方程机器人运动方程3.3.1 运动分析4。求末杆的位姿矩阵你现在浏览的是第三十五页，共64页Robotics运动学运动学3.3 PUMA6003.3 PUMA600机器人运动方程机器人运动方程3.3.1 运动分析你现在浏览的是第三十六页，共64页Robotics运动学运动学3.3 PUMA6003.3 PUMA600机器人运动方程机器人运动方程3.3.1 运动分析 （3-64）你现在浏览的是第三十七页，共64页Robotics运动学运动学3.3 PUMA6003.3 PUMA600机器人运动方程机器人运动方程3.3.1 运动分析5。验证你现在浏览的是第三十八页，共64页Robotics运动学运动学3.3 PUMA6003.3 PUMA600机器人运动方程机器人运动方程3.3.2 运动综合已知，求：各转角你现在浏览的是第三十九页，共64页Robotics运动学运动学3.3 PUMA6003.3 PUMA600机器人运动方程机器人运动方程3.3.2 运动综合由于 交于一点W,点W在基础坐标系中的位置仅与 有关。据此，可先解出 ，再分离出 ，并逐一求解。1.求1你现在浏览的是第四十页，共64页Robotics运动学运动学3.3 PUMA6003.3 PUMA600机器人运动方程机器人运动方程3.3.2 运动综合有两个可能的解。其他角度可以类似方法求得。你现在浏览的是第四十一页，共64页Robotics运动学运动学3.3 PUMA6003.3 PUMA600机器人运动方程机器人运动方程3.3.2 运动综合解的多重性你现在浏览的是第四十二页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动1。微分平移和旋转在基系中的描述：在坐标系T中描述：你现在浏览的是第四十三页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动1。微分平移和旋转微分平移变换：微分旋转变换：因为：你现在浏览的是第四十四页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动1。微分平移和旋转有：你现在浏览的是第四十五页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动1。微分平移和旋转所以有 （3-87）你现在浏览的是第四十六页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动1。微分平移和旋转因为：(3-88)(3-89)微分平移和旋转矢量：你现在浏览的是第四十七页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动1。微分平移和旋转记：（3-90）（3-91）你现在浏览的是第四十八页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动1。微分平移和旋转例3.1:已知坐标系A和其对基系的微分平移和旋转,求微分变换dA.解:(3-88)你现在浏览的是第四十九页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动1。微分平移和旋转 坐标系A的微分变化你现在浏览的是第五十页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动2。微分运动的等价变换目的：把一个坐标系内的位姿变换到另一坐标系内由 有：你现在浏览的是第五十一页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动2。微分运动的等价变换与（3-89）元素对应相等，有你现在浏览的是第五十二页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动2。微分运动的等价变换你现在浏览的是第五十三页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动2。微分运动的等价变换你现在浏览的是第五十四页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动2。微分运动的等价变换例3-2：在例1中，求坐标系A的等价微分平移和旋转你现在浏览的是第五十五页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动3。变换式中的微分关系你现在浏览的是第五十六页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动3。变换式中的微分关系由上图，有你现在浏览的是第五十七页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动3。变换式中的微分关系一摄像机，装在机械手的连杆5上。这一连接及机械手的最后一个连杆所处当前位置，分别由下式确定：被观察的目标物体为CAMO。要把机械手的末端引向目标物体，需要知道的坐标系CAM内的微分变化为：求在坐标系T6内所需要的微分变化。你现在浏览的是第五十八页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动3。变换式中的微分关系例3。3：你现在浏览的是第五十九页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动3。变换式中的微分关系你现在浏览的是第六十页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.1 机器人的微分运动3。变换式中的微分关系你现在浏览的是第六十一页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.2 机器人的雅可比矩阵1。定义 机械手的操作速度与关节速度间的线性变换定义为机械手的雅可比矩阵。你现在浏览的是第六十二页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.2 机器人的雅可比矩阵你现在浏览的是第六十三页，共64页Robotics运动学运动学3.4 3.4 机器人的雅可比公式机器人的雅可比公式3.4.2 机器人的雅可比矩阵2。雅可比矩阵的求法（1）矢量积法 对移动关节 对转动关节 你现在浏览的是第六十四页，共64页
