数值图像处理之刚性变换匹配源代码（opencv）

#include<stdio.h>
#include <cv.h>
#include <highgui.h>


double Initiasigma2(CvMat* E,CvMat* F);//初始化sigma的值
CvMat* Compute_P(CvMat* E,CvMat* F,double sigma2);
double Compute_Np(CvMat* A);//计算Np的值(矩阵所有原始求和)
CvMat* Mat_mul(CvMat* A,CvMat* B);//矩阵乘法运算
CvMat* Mat_transpose(CvMat* A);//矩阵转置
double Mat_trace(CvMat* A);//矩阵的迹
CvMat* CreateMat_col(CvMat* A);//创建列矩阵(元素均为1)
CvMat* Mat_number_Mul(CvMat* A,double Num);//数与矩阵相乘
CvMat* Mat_sub(CvMat* A,CvMat* B);//矩阵的减法运算
CvMat* Mat_Invert(CvMat* A);//矩阵求逆运算
CvMat* Mat_Create_dia(CvMat* A);//创建对角矩阵
CvMat* Mat_Add(CvMat* A,CvMat* B);//矩阵的加法运算
IplImage* Y_CreatePointImage(CvMat* A);
CvMat* CreateMat_col_dia(CvMat* A);

void main()
{
CvMat* X1;
CvMat* Y1;
CvMat* B1;
CvMat* tt;
CvMat* t_y;
CvMat* Y_EM;
CvMat* X_Origin;
CvMat* Y_Origin;

double vals[]={1,0.5,0.3,1};
double t_val[]={10,10};
double ty_vals[]={150,150};

B1=cvCreateMat(2,2,CV_64F);
cvInitMatHeader(B1,2,2,CV_64F,vals);

tt=cvCreateMat(2,1,CV_64F);
cvInitMatHeader(tt,2,1,CV_64F,t_val);


    t_y=cvCreateMat(2,1,CV_64F);
    cvInitMatHeader(t_y,2,1,CV_64F,ty_vals);

int i=0;
int Iteration=30;

//加载X点集
X1=(CvMat*)cvLoad("2D_fish_X.xml");
//生成Y点集
Y1=cvCloneMat(X1);
Y1=Mat_Add(Mat_mul(Y1,B1),Mat_mul(CreateMat_col(Y1),Mat_transpose(tt)));
//显示X,Y点集的图像
X_Origin=Mat_Add(Mat_number_Mul(X1,100),Mat_mul(CreateMat_col(X1),Mat_transpose(t_y)));
Y_Origin=Mat_Add(Mat_number_Mul(Y1,100),Mat_mul(CreateMat_col(Y1),Mat_transpose(t_y)));
IplImage* src=Y_CreatePointImage(X_Origin);
cvNamedWindow("Original_Img");
cvShowImage("Original_Img",src);