机械臂运动学笔记（一）：正向运动学

正向运动学指的是通过相邻关节间的转动和移动坐标，将末端的坐标计算出来。

反向运动学指的是已知机械臂末端的坐标，反算每个关节可能的转动和移动参数。

一.任意连杆连接的变量定义（Craig DH）

假设对于任意轴，只存在转动或移动。

对于任意多个轴连接，相邻两个轴之间，其连杆（绿色），轴的夹角（橙色），连杆的偏距（紫色），关节角（红色）如下图所示。

其方向为X轴沿着连杆方向，Y轴为右手定则方向,Z轴为旋转方向右手定则指向的大拇指方向

多杆连接时，一共有四个参数( $\alpha _{i-1}$ , $a _{i-1}$ , $d _{i}$ ， $\theta _{i}$ ）

$\alpha _{i-1}$ ：表示从第frame_i-1坐标系的 $X _{i-1}$ 轴向其坐标系原点看过去， $Z_{i}$ 轴相对于 $Z _{i-1}$ 轴的旋转角度，若为顺时针 $K _{i}$ 度，则 $\alpha _{i-1}$ = $-K _{i}$ （顺时针为负，逆时针为正）

$a _{i-1}$ ：表示沿着第frame_i-1坐标系的 $X _{i-1}$ 轴方向，两个坐标系原点发生位移量为L，则 $a _{i-1}$ =L

$d _{i}$ ：表示沿着第frame_i坐标系的 $Z_{i}$ 轴方向，两个坐标系的原点发生了d的位移，则 $d _{i}$ =d

$\theta _{i}$ :从第frame_i坐标系的 $Z_{i}$ 轴向其坐标原点看过去， $X _{i}$ 轴相较于 $X _{i-1}$ 轴顺时针旋转 $M_{i}$ 度， $\theta _{i}$ = $-M_{i}$ （顺时针为负，逆时针为正）

二.不同坐标系间的坐标变换

对于两个坐标系间的坐标变换，存在：点Pa为A系下的坐标，若要变成B系，则=R+=，其中为A系到B系的变换矩阵；相当于A系在B系中的位姿坐标；相当于B系经过平移旋转和A系重合时，该平移旋转的组成为变换矩阵

那么对于两个轴之间的坐标转换，若要将第i个坐标系的点 $P_{i}$ 转换到i-1坐标系下 $P_{i-1}$ ，其变换矩阵相当于第i-1个坐标系，经过变换矩阵 $T^{_{i}^{i-1}}$ （一系列旋转平移）变成第i个坐标系。那么这一系列变换可分为连续的四个步骤，1）先将i-1坐标系经过 $a _{i-1}$ 旋转变为R坐标系，使得i-1坐标系与i坐标系的Z轴平行。2）将R系经过 $a _{i-1}$ 平移变成Q坐标系，使得i-1坐标系与i坐标系的原点的X,Y坐标相同