三角函数 求模 和 求角度算法

#include <stdio.h>
//x y 为Q8格式
//返回模长 角度 由最后两个变量返回指针值
int my_atan5(int x, int y,int * AP,int *XianP)
{
const int angle[] = {11520, 6801, 3593, 1824, 916, 458, 229, 115, 57, 29, 14, 7, 4, 2, 1};

int i = 0,j;
int x_new, y_new;
int angleSum = 0;

if(y<0){
 y = -y; // 3 4
 j=1;
}
else{
      // 2 1
 j=0;
}

if(x<0){
 x = -x; // 2 3 
 if(j == 0)j=2;else j= 3;
}
else{
      // 1 4
 if(j == 0)j=1;else j= 4;
}

for(i = 0; i < 15; i++)
{
    if(y > 0)
    {
        x_new = x + (y >> i);
        y_new = y - (x >> i);
        x = x_new;
        y = y_new;
        angleSum += angle[i];
    }
    else
    {
        x_new = x - (y >> i);
        y_new = y + (x >> i);
        x = x_new;
        y = y_new;
        angleSum -= angle[i];
    }
}

x *= 155;
x = x>>8;
*AP = angleSum;
*XianP = j;
return x;
}

int main()
{
int a,b,c;
/* 我的第一个 C 程序 */
a = my_atan5((0<<8),(8<<8),&b,&c);
printf(“第二象区 加90度 第三象区加180度 第四区加270度-45度 = 11520\n模长Sq8 = %d\n角度Aq8 = %d\n象区 =%d\n”,a,b,c);
return 0;
}

https://c.runoob.com/compile/11 可以这个网站 验证程序

程序中 角度用的是360度 Q8格式(实际值X256).由于int最大值 不能支持 360度 程序将所有度数控制在90度以内 实际度数按返回的象区 补偿上去然后格式转换成大一点的类型 比如LONG型 这个算法是CORDIC算法。是经典算法。本人是做单片机的 这个用来求 模电流做闭环。控制电机恒流运行。

    原文作者:a1031238455
    原文地址: https://blog.csdn.net/a1031238455/article/details/103453208
    本文转自网络文章,转载此文章仅为分享知识,如有侵权,请联系博主进行删除。
点赞