@staticmethod
def angle_pose_to_mat(pose):
    assert (len(pose) == 1)
    q = quatFromAxisAngle((0, 0, pose)).tolist()
    matrix = matrixFromPose((q + pos))
    return matrix
@staticmethod
def angle_pose_to_mat(pose):
    assert (len(pose) == 1)
    q = quatFromAxisAngle((0, 0, pose)).tolist()
    matrix = matrixFromPose((q + pos))
    return matrix