光栅投影解相位

#include 
#include 
#include 
#include 
#include 
using namespace std;

#define w 640
#define h 480
#define pi 3.14159
#define t 32
#define l 600
#define d 500

#define beta 2*pi*9*15.5/532

//参考平面
double a0[h][w] = {0};
double a1[h][w] = {0};
double a2[h][w] = {0};
double a3[h][w] = {0};

//被测物
double b0[h][w] = {0};
double b1[h][w] = {0};
double b2[h][w] = {0};
double b3[h][w] = {0};

double det1[h][w] = {0};
double det2[h][w] = {0};

int k0[h][w] = {0};	//参考平面阶次
int k1[h][w] = {0};	//被测物阶次

double ph0[h][w] = {0};	//相对相位
double ph1[h][w] = {0};	//参考平面绝对相位
double ph2[h][w] = {0};	//被测物绝对相位
double d_ph[h][w] =  {0}; //相位差

double z[ h *w ] = {0};	//z轴坐标
int main（）
{

	//CvMat* mat = cvCreateMat（whCV_8UC1）;
	//cvZero（mat）;//将矩阵置0
	//参考平面投影光栅
	for （int i = 0; i < h; i++）
	{
		for （int j = 0; j < w; j++）
		{
			a0[i][j] = 128+127*cos（2*pi/t*j）;
			a1[i][j] = 128+127*cos（2*pi/t*j+0.5*pi）;
			a2[i][j] = 128+127*cos（2*pi/t*j+pi）;
			a3[i][j] = 128+127*cos（2*pi/t*j+1.5*pi）;
		}		
	}
	//被测物体投影光栅
	for （int i = 0; i < h; i++）
	{
		for （int j = 0; j < w; j++）
		{
			b0[i][j] = a0[i][j];
			b1[i][j] = a1[i][j];
			b2[i][j] = a2[i][j];
			b3[i][j] = a3[i][j];
		}		
	}

	for （int i = 150; i < 300; i++）
	{
		for （int j = 250; j < 500; j++）
		{
			b0[i][j] = 128+127*cos（2*pi/t*j + pi/10）;
			b1[i][j] = 128+127*cos（2*pi/t*j + pi/10 + 0.5*pi）;
			b2[i][j] = 128+127*cos（2*pi/t*j + pi/10 + pi）;
			b3[i][j] = 128+127*cos（2*pi/t*j + pi/10 + 1.5*pi）;
		}		
	}

	for （int i = 0; i < h; i++）
	{
		for （int j = 0; j < w; j++）
		{
			ph0[i][j]=atan（（a3[i][j]-a1[i][j]）/（a0[i][j]-a2[i][j]））;
			
		}		
	}
	for （int i = 0; i < h; i++）
	{
		for （int j = 0; j < w; j++）
		{
			det1[i][j]=atan（（a2[i][j]-a1[i][j]）/（a0[i][j]-a1[i][j]））+pi/4;
		}		
	}

	for （int i = 0; i < h; i++）
	{
		for （int j = 0; j < w; j++）
		{
			det2[i][j] = atan（（（1-cos（beta））*（a0[i][j]-a2[i][j]））/（（sin（beta））*（2*a1[i][j]-a0[i][j]-a2[i][j]）））;
		}		
	}
	for （int i = 0; i < h; i++）
	{
		for （int j = 1; j < w; j++）
		{
			if（（det2[i][j] - det2[i][j-1]） >=  pi/2）
				k0[i][j] = k0[i][j-1] -1;
			if（abs（det2[i][j] - det2[i][j-1]） <  pi/2）
				k0[i][j] = k0[i][j-1];
			if（（det2[i][j] - det2[i][j-1]） <=  -pi/2）
				k0[i][j] = k0[i][j-1] +1;
		}		
	}
	//参考平面绝对相位
	for （int i = 0; i < h; i++）
	{
		for （int j = 0; j < w; j++）
		{
			ph1[i][j] = det2[i][j] + k0[i][j] * pi;
		}		
	}

	//被测物解相位
	//被测物相对相位
		for （int i = 0; i < h; i++）
	{
		for （int j = 0; j < w; j++）
		{
			ph0[i][j]=atan（（b3[i][j]-b1[i][j]）/（b0[i][j]-b2[i][j]））;
			
		}		
	}
	for （int i = 0; i < h; i++）
	{
		for （int j = 0; j < w; j++）
		{
			det1[i][j]=atan（（b2[i][j]-b1[i][j]）/（b0[i][j]-b1[i][j]））+pi/4;
		}		
	}

	for （int i = 0; i < h; i++）
	{
		for （int j = 0; j < w; j++）
		{
			det2[i][j] = atan（（（1-cos（beta））*（b0[i][j]-b2[i][j]））/（（sin（beta））*（2*b1[i][j]-b0[i][j

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     目录           0  2013-10-14 21:07  mat
     目录           0  2013-10-14 20:56  matDebug
     文件      114688  2013-10-14 21:05  matDebugmat.exe
     文件      752168  2013-10-14 21:05  matDebugmat.ilk
     文件     1788928  2013-10-14 21:05  matDebugmat.pdb
     目录           0  2013-10-14 20:58  matmat
     目录           0  2013-10-14 21:05  matmatDebug
     文件       17282  2013-10-14 21:05  matmatDebugCL.read.1.tlog
     文件         578  2013-10-14 21:05  matmatDebugCL.write.1.tlog
     文件        1166  2013-10-14 21:05  matmatDebugcl.command.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink-cvtres.read.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink-cvtres.write.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink-rc.read.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink-rc.write.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.1120-cvtres.read.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.1120-cvtres.write.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.1120-rc.read.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.1120-rc.write.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.1120.read.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.1120.write.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.2232-cvtres.read.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.2232-cvtres.write.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.2232-rc.read.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.2232-rc.write.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.2232.read.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.2232.write.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.2504-cvtres.read.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.2504-cvtres.write.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.2504-rc.read.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.2504-rc.write.1.tlog
     文件           2  2013-10-14 21:05  matmatDebuglink.2504.read.1.tlog
............此处省略101个文件信息