关于hough圆弧检测C++程序的问题

需要用到一个圆弧检测的程序，苦于网上没有C++版的，自己根据MATLAB函数写了一个，自己感觉没什么问题，编译也可以通过，但结果就是很奇怪，求各位大咖帮忙，新手，小白一个。。。。

void hough_circle(IplImage *BW,double step_r,double step_angle,double r_min,double r_max,double p)
{
	//[m,n] = size(BW);
	int m=BW->width,n=BW->height;
	int size_r = (int)((r_max-r_min)/step_r)+1;
	int size_angle = (int)(2*pi/step_angle);
	//hough_space = zeros(m,n,size_r);
	int l=m*n*size_r;
	int *hough_space=new int [l];
	for(int i=0;iheight*BW->width;
	Str *location=new Str [SIZE];
	int ecount=0;//计数，统计白点
	for (int i = 0; i < BW->height; i++)
     {
         for (int j = 0; j < BW->width; j++)
         {
            char  pixel = *(BW->imageData + i*BW->widthStep+j);
			if(pixel==255)
			{
				location[ecount].row=i;
				location[ecount].col=j;
				ecount++;
			}
		 }
	}

//ecount = size(rows);
 
/*% Hough变换
% 将图像空间(x,y)对应到参数空间(a,b,r)
% a = x-r*cos(angle)
% b = y-r*sin(angle)*/
/*for i=1:ecount
    for r=1:size_r
        for k=1:size_angle
            a = round(rows(i)-(r_min+(r-1)*step_r)*cos(k*step_angle));
            b = round(cols(i)-(r_min+(r-1)*step_r)*sin(k*step_angle));
            if(a>0&a<=m&b>0&b<=n)
                hough_space(a,b,r) = hough_space(a,b,r)+1;
            end
        end
    end
end*/
 int a=0,b=0;
 for(int i=0;i0)&(a<=m)&(b>0)&(b<=n))
				hough_space[r*m*n+a*m+b]++;
		 }

 
// 搜索超过阈值的聚集点
/*max_para = max(max(max(hough_space)));
index = find(hough_space>=max_para*p);
length = size(index);
hough_circle=zeros(m,n);*/
int max_para=hough_space[0];
for(int i=1;i=hough_space[i]?max_para:hough_space[i];
}
int thre=max_para*p;
int par1[LEN],par2[LEN],par3[LEN];
for (int j=0;j=thre)
	{
		par3[length]=i/(m*n)+1;
		par2[length]=(i%(m*n))/m+1;
		par1[length]=(i%(m*n))%m+1;
		length++;
	}
int size_h=m*n;
int *hough_circle=new int [size_h];
for (int i=0;i(r_min+(par3-1)*step_r)^2-5)
            hough_circle(rows(i),cols(i)) = 1;
        end
    end
end*/

//par3是半径，par1和par2是要检测的圆的坐标。
//index(k)在hough_space中的三维位置(par1,par2,par3)
for(int i=0;i(r_min+(par3[k]-1)*step_r)^2-5))
            hough_circle[location[i].row*m+location[i].col] = 1;

 
//打印结果 
cout<<"圆点坐标      "<<"半径     "<

如上，其中注释部分是MATLAB对应代码