核心算法,是用 的那个 cordic 算法..
http://www.cnblogs.com/signal/archive/2012/11/13/2768140.html
这里主要是想把算法弄到FPGA中去写的测试代码...
这里主要是贴关键代码:
void CTestImgDlg::OnImageCordic()
{
// TODO: Add your control notification handler code here
DWORD dwStart = GetTickCount();
int i;
int j;
for (i=0; i<m_HeightSW; i++)
{
for (j=0; j<m_WidthSW; j++)
{
// j = m_WidthSW/2;
int posX = i;
int posY = j;
BYTE val = this->GetImageCordic(posX,posY); --开始转换
m_pDataSW[i*m_WidthSW + j] = val;
}
}
CString str;
str.Format(" %d ", GetTickCount() - dwStart);
this->SetWindowText(str);
this->Invalidate();
}
#define MOV_POS_X (-256) //坐标变幻值
#define MOV_POS_Y (86)
#define US_IMG_W (81) // 原始图像的大小
#define US_IMG_H (256)
#define ANG_UNIT (60.0/(US_IMG_W - 1)) // 图像横像素所占角度
#define LEN_UNIT ((512 - 1 - 20)/(US_IMG_H*1.0)) // 图像坚像素所占长度
BYTE CTestImgDlg::GetImageCordic(int i, int j)
{
BYTE val = m_pDataSW[i*m_WidthSW + j];
// 直角坐标位置改变
double posX = i + MOV_POS_Y;
double posY = j + MOV_POS_X;
// posX = 300;
// posY = 300;
// 转为极坐标
double len;
double ang;
// cordic_int(i,j,len,ang);
cordic_double(posX,posY,len,ang);
// 换算为直角坐标的坐标
// double posX;
// double posY;
posX = ang/ANG_UNIT;
posY = len/LEN_UNIT;
posX = posX + US_IMG_W/2;
posY = posY - 56;
//最近邻的必要.........
// posX += 0.5;
// posY += 0.5;
// 没有落在图像上,则为黑色
if (posX < 0.0 || posX > US_IMG_W )
{
return 0;
}
if (posY < 0.0 || posY > US_IMG_H )
{
return 0;
}
// 下面是像素的计算--用的是简化计算, 把一个像素的落点分为8*8的可能区域,
// 如果要求更高,可以区分更细,而且不占什么时间, 不过我想没必要
int pointX = posX;
int pointY = posY;
//落点所在的区域
int X_c0 = (posX - pointX)*8;
int X_c1 = (posY - pointY)*8;
//取出四个点
int val00 = m_pDataUS[pointY * m_WidthUS + pointX];
int val01 = m_pDataUS[pointY * m_WidthUS + pointX + 1];
int val10 = m_pDataUS[(pointY+1) * m_WidthUS + pointX];
int val11 = m_pDataUS[(pointY+1) * m_WidthUS + pointX + 1];
//计算值--先求横向,再求纵向
int v1 = val00 + ((val01 - val00)>>3)*X_c0;
int v2 = val10 + ((val11 - val10)>>3)*X_c0;
val = v1 + ((v2 - v1)>>3)*X_c1;
// val = posY;
// 计算图像数值
return val;
}