双目相机空间坐标重建.图像畸变处理（四）

双目相机空间坐标重建.图像畸变处理（四）

cv::Mat Im0 = cv::imread(“E:\zcb_work\2113\pic\ch1\left11.jpg”, 0);
if (Im0.empty())
return -1;
printf("++++ open image succesful +++\r\n");
imshow(“image0”, Im0);

double fx1 = 534.10766364;//mm
double fy1 = 534.01052742;//mm
double cx1 = 341.14525437;//mm
double cy1 = 234.85237461;//mm

double k1 = -0.291268580087220;
double k2 = 0.112956040249740;
double p1 = 0.000644024243857767;
double p2 = -0.000278487828264588;
double k3 = 0;

#if 1
//pic2 camera position
printf("pic2 camera position\r\n");	
{
		int i = 0;
		int j = 0;
		for( i = 0; i < h;i++)
		{			
			for( j = 0; j < w ;j++)
			{
			        double xDistorti