旋转矢量转旋转矩阵

功能: 通过罗德里格斯方法将旋转矢量转换成旋转矩阵

输入参数

名称 类型 合法范围 缺省值 含义

旋转矢量

List

[0, 0, 0, 0, 0, 0]

旋转矢量, 为6位的数组,默认为[0,0,0,0,0,0]

输出参数

名称 类型 合法范围 缺省值 含义

旋转矩阵

Matrix

旋转矩阵,输出为4*4的矩阵