大神~请教你一个关于你的程序校正磁力计的一个小小的疑问.麻烦大神有时间能抽空解答下~O(∩_∩)O~~
在QCopterFC_it.c    127行开始会有一段校正程序,期间会有LED_B作为一个状态指示灯~
疑问一:  为什么会有 八组CASE? 分别测量些什么数据?如何操作~

1. switch((u16)(Correction_Time/600)) {
   
2.         case 0:
   
3.           LED_B = 0;
   
4.           MagDataX[0] = (s16)MoveAve_WMA(Mag.X, MAG_FIFO[0], MagCorrectionAve);  
   
5.           MagDataY[0] = (s16)MoveAve_WMA(Mag.Y, MAG_FIFO[1], MagCorrectionAve);
   
6.           break;
   
7.         case 1:
   
8.           LED_B = 1;
   
9.           MagDataX[1] = (s16)MoveAve_WMA(Mag.X, MAG_FIFO[0], MagCorrectionAve);
   
10.           MagDataY[1] = (s16)MoveAve_WMA(Mag.Y, MAG_FIFO[1], MagCorrectionAve);
    
11.           break;
    
12.         case 2:
    
13.           LED_B = 0;
    
14.           MagDataX[2] = (s16)MoveAve_WMA(Mag.X, MAG_FIFO[0], MagCorrectionAve);
    
15.           MagDataY[2] = (s16)MoveAve_WMA(Mag.Y, MAG_FIFO[1], MagCorrectionAve);
    
16.           break;
    
17.         case 3:
    
18.           LED_B = 1;
    
19.           MagDataX[3] = (s16)MoveAve_WMA(Mag.X, MAG_FIFO[0], MagCorrectionAve);
    
20.           MagDataY[3] = (s16)MoveAve_WMA(Mag.Y, MAG_FIFO[1], MagCorrectionAve);
    
21.           break;
    
22.         case 4:
    
23.           LED_B = 0;
    
24.           MagDataX[4] = (s16)MoveAve_WMA(Mag.X, MAG_FIFO[0], MagCorrectionAve);
    
25.           MagDataY[4] = (s16)MoveAve_WMA(Mag.Y, MAG_FIFO[1], MagCorrectionAve);
    
26.           break;
    
27.         case 5:
    
28.           LED_B = 1;
    
29.           MagDataX[5] = (s16)MoveAve_WMA(Mag.X, MAG_FIFO[0], MagCorrectionAve);
    
30.           MagDataY[5] = (s16)MoveAve_WMA(Mag.Y, MAG_FIFO[1], MagCorrectionAve);
    
31.           break;
    
32.         case 6:
    
33.           LED_B = 0;
    
34.           MagDataX[6] = (s16)MoveAve_WMA(Mag.X, MAG_FIFO[0], MagCorrectionAve);
    
35.           MagDataY[6] = (s16)MoveAve_WMA(Mag.Y, MAG_FIFO[1], MagCorrectionAve);
    
36.           break;
    
37.         case 7:
    
38.           LED_B = 1;
    
39.           MagDataX[7] = (s16)MoveAve_WMA(Mag.X, MAG_FIFO[0], MagCorrectionAve);
    
40.           MagDataY[7] = (s16)MoveAve_WMA(Mag.Y, MAG_FIFO[1], MagCorrectionAve);
    
41.           break;
    
42.         default:
    
43.           LED_B = 1;
    
44.           Correction_Time = 0;
    
45.           EllipseFitting(Ellipse, MagDataX, MagDataY, 8);
    
46.           Mag.OffsetX = Ellipse[1];
    
47.           Mag.OffsetY = Ellipse[2];
    
48.           SensorMode = Mode_Algorithm;  // 切換至運算模式
    
49.           break;
    
50.       }

复制代码

疑问二: 比如在 以上问中 CASE 0:中 代码如下:

1. case 0:
   
2.           LED_B = 0;
   
3.           MagDataX[0] = (s16)MoveAve_WMA(Mag.X, MAG_FIFO[0], MagCorrectionAve);  
   
4.           MagDataY[0] = (s16)MoveAve_WMA(Mag.Y, MAG_FIFO[1], MagCorrectionAve);
   
5.           break;

复制代码
对于为何会用  MAG_FIFO[0]还有MAG_FIFO[1]呢?根据MoveAve_WMA函数:代码如下:

1. s16 MoveAve_WMA( s16 NewData, s16 *MoveAve_FIFO, u8 SampleNum )
   
2. {
   
3.   u8 i = 0;
   
4.   s16 AveData = 0;
   
5.   u16 SampleSum = 0;
   
6.   s32 MoveAve_Sum = 0;
   
7. 
   
8.   for(i=0; i<SampleNum-1; i++)                // 陣列移動
   
9.     MoveAve_FIFO[i] = MoveAve_FIFO[i+1];
   
10.   MoveAve_FIFO[SampleNum-1] = NewData;        // 加入新數據
    
11.    
    
12.   for(i=0; i<SampleNum; i++)                  // 求和 & 加權
    
13.     MoveAve_Sum += MoveAve_FIFO[i]*(i+1);
    
14.    
    
15.   SampleSum = (SampleNum*(SampleNum+1))/2;    // 計算加權除數
    
16.   AveData = (s16)(MoveAve_Sum/SampleSum);     // 計算平均值
    
17. 
    
18.   return AveData;
    
19. }

复制代码
可知滑动加权平均算法中数组是从指针头往后的八位..这样子不是导致X,Y中有很大一部分重叠的值吗?重叠位在MAG_FIFO[1]~MAG_FIFO[7]中~
麻烦楼主大神解答下~谢谢