DH法计算机器人的正运动学 import numpy as np from functools import reduce np.set_printoptions(precision=4, suppress=True) 定义绕x/y/z旋转的旋转矩阵 def rotate(axis, deg)