电磁定位程序算法求解

风雨同舟1

void Angle_Culculate()            
{
     uint i;
     AD_GET_VALUE();
    /*******************************传感器定位*********************************

              此部分应该注意前面的ad采样回来的要滤波不然对后面的定位有影响
                                    made by liurui
                                             20/6/2011

     ******************************传感器定位**********************************/
     ref_AD=85;    //有待调试  
     lost_AD=255;   //有待调试

for(i=0;i<6;i++)
    {
       if(This_AD[i]>This_AD[max_num])
       max_num=i;   

    }
/***************************************************************************
                    d_max_num应该选择2或是3 选择4几乎就没有作用了
                                    跳变量是几需要实际调试
    ******************************************************************************/      

  if(max_num<last_max_num)
          d_max_num = last_max_num - max_num;         //计算跳变量
              else
                 d_max_num = max_num - last_max_num;

         if(d_max_num>=2)
              max_num=last_max_num;                     //非正常跳变
                 else
                    last_max_num = max_num;            //正常获取最大值   储存当前最大值                 
    last_max_num=max_num;                                 
    /***********************数据丢失标志位****************************/            

             if(This_AD[max_num]<lost_AD)         lost_fonction_flag=1;
                else
                    if(This_AD[max_num]>lost_AD)  lost_fonction_flag=0;

if(lost_fonction_flag==1)     //修改过，bug！！！！！！
  {
     this_position=last_position;
     if(last_position<=centre_position&&max_num==0&&This_AD[0]>lost_AD)          lost_fonction_flag=0;
          else  
              if(last_position>centre_position&&max_num==5&&This_AD[5]>lost_AD)  lost_fonction_flag=0;
  }

else
{
      if(max_num==0)     
          {   
                if(This_AD[0]<=ref_AD)   this_position=0;
                else                  
                  if(This_AD[1]<ref_AD)
                     this_position=0+20*(This_AD[0]-ref_AD)/(This_AD[0]-This_AD[1]);
                         else   
                            this_position=40-20*(This_AD[0]-This_AD[1])/(This_AD[0]-ref_AD);         
          }
       else if(max_num==5)   
                {
                     if(This_AD[5]<=ref_AD)    this_position=240;
                    else
                      if(This_AD[4]>ref_AD)    this_position=200+20*(This_AD[5]-This_AD[4])/(This_AD[5]-ref_AD);
                          else      
                            this_position=240-20*(This_AD[5]-ref_AD)/(This_AD[5]-This_AD[4]);
                }
想知道ref-AD在程序中的作用，求赐教

亦寒

感觉应该是对偏移量计算的修正，很多算法在偏移量增大到一定程度后计算出来的值反而变小