我正在尝试为我的 MCU 优化 sin/cos 以计算地理距离。这部分公式特别是使用三角函数:
double e = (MyTan( lat2 / 2 + quarter_pi ) / MyTan( lat1 / 2 + quarter_pi ));
因此,我尝试为 to 构建自己的sin/cos查找表,-PI如下PI所示:
#define PARTPERDEGREE 10
double mysinlut[PARTPERDEGREE * 90 + 1];
double mycoslut[PARTPERDEGREE * 90 + 1];
void MySinCosCreate()
{
    int i;
    double angle, angleinc;
    // Each degree also divided into 10 parts
    angleinc = (M_PI / 180) / PARTPERDEGREE;
    for (i = 0, angle = 0.0; i <= (PARTPERDEGREE * 90 + 1); ++i, angle += angleinc)
    {
        mysinlut[i] = sin(angle);
    }
    angleinc = (M_PI / 180) / PARTPERDEGREE;
    for (i = 0, angle = 0.0; i <= (PARTPERDEGREE * 90 + 1); ++i, angle += angleinc)
    {
        mycoslut[i] = cos(angle);
    }
}
double MySin(double rad)
{
   int ix;
   int sign = 1;
   if(rad > (M_PI / 2))
        rad = M_PI / 2 - (rad - M_PI / 2);
   if(rad < -(M_PI / 2))
       rad = -M_PI / 2 - (rad + M_PI / 2);
   if(rad < 0)
   {
        sign = -1;
        rad *= -1;
   }
   ix = (rad * 180) / M_PI * PARTPERDEGREE;
   return sign * mysinlut[ix];
}
double MyCos(double rad)
{
   int ix;
   int sign = 1;
    if(rad > M_PI / 2)
    {
        rad = M_PI / 2 - (rad - M_PI / 2);
        sign = -1;
    }
    else if(rad < -(M_PI / 2))
    {
        rad = M_PI / 2 + (rad + M_PI / 2);
        sign = -1;
    }
    else if(rad > -M_PI / 2 && rad < M_PI / 2)
    {   
        rad = abs(rad);
        sign = 1;
    }
    ix = (rad * 180) / M_PI * PARTPERDEGREE;
    return sign * mycoslut[ix];
}
double MyTan(double rad)
{
    return MySin(rad) / MyCos(rad);
}
您可以看到表格的分辨率是每度 10 份。我可以稍微增加它,但它没有多大帮助,看起来我需要一些插值。任何人都可以建议对我的功能进行一些实际的改进以获得更好的结果吗?下面是 234 个不同结果的图表e。蓝色系列具有理想的 sin/cos,红色系列来自 LUT。
