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