CORDIC или метод Волдера

vital792

void cordic32_core_rotation(int *x, int *y, int *z, int n)
{
    int k, d, t;
    int xt = *x, yt = *y, zt = *z; //xt = альфа; yt = 0, zt = 1/k
    for (k=0; k<n; ++k)
    {
        d = zt >> 31;    //d = z>=0 ? 0 : -1; 
        t = xt;
        xt += (((yt>>k) ^ d) - d); //здес вычисляется cos(альфа) ?
        yt -= (((t>>k) ^ d) - d);  //здесь минус синус ?
        zt -= ((cordic_tab[k] ^ d) - d); //здесь уменьшается альфа -> 0
    }
    *x = xt, *y = yt, *z = zt;
}

#include <iostream>
 
//Constants
#define cordic_1K 0x26DD3B6A    // 1/k = 0.6072529350088812561694
#define half_pi 0x6487ED51      // pi / 2
#define MUL 1073741824.000000   // 1.0 = 1073741824
#define CORDIC_NTAB 32
int cordic_tab [] = {
    0x3243F6A8, 0x1DAC6705, 0x0FADBAFC, 0x07F56EA6, 0x03FEAB76, 0x01FFD55B, 0x00FFFAAA, 0x007FFF55,
    0x003FFFEA, 0x001FFFFD, 0x000FFFFF, 0x0007FFFF, 0x0003FFFF, 0x0001FFFF, 0x0000FFFF, 0x00007FFF,
    0x00003FFF, 0x00001FFF, 0x00000FFF, 0x000007FF, 0x000003FF, 0x000001FF, 0x000000FF, 0x0000007F,
    0x0000003F, 0x0000001F, 0x0000000F, 0x00000008, 0x00000004, 0x00000002, 0x00000001, 0x00000000
};
 
// rotation mode
void cordic32_core_rotation(int *x, int *y, int *z, int n)
{
    int k, d, t;
    int xt = *x, yt = *y, zt = *z;
    for (k=0; k<n; ++k)
    {
        d = zt >> 31;    //d = z>=0 ? 0 : -1;
        t = xt;
        xt += (((yt>>k) ^ d) - d); //здес вычисляется cos(альфа)
        yt -= (((t>>k) ^ d) - d);  //здесь минус синус
        zt -= ((cordic_tab[k] ^ d) - d); //здесь уменьшается альфа -> 0
    }
    *x = xt, *y = yt, *z = zt;
    std::cout << "cos = " << xt << std::endl;
} 
 
void cordic32_sincos(int alpha, int *s, int *c)
{
    int z = alpha;
    *s = 0, *c = cordic_1K;
    cordic32_core_rotation(c, s, &z, 32);
}
 
 
int main ( )
{
     int a = 10;
     int *d1 = &a;
     int *d2 = &a;
     cordic32_sincos(90, d1, d2);
     return 0;
}

#include <iostream>
#include <math.h>
 
//Constants
#define pi 3.1415926536897932384626
 
#define cordic_1K 0x26DD3B6A    // 1/k = 0.6072529350088812561694
#define half_pi 0x6487ED51      // pi / 2
#define MUL 1073741824.000000   // 1.0 = 1073741824
#define CORDIC_NTAB 32
int cordic_tab [] = {
    0x3243F6A8, 0x1DAC6705, 0x0FADBAFC, 0x07F56EA6, 0x03FEAB76, 0x01FFD55B, 0x00FFFAAA, 0x007FFF55,
    0x003FFFEA, 0x001FFFFD, 0x000FFFFF, 0x0007FFFF, 0x0003FFFF, 0x0001FFFF, 0x0000FFFF, 0x00007FFF,
    0x00003FFF, 0x00001FFF, 0x00000FFF, 0x000007FF, 0x000003FF, 0x000001FF, 0x000000FF, 0x0000007F,
    0x0000003F, 0x0000001F, 0x0000000F, 0x00000008, 0x00000004, 0x00000002, 0x00000001, 0x00000000
};
 
// rotation mode
void cordic32_core_rotation(int *x, int *y, int *z, int n)
{
    int k, d, t;
    int xt = *x, yt = *y, zt = *z;
    for (k=0; k<n; ++k)
    {
        d = zt >> 31;    //d = z>=0 ? 0 : -1;
        t = xt;
        xt -= (((yt>>k) ^ d) - d); //здес вычисляется cos(альфа)
        yt += (((t>>k) ^ d) - d);  //здесь минус синус
        zt -= ((cordic_tab[k] ^ d) - d); //здесь уменьшается альфа -> 0
    }
    *x = xt, *y = yt, *z = zt;
}
 
void cordic32_sincos(int alpha, int *s, int *c)
{
    int z = alpha;
    *s = 0, *c = cordic_1K;
    cordic32_core_rotation(c, s, &z, 32);
}
 
int main()
{
     int d1, d2;
     double angle = -80.0; // degree
 
     std::cout << "cos = " << cos(angle*pi/180) << std::endl; // radian
     cordic32_sincos(angle*pi/180*MUL, &d1, &d2);
     std::cout << "cordic cos = " << (double)d2/MUL << std::endl;
     std::cout << "sin = " << sin(angle*pi/180) << std::endl;
     std::cout << "cordic sin = " << (double)d1/MUL << std::endl;
     return 0;
}