opencv2.4.9 相机定标及图像矫正

#include “opencv2/core/core.hpp“
#include “opencv2/imgproc/imgproc.hpp“
#include “opencv2/calib3d/calib3d.hpp“
#include “opencv2/highgui/highgui.hpp“
#include 
#include 

using namespace cv;
using namespace std;

void main（） 
{
	ifstream fin（“calibdata.txt“）; /* 标定所用图像文件的路径 */
	ofstream fout（“caliberation_result.txt“）;  /* 保存标定结果的文件 */	
	//读取每一幅图像，从中提取出角点，然后对角点进行亚像素精确化	
	cout<<“开始提取角点………………“;
	int image_count=0;  /* 图像数量 */
	Size image_size;  /* 图像的尺寸 */
	Size board_size = Size（46）;    /* 标定板上每行、列的角点数 */
	vector image_points_buf;  /* 缓存每幅图像上检测到的角点 */
	vector> image_points_seq; /* 保存检测到的所有角点 */
	string filename;
	int count= -1 ;//用于存储角点个数。
	while （getline（finfilename））
	{
		image_count++;		
		// 用于观察检验输出
		cout<<“image_count = “<		/* 输出检验*/
		cout<<“-->count = “<		Mat imageInput=imread（filename）;
		if （image_count == 1）  //读入第一张图片时获取图像宽高信息
		{
			image_size.width = imageInput.cols;
			image_size.height =imageInput.rows;			
			cout<<“image_size.width = “<			cout<<“image_size.height = “<		}

		/* 提取角点 */
		if （0 == findChessboardCorners（imageInputboard_sizeimage_points_buf））
		{			
			cout<<“can not find chessboard corners!\n“; //找不到角点
			exit（1）;
		} 
		else 
		{
			Mat view_gray;
			cvtColor（imageInputview_grayCV_RGB2GRAY）;
			/* 亚像素精确化 */
			find4QuadCornerSubpix（view_grayimage_points_bufSize（55））; //对粗提取的角点进行精确化
			image_points_seq.push_back（image_points_buf）;  //保存亚像素角点
			/* 在图像上显示角点位置 */
			drawChessboardCorners（view_grayboard_sizeimage_points_buftrue）; //用于在图片中标记角点
			imshow（“Camera Calibration“view_gray）;//显示图片
			waitKey（500）;//暂停0.5S		
		}
	}
	int total = image_points_seq.size（）;
	cout<<“total = “<	int CornerNum=board_size.width*board_size.height;  //每张图片上总的角点数
	for （int ii=0 ; ii	{
		if （0 == ii%CornerNum）// 24 是每幅图片的角点个数。此判断语句是为了输出 图片号，便于控制台观看 
		{	
			int i = -1;
			i = ii/CornerNum;
			int j=i+1;
			cout<<“--> 第 “< : “<		}
		if （0 == ii%3）	// 此判断语句，格式化输出，便于控制台查看
		{
			cout<		}
		else
		{
			cout.width（10）;
		}
		//输出所有的角点
		cout<<“ -->“<		cout<<“ -->“<	}	
	cout<<“角点提取完成！\n“;

	//以下是摄像机标定
	cout<<“开始标定………………“;
	/*棋盘三维信息*/
	Size square_size = Size（1010）;  /* 实际测量得到的标定板上每个棋盘格的大小 */
	vector> object_points; /* 保存标定板上角点的三维坐标 */
	/*内外参数*/
	Mat cameraMatrix=Mat（33CV_32FC1Scalar::all（0））; /* 摄像机内参数矩阵 */
	vector point_counts;  // 每幅图像中角点的数量
	Mat distCoeffs=Mat（15CV_32FC1Scalar::all（0））; /* 摄像机的5个畸变系数：k1k2p1p2k3 */
	vector tvecsMat;  /* 每幅图像的旋转向量 */
	vector rvecsMat; /* 每幅图像的平移向量 */
	/* 初始化标定板上角点的三维坐标 */
	int ijt;
	for （t=0;t	{
		vector tempPointSet;
		for （i=0;i		{
			for （j=0;j