会计学4.1工业机器人的运动学方程简介4.1工业机器人的运动学方程简介4.1工业机器人的运动学方程的建立1.机器人运动学方程通常把描述一个连杆坐标系与下一个连杆坐标系间相对关系的齐次变换矩阵叫Ai变换矩阵,简称Ai矩阵。如A1矩阵表示第一个连杆坐标系相对固定坐标系的位姿;A2矩阵表示第二个连杆坐标系相对第一个连杆坐标系的位姿;Ai表示第i个连杆相对于第i-1个连杆的位姿变换矩阵。那么,第二个连杆坐标系在固定坐标系中的位姿可用A1和A2的乘积来表示,即:依此类推,对于六连杆机器人,有下列矩阵:2.正向运动学及实例如图所示,SCARA装配机器人的三个关节轴线是相互平行的,{0}、{1}、{2}、{3}分别表示固定坐标系、连杆1的动坐标系、连杆2的动坐标系、连杆3的动坐标系,分别坐落在关节1、关节2、关节3和手部中心。坐标系3即为手部坐标系。连杆运动为旋转运动,连杆参数θn为变量,其余参数均为常量。该机器人的参数如表所示。/该平面关节型机器人的运动学方程为/手部位置：手部姿态如图所示,当转角变量分别为θ1=30°,θ2=-60°,θ3=-30°时，则可根据平面关节型机器人运动学方程求解出运动学正解,即手部的位姿矩阵表达式建立运动学方程的步骤：（1）建立坐标系（2）确定结构参数和关节变量（3）求两杆间的位姿矩阵Ai（4）求末端执行器的位姿矩阵（5）求末端执行器的位置和姿态坐标设置时应注意以下各点：1)使操作机处于操作的零位，由基座开始先设立固定的基础(参考)坐标系S。，其zo的正向最好与重力加速度反向，原点O0在第一关节轴线上，x0位于操作机工作空间的对称平面内；2)尽量使xi与xi-1同向，Oi与Oi-1在zi方向同“高”，否则关节变量θi(或di)要加初始值；3)末端执行器坐标架Se的原点Oe，最好选在“手”心点上，ze的正向指向(或背离)工件。例题：建立斯坦福机器人的运动方程。解：（1）建立坐标系例题：建立斯坦福机器人的运动方程。（2）确定结构参数和关节变量例题：建立斯坦福机器人的运动方程。（3）求两杆间的位姿矩阵Ai例题：建立斯坦福机器人的运动方程。例题：建立斯坦福机器人的运动方程。例题：建立斯坦福机器人的运动方程。例题：建立斯坦福机器人的运动方程。例题：建立斯坦福机器人的运动方程。例题：建立斯坦福机器人的运动方程。（4）求末端执行器的位姿矩阵例题：如下机器人的运动方程。三自由度机械手如图所示,臂长为l1和l2,手部中心离手腕中心的距离为H,转角为θ1、θ2、θ3,试建立杆件坐标系,并推导出该机械手的运动学方程。解：（1）建立坐标系（2）给出连杆参数和关节变量。(3)求相邻两杆之间位姿变换矩阵（4）建立运动方程(5)给出手部位姿手部位置：