标定。。。

void Cmy3DScanMFCDlg::OnBnClickedButton3()//开始
{
    
	// TODO: 在此添加控件通知处理程序代码
	
	plistb->AddString(_T("开始标定："));


	cd.camera_points.clear();
	cd.cornerpoints_temp.clear();
	cd.cornerpoints.clear();
	cd.worldpoints.clear();
	grating.samples_FAI.clear();
	delete grating.src_grating_cllect;
	grating.src_grating_cllect = new cv::Mat[cam.group_num][13];
	cam.calib_num = cam.group_num;
	cam.calib_button_flag = 1;
	

}


void Cmy3DScanMFCDlg::OnBnClickedButton9()
{
    
	// TODO: 在此添加控件通知处理程序代码
	//bool flag = cd.collectWorldPoints(grating.src_grating[0]);
	bool flag = cd.collectWorldPointsCircle(grating.src_grating[0]);
	if (!flag)
	{
    
		CString CStemp;
		CStemp.Format(_T("%d"), cam.group_num +1-cam.calib_num);

		plistb->AddString(_T("第")+ CStemp+_T("次标定失败！"));
	}
	else
	{
    
		
		CString CStemp;
		CStemp.Format(_T("%d"), cam.group_num+1 - cam.calib_num);
		plistb->AddString(_T("第") + CStemp + _T("次标定完成！"));
		

		for (int i = 1;i < 13;++i)
		{
    
			grating.src_grating_cllect[cam.group_num - cam.calib_num][i] = grating.src_grating[i];
		}

		cam.calib_num--;
		
	}

	if (cam.calib_num == 0)
	{
    


		cd.cameraCalibrationChessBoard();

		for (int i = 0;i < cam.group_num;++i)
		{
    
			grating.threeFrequencyHeterodyneImproved(cd.cornerpoints[i], grating.src_grating_cllect[i]);
		}

		cd.calculateCameraPoints();
		cd.phase3DPointsMapping(grating.samples_FAI);
		plistb->AddString(_T("标定完成！！！") );
		delete grating.src_grating_cllect;
		grating.src_grating_cllect = new cv::Mat[cam.group_num][13];
	}

	


}