效果

脚本

import numpy as np
import math
import csv
import os
from settings import *

def euler_to_rotation_matrix(roll, pitch, yaw):
    # 计算旋转矩阵
    # Z-Y-X转换顺序
    Rz