#include?“stdafx.h“
#include?
#include?“correspEstimation.h“
#include??
#include??
using?namespace?std;
#define?cvCopyImage（?src?dst?）?????????cvCopy（?src?dst?0?）

#define?WINDOW_OPTION??CV_BLUR
#define?PARAM1?3
#define?PARAM2?3
#define?RANGE_NEIGHBOR??6

//一維數組轉化為cvMat
void?Array2CvMat（float*arrCvMat*cvArrint?rowint?column）
{
	int?ij;
	for（i=0;i	{
		for（j=0;j		{
			cvmSet（cvArrijarr[i*column+j]）;
		}
	}
}

void?CvImageCopyUchar2Float（IplImage?*srcIplImage?*dst）
{
	int?ijk;
	int?height=src->height;
	int?width=src->width;
	int?channels=src->nChannels;
	int?step=src->widthStep;
	float?*dstData=（float*）dst->imageData;
	uchar?*srcData=（uchar*）src->imageData;
	//copy?uchar?precision?image?to?float?precision?image
	for（i=0;i	{
		for（j=0;j		{
			for（k=0;k			{
				dstData[i*step+j*channels+k]
					=（float）srcData[i*step+j*channels+k];
			
			}
		}
	}
}


void?GetffImage（IplImage?*inImage
				IplImage?*outImage
				CvMat?*kernel1st?
				CvMat?*kernel2nd
				CvPoint?anchor
				int?windowOption
				int?param1
				int?param2）
{
	IplImage?*tempImage?=?0;
	IplImage?*f1Image???=?0;
	IplImage?*f2Image???=?0;

	float?*f1Data??=?0;
	float?*f2Data??=?0;
	float?*outData?;
	
	int?width????=?inImage->width;
	int?height???=?inImage->height;
	int?channels?=?inImage->nChannels;
	int?step?????=?inImage->widthStep;

	f1Image???=?cvCreateImage（cvSize（width?height）?IPL_DEPTH_32F?channels）;
	f2Image???=?cvCreateImage（cvSize（width?height）?IPL_DEPTH_32F?channels）;
	tempImage?=?cvCreateImage（cvSize（width?height）?IPL_DEPTH_32F?channels）;

	f1Data??=?（float*）f1Image->imageData;
	f2Data??=?（float*）f2Image->imageData;
	outData?=?（float*）outImage->imageData;
	
	//把Uchar的圖象數據轉化為float
	CvImageCopyUchar2Float（inImage?tempImage）;
	
	//用kernel1st和kernel2nd對圖象分別在x和y方向進行卷積運算
	cvFilter2D（tempImage?f1Image?kernel1st?anchor）;
	cvFilter2D（tempImage?f2Image?kernel2nd?anchor）;

	//計算out=f1*f2;
	
	for（int?i?=?0;??i?	{
		for（int?j?=?0;?j?		{
			for（int?k?=?0?;?k?			{
				outData[i*step+j*channels+k]=f1Data[i*step+j*channels+k]
											*f2Data[i*step+j*channels+k];
			}
		}
	}
	
	//對輸出圖象進行平滑處理
	cvCopyImage（outImage?tempImage）;
	cvSmooth（tempImage?outImage?windowOptionparam1param2）;
	
	cvReleaseImage（&tempImage）;
	cvReleaseImage（&f1Image）;
	cvReleaseImage（&f2Image）;

}

//查找鄰域內最大值點
void?FindLocalMaxPoint（IplImage?*inImageIplImage?*mapint?range）
{
	int?width????=?inImage->width;;
	int?height???=?inImage->height;
	int?channels?=?inImage->nChannels;
	int?step?????=?map->widthStep;
	float?current;

	int?r?=?range/2;
	float?*inData=（float*）?inImage->imageData;
	uchar?*mapData=?（uchar*）map->imageData;
	int?sum;
	int?numOfNeighbor=?（2*r+1）*（2*r+1）;
	int?posI;
	int?posJ;

	for（int?i?=?0;?i?