设定各个连杆坐标系列出相应的连杆DH参数写出各个连杆变换矩阵写成整个机器人的运动学方程