四轴机器人逆运动学求解.pptVIP

* * * * * 四轴机器人逆运动学求解 目录 逆运动学方程介绍 1 逆运动学求解案例 2 总结 3 1.逆运动学方程介绍 所谓逆运动学方程的解，就是已知机械手直角坐标空间的位姿（pose）T6，求出各节变量θn or dn 。 T4= A1 A2 A3 A4 （1.1） 逆运动学方程解的步骤如下： （1）根据机械手关节坐标设置确定An An为关节坐标的齐次坐标变换，由关节变量和参数确定。关节变量和参数有： an－连杆长度; αn－连杆扭转角; dn－相邻两连杆的距离; θn－相邻两连杆的夹角。 对于旋转关节θn为关节变量，而对于滑动关节dn为关节变量。其余为连杆参数，由机械手的几何尺寸和组合形态决定。 （2） 根据任务确定机械手的位姿T6 T6为机械手末端在直角坐标系（参考坐标或基坐标）中的位姿，由任务确定，即表达式T4 = Z-1 X E-1确定。它是由三个平移分量构成的平移矢量P（确定空间位置）和三个旋转矢量n，o，a（确定姿态）组成的齐次变换矩阵描述。 （3）由T4和An（n＝1，2，…，4）和式（1.1）求出相应的