双目相机下目标三维坐标计算（四）

本文来自公众号：机器人视觉
完成双目相机标定以后，获得双目相机的参数矩阵

包括左右相机的内参数矩阵、左右相机的畸变系数矩阵、右相机相对于左相机的旋转矩阵与平移矩阵

已知左右相机图像中的对应点坐标，获取目标在双目视觉传感器下三维坐标的流程如下：

1、将双目相机标定参数整理如下：

//左相机内参数矩阵
float leftIntrinsic[3][3] = { 3061.6936, -0.8869, 641.3042,
0, 3058.8751, 508.9555,
0, 0, 1 };

//左相机畸变系数
float leftDistortion[1][5] = { -0.0133, 0.6503, 0.0029, -0.0049, -16.8704 };
//左相机旋转矩阵
float leftRotation[3][3] = { 1, 0, 0,
0, 1, 0,
0, 0, 1 };
//左相机平移向量
float leftTranslation[1][3] = { 0, 0, 0 };

//右相机内参数矩阵
float rightIntrinsic[3][3] = { 3069.2482, -0.8951, 620.5357,
0, 3069.2450, 532.7122,
0, 0, 1 };
//右相机畸变系数
float rightDistortion[1][5] = { -0.0593, 3.4501, 0.0003, -8.5614, -58.3116 };
//右相机旋转矩阵
float rightRotation[3][3] = { 0.9989, 0.0131, -0.0439,
-0.0121, 0.9996, 0.0233,
0.0441, -0.0228, 0.9987};
//右相机平移向量
float rightTranslation[1][3] = {-73.8389, 2.6712, 3.3792};

2、二维像素坐标与相机坐标系下三维坐标转换

//************************************
// Description: 根据左右相机中成像坐标求解空间坐标
// Method:    uv2xyz
// FullName:  uv2xyz
// Parameter: Point2f uvLeft
// Parameter: Point2f uvRight
// Returns:   cv::Point3f
//************************************
Point3f uv2xyz(Point2f uvLeft, Point2f uvRight)
{
	//  [u1]      |X|					  [u2]      |X|
	//Z*|v1| = Ml*|Y|					Z*|v2| = Mr*|Y|
	//  [ 1]      |Z|					  [ 1]      |Z|
	//			  |1|								|1|
	Mat mLeftRotation = Mat(3, 3, CV_32F, leftRotation);
	Mat mLeftTranslation = Mat(3, 1, CV_32F, leftTranslation);
	Mat mLeftRT = Mat(3, 4, CV_32F);//左相机M矩阵
	hconcat(mLeftRotation, mLeftTranslation, mLeftRT);
	Mat mLeftIntrinsic = Mat(3, 3, CV_32F, leftIntrinsic);
	Mat mLeftM = mLeftIntrinsic * mLeftRT;
	//cout<<"左相机M矩阵 = "<

更换点对测试

	Point2f l = (857, 666);
	Point2f r = (303, 775);
	//Point2f l = (1014, 445);
	//Point2f r = (523, 387);
	Point3f worldPoint;
	worldPoint = uv2xyz(l, r);
	cout << "空间坐标为:" << endl << uv2xyz(l, r) << endl;
	system("pause");

更换点对测试：

	Point2f l = (931, 449);
	Point2f r = (370, 555);
	Point3f worldPoint;
	worldPoint = uv2xyz(l, r);
	cout << "空间坐标为:" << endl << uv2xyz(l, r) << endl;
	system("pause");

线结构光传感器标定（相机标定+结构光标定）完整流程（一）
https://blog.csdn.net/qq_27353621/article/details/120787942
UR机器人手眼标定（二）
https://blog.csdn.net/qq_27353621/article/details/121603215
双目相机标定（三）
https://blog.csdn.net/qq_27353621/article/details/121031972
公众号：机器人视觉