【算法】Cordic算法的原理及matlab/verilog应用

刘小适2024-04-10 23:55

一、前言

单片机或者FPGA等计算能力弱的嵌入式设备进行加减运算还是容易实现，但是想要计算三角函数（sin、cos、tan），甚至双曲线、指数、对数这样复杂的函数，那就需要费些力了。通常这些函数的计算需要通者查找表或近似计算（如泰勒级数逼近）等技术来转换为硬件易于实现的方式。

CORDIC(Coordinate Rotation Digital Computer, 坐标旋转数字计算方法)算法就是一种化繁为简的算法，通过基本的加减和移位运算代替乘法运算，逐渐逼近目标值，得出函数的数值解。

二、Cordic算法理论推导

理论推导参考：CORDIC算法理论详解_cordic算法详解-CSDN博客，这篇博客的推导仔细而全面。

Cordic算法的基石在于一个规律：从tan45°开始，角度每减半，tan值也接近减半。这一规律直接将三角函数运算变成2的幂运算，而这在数字电路中可直接用移位运算来实现。

三、Cordic算法 matlab实现

3.1 已知相位（角度）求坐标（正弦余弦）

Matlab 复制代码

function [sin_theta,cos_theta] = cordic_sincos(theta,n)
% n:iterations
% theta: -180~180
tan_table = 2.^-(0 : n-1);
angle_rad_lut = atan(tan_table);
%angle_deg_lut = rad2deg( atan(tan_table) );
 
k = 1;
for i = 0 : n-1
    k = k*(1/sqrt(1 + 2^(-2*i)));
end
 

x = k;
y = 0;
theta_tar = theta*pi/180;  % to be rad
z=theta_tar;
 
% preprocess
if (theta_tar > pi/2)  
    theta_tar = theta_tar - pi/2;
elseif (theta_tar < -pi/2)
    theta_tar = theta_tar + pi/2;
end
     
 for i = 0 : n-1   
         if (z > 0)  
             d =1;
         else
             d=-1;
         end
        x_temp = x;
        y_temp =y;
        z_temp = z;
        x= x_temp - d*y_temp*2^(-i);
        y = y_temp + d*x_temp*2^(-i);
        z = z_temp - d*angle_rad_lut(i+1);
        
end
    
if (theta_tar > pi/2)  
    sin_theta = -x;
    cos_theta = y;
elseif (theta_tar < -pi/2)
    sin_theta = x;
    cos_theta = -y;
else
    sin_theta = y;
    cos_theta = x;
end
end

3.2 已知坐标求相位

待实现

四、cordic算法的verilog实现

待实现