分别利用S-DH和M-DH两种坐标系模型建立坐标变换矩阵,又利用变换矩阵求出各个关节的参数变量,即机器人的正解与反解。
1