将欧拉角转换为旋转矩阵（手眼标定）python版本-Toy模板网

这篇具有很好参考价值的文章主要介绍了将欧拉角转换为旋转矩阵（手眼标定）python版本。希望对大家有所帮助。如果存在错误或未考虑完全的地方，请大家不吝赐教，您也可以点击"举报违法"按钮提交疑问。

一、手眼矩阵的分类

1、欧拉角版

[x,y,z,rx,ry,rz]

2、四元数版

[x,y,z,qx,qy,qz,qw]

3、旋转矩阵版本

[
    [r11,r12,r13,x],
    [r21,r22,r23,y],
    [r31,r32,r33,z]
]

4、齐次矩阵

[
    [r11,r12,r13,x],
    [r21,r22,r23,y],
    [r31,r32,r33,z]，
    [0,  0,  0,  1]
]

二、手眼标定的分类

python 欧拉角转旋转矩阵,手眼标定,工业机器人,视觉,python,矩阵,numpy,视觉检测文章来源地址https://www.toymoban.com/news/detail-567740.html

三、用python将欧拉角版转换为齐次矩阵

import numpy as np
import math

def eulerAnglesToRotationMatrix(theta):
    R_x = np.array([[1, 0, 0],
                    [0, math.cos(theta[0]), -math.sin(theta[0])],
                    [0, math.sin(theta[0]), math.cos(theta[0])]])

    R_y = np.array([[math.cos(theta[1]), 0, math.sin(theta[1])],
                    [0, 1, 0],
                    [-math.sin(theta[1]), 0, math.cos(theta[1])]])

    R_z = np.array([[math.cos(theta[2]), -math.sin(theta[2]), 0],
                    [math.sin(theta[2]), math.cos(theta[2]), 0],
                    [0, 0, 1]])
    R = np.dot(R_x, np.dot(R_y, R_z))
    return R
# 需要将角度值转换为弧度值
Rx = math.radians(189.4)
Ry = math.radians(0.6782)
Rz = math.radians(0.5492)
# 将转换坐标输入a
a = np.array([178.67, 731.98, 625.06])
theta = [Rx, Ry, Rz]
# 将转换结果放入m
m = eulerAnglesToRotationMatrix(theta)
# 合成旋转矩阵
d = np.array([0, 0, 0, 1])
b = np.row_stack((np.column_stack((m, a)), d))
n = np.array([[-63.51], [92.75], [723.51], [1]])
# 输出转换坐标
print(np.dot(b, n))
输出结果：
[[ 122.8422612 ]
 [ 759.36439782]
 [-104.48517409]
 [   1.        ]]