文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > IT/计算机 > 计算机软件及应用 > 最小二乘 影像匹配程序
侵权投诉

最小二乘 影像匹配程序

// 最小二乘
bool CPicMatchDoc::LeastSquare(int p[],double pt[],int n,double dre)
{
int nXsizel=pBitmapInfoL[0]->bmiHeader.biWidth;
int nYsizel=pBitmapInfoL[0]->bmiHeader.biHeight;
int nXsizer=pBitmapInfoR[0]->bmiHeader.biWidth;
int nYsizer=pBitmapInfoR[0]->bmiHeader.biHeight;

if (p[0]-m_w/2-1<0||p[0]+m_w/2+1>=nXsizel
||p[1]-m_h/2-1<0||p[1]+m_h/2+1>=nYsizel)
return 0;
if (p[2]-m_w/2-1<0||p[2]+m_w/2+1>=nXsizer
||p[3]-m_h/2-1<0||p[3]+m_h/2+1>=nYsizer)
return 0;

//p[0] p[1]左片x y,p[2] p[3]右片x y
double a0=p[2]-p[0],a1=1,a2=0,b0=p[3]-p[1],b1=0,b2=1; //变形参数
double h0=0,h1=1; //灰度辐射畸变
double V[8]={0}; //改正数,对应h0,h1,a0,a1……

double *C=new double[m_w*m_h*8]; //系数矩阵,大小为 窗口X8
double *L=new double[m_w*m_h]; //灰度差矩阵,左片-右片
double *CT=new double[m_w*m_h*8]; //系数矩阵,大小为 窗口X8

double CTC[64]={0};
double CTL[8]={0};

memset(C,0,m_w*m_h*8*sizeof(double));
memset(CT,0,m_w*m_h*8*sizeof(double));
memset(L,0,m_w*m_h*sizeof(double));

unsigned char **pl=new unsigned char*[m_w+2]; //左片灰度值 x坐标在前
unsigned char **pr=new unsigned char*[m_w+2]; //右片灰度值 y坐标在后

double **lx=new double *[m_w+2]; //左片窗口x坐标
double **ly=new double *[m_w+2]; //左片窗口y坐标
double **rx=new double *[m_w+2]; //右片窗口x坐标
double **ry=new double *[m_w+2]; //右片窗口y坐标

for(int m=0;m<m_w+2;m++)
{
pl[m]=new unsigned char[m_h+2];
memset(pl[m],0,sizeof(unsigned char)*(m_h+2));
pr[m]=new unsigned char[m_h+2];
memset(pr[m],0,sizeof(unsigned char)*(m_h+2));
lx[m]=new double[m_h+2];
ly[m]=new double[m_h+2];
rx[m]=new double[m_h+2];
ry[m]=new double[m_h+2];
memset(lx[m],0,sizeof(double)*(m_h+2));
memset(ly[m],0,sizeof(double)*(m_h+2));
memset(rx[m],0,sizeof(double)*(m_h+2));
memset(ry[m],0,sizeof(double)*(m_h+2));
}

#define l(i,j) (int)((nXsizel*8+31)/32)*4*j+i
#define r(i,j) (int)((nXsizer*8+31)/32)*4*j+i

int i,j; //循环变量

for(j=0;j<m_h+2;j++)
{
for (i=0;i<m_w+2;i++)
{
lx[i][j]=p[0]-m_w/2-1+i;
ly[i][j]=p[1]-m_h/2-1+j;
int mmm=l((p[0]-m_w/2-1+i),(p[1]-m_h/2-1+j));
pl[i][j]=pDataL[0][mmm];
}
}

double re[2]={dre,-1};
int mcount=0;
double th0,th1,ta0,ta1,ta2,tb1,tb2,tb0;
while (mcount!=n)
{
mcount++;
//计算右片坐标 重采样
for(j=0;j<m_h+2;j++)
{
for (i=0;i<m_w+2;i++)
{
rx[i][j]=a0+a1*lx[i][j]+a2*ly[i][j];
ry[i][j]=b0+b1*lx[i][j]+b2*ly[i][j];
if (rx[i][j]<0||ry[i][j]<0||(int)rx[i][j]+1>=nXsizer-1||(int)ry[i][j]+1>=nYsizer-1)
return 0;
if ((rx[i][j]-(int)rx[i][j]==0)&&(ry[i][j]-(int)ry[i][j]==0))
pr[i][j]=pDataR[0][r(((int)rx[i][j]),((int)ry[i][j]))];
else
{
int x1=(int)rx[i][j];
int y1=(int)ry[i][j];
double dx=rx[i][j]-x1;
double dy=ry[i][j]-y1;

pr

第1页

你可能喜欢

热门文档

相关文档

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email