机器人概论第三章机械手的运动

机器人概论第三章机械手的运动第1页，课件共36页，创作于2023年2月3.1机械手运动的表示方法3.1.1机械手的结构机械手的运动第2页，课件共36页，创作于2023年2月3.1机械手运动的表示方法3.1.2机械手的机构和运动学回转关节棱柱关节关节变量手爪姿态运动学机械手的运动第3页，课件共36页，创作于2023年2月3.1机械手运动的表示方法3.1.2机械手的机构和运动学手爪位置r;关节变量θ有：写为：运动学方程式。机械手的运动第4页，课件共36页，创作于2023年2月3.1机械手运动的表示方法3.1.2机械手的机构和运动学

正运动学与逆运动学机械手的运动第5页，课件共36页，创作于2023年2月3.1机械手运动的表示方法3.1.3运动学、静力学、动力学的关系手爪力F与关节驱动力静态时的关系：静力学机械手的运动第6页，课件共36页，创作于2023年2月3.1机械手运动的表示方法3.1.3运动学、静力学、动力学的关系驱动力矩与关节位置关节速度、关节加速度的关系动力学机械手的运动第7页，课件共36页，创作于2023年2月3.1机械手运动的表示方法3.1.3运动学、静力学、动力学的关系机械手的运动第8页，课件共36页，创作于2023年2月3.2手爪位置和关节变量的关系3.2.1手爪位置和姿态的表示方法ΣB基坐标系ΣE

手爪坐标系BpE∈R3x1:手爪坐标系原点在基坐标中的

位置向量BRE∈R3x3:坐标变换矩阵机械手的运动第9页，课件共36页，创作于2023年2月3.2手爪位置和关节变量的关系3.2.3齐次变换两个坐标系中位姿关系：上式称为齐次变换矩阵机械手的运动第10页，课件共36页，创作于2023年2月机械手的运动第11页，课件共36页，创作于2023年2月3.2手爪位置和关节变量的关系3.2.3齐次变换对二自由度机械手机械手的运动第12页，课件共36页，创作于2023年2月3.2手爪位置和关节变量的关系3.2.3齐次变换利用上式的确步骤：1）建立连杆坐标系，并用连杆长度和关节变量，求相邻坐标系的位姿关系2）求相邻坐标系的齐次变换矩阵；3）利用上式求总变换机械手的运动第13页，课件共36页，创作于2023年2月3.2手爪位置和关节变量的关系3.2.3齐次变换机械手的运动第14页，课件共36页，创作于2023年2月3.2手爪位置和关节变量的关系3.2.3齐次变换机械手的运动第15页，课件共36页，创作于2023年2月3.2手爪位置和关节变量的关系3.2.3齐次变换机械手的运动第16页，课件共36页，创作于2023年2月3.3雅可比矩阵3.3.1雅可比矩阵的定义机器人正运动学方程：，这里其中：n>m:冗余机器人机械手的运动第17页，课件共36页，创作于2023年2月3.3雅可比矩阵3.3.1雅可比矩阵的定义

J：雅可比矩阵机械手的运动第18页，课件共36页，创作于2023年2月3.3雅可比矩阵3.3.1雅可比矩阵的定义例：两自由度机械手的雅可比矩阵机械手的运动第19页，课件共36页，创作于2023年2月3.3雅可比矩阵3.3.2关节速度和手爪速度的几何学关系

机械手的运动则J1、J2分别为单位关节速度在手爪位置产生的速度分量。即由图中的PE,1,PE,2反时针转动90度而成第20页，课件共36页，创作于2023年2月3.3雅可比矩阵3.3.2关节速度和手爪速度的几何学关系

机械手的运动第21页，课件共36页，创作于2023年2月3.4手爪力和关节驱动力的关系3.4.1虚功原理机械手的运动第22页，课件共36页，创作于2023年2月3.4手爪力和关节驱动力的关系3.4.2机械手静力学关系式的推导

手爪的虚位移

手爪的虚位移手爪力关节驱动力机械手的运动第23页，课件共36页，创作于2023年2月3.4手爪力和关节驱动力的关系3.4.2机械手静力学关系式的推导机械手的运动第24页，课件共36页，创作于2023年2月3.4手爪力和关节驱动力的关系3.4.2机械手静力学关系式的推导机械手的运动2自由度的机械手如图所示。取θ1=0(rad)θ2=

∏/2（rad)的姿态时,分别求解生成手爪力FA=[fx,0]TFB=[0,fy]T时的驱动力τAτB。第25页，课件共36页，创作于2023年2月3.5机械手运动方程式的求解3.5.1惯性矩机械手的运动第26页，课件共36页，创作于2023年2月3.5机械手运动方程式的求解3.5.1惯性矩绕一端旋转惯性矩绕重心旋转惯性矩机械手的运动第27页，课件共36页，创作于2023年2月3.5机械手运动方程式的求解3.5.2牛顿-欧拉方程式机械手的运动第28页，课件共36页，创作于2023年2月3.5机械手运动方程式的求解3.5.2牛顿-欧拉方程式机械手的运动第29页，课件共36页，创作于2023年2月3.5机械手运动方程式的求解3.5.3拉格郎日运动方程式机械手的运动第30页，课件共36页，创作于2023年2月3.5机械手运动方程式的求解3.5.3拉格郎日运动方程式机械手的运动第31页，课件共36页，创作于2023年2月3.5机械手运动方程式的求解3.5.3拉格郎日运动方程式惯性力；离心力；重力项机械手的运动第32页，课件共36页，创作于2023年2月作业P291、2、3P294,P2951、求下图的2自由度机械手，若从爪看到P点位置EPp=[0.2m,0.2m],求BPp,假定L1=L2=0.2m,θ1=θ2=∏/6第33页，课件共36页，创作于2023年2月作业2、求图示3自由度机械手的雅克比矩阵。3、图示有移动副（棱柱副)机械手的雅克比矩阵。第34页，课件共36页，创作于2023年2月作业4、对于第二题中的机械手取θ1=0(rad)θ