forkd

Dependencies:   mbed

Fork of LGstaandart by Dmitry Kovalev

Revision:
221:53b256368ca1
Parent:
220:04c54405b82d
Child:
222:7de7b3bf3a1d
--- a/Command.c	Fri Oct 20 13:16:32 2017 +0000
+++ b/Command.c	Mon Oct 23 05:31:10 2017 +0000
@@ -156,40 +156,40 @@
     int Temp1;
    	float Temp2;
     int Shift = -11463;
-    static unsigned int t=15;
+    static unsigned int t=16;
 
 	BuffTemp[0] = Gyro.SOC_Out;
     BuffTemp[1] = Gyro.My_Addres;
 
-    	iRate_7 =(BuffADC_10v[(t - Gyro.PLC_Phase)&0x3f])&0xffff;
+    	iRate_7 =(BuffADC_10v_F[(t)&0x3f])&0xffff;
     BuffTemp[ 2] =(iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[ 3] =(iRate_7 >>  0) & 0xff;//младший байт разности счетчиков
    		
-   		iRate_7  =(BuffADC_10v[((t - 2) - (Gyro.PLC_Phase ))&0x3f])&0xffff;
+   		iRate_7  =(BuffADC_10v_F[(t - 2)&0x3f])&0xffff;
     BuffTemp[ 4] =(iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[ 5] =(iRate_7 >>  0) & 0xff;//младший байт разности счетчиков;
                         
-        iRate_7  =(BuffADC_10v[((t - 4) - (Gyro.PLC_Phase))&0x3f])&0xffff;
+        iRate_7  =(BuffADC_10v_F[((t - 4))&0x3f])&0xffff;
     BuffTemp[ 6] =(iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[ 7] =(iRate_7 >>  0) & 0xff;//младший байт разности счетчиков;
 
-        iRate_7  =(BuffADC_10v[((t - 6) - (Gyro.PLC_Phase))&0x3f])&0xffff;
+        iRate_7  =(BuffADC_10v_F[((t - 6))&0x3f])&0xffff;
     BuffTemp[ 8] =(iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[ 9] =(iRate_7 >>  0) & 0xff;//младший байт разности счетчиков;
 
-        iRate_7  =(BuffADC_10v[((t - 8) - (Gyro.PLC_Phase))&0x3f])&0xffff;
+        iRate_7  =(BuffADC_10v_F[((t - 8))&0x3f])&0xffff;
     BuffTemp[10] =(iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[11] =(iRate_7 >>  0) & 0xff;//младший байт разности счетчиков;
        
-  		iRate_7  =(BuffADC_10v[((t - 10) - (Gyro.PLC_Phase))&0x3f])&0xffff;
+  		iRate_7  =(BuffADC_10v[((t - 10))&0x3f])&0xffff;
     BuffTemp[12] =(iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[13] =(iRate_7 >>  0) & 0xff;//младший байт разности счетчиков;
 
-         iRate_7 =(BuffADC_10v[((t - 12) - (Gyro.PLC_Phase))&0x3f])&0xffff;
+         iRate_7 =(BuffADC_10v_F[((t - 12))&0x3f])&0xffff;
     BuffTemp[14] =(iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[15] =(iRate_7 >>  0) & 0xff;//младший байт разности счетчиков;
         
-         iRate_7 = (BuffADC_10v[((t - 14) - (Gyro.PLC_Phase))&0x3f])&0xffff;
+         iRate_7 = (BuffADC_10v_F[((t - 14))&0x3f])&0xffff;
     BuffTemp[16] =(iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[17] =(iRate_7 >>  0) & 0xff;//младший байт разности счетчиков;    
      
@@ -197,39 +197,39 @@
      
      
      
-         /* iRate_7 = ModArraySin32[(t)+ (Gyro.PLC_Phase)] - 50;
+        iRate_7 = ModArraySin[(t)+ (Gyro.PLC_Phase)] - 50;
     BuffTemp[ 18] = (iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[ 19] = (iRate_7 >>  0) & 0xff;//младший байт разности счетчиков;
        
-          iRate_7 = ModArraySin32[(t - 2+ (Gyro.PLC_Phase))&0x3f] - 50;
+          iRate_7 = ModArraySin[(t - 2+ (Gyro.PLC_Phase))&0x3f] - 50;
     BuffTemp[ 20] = (iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[ 21] = (iRate_7 >>  0) & 0xff;//младший байт разности счетчиков;
           
-          iRate_7 = ModArraySin32[(t - 4+ (Gyro.PLC_Phase))&0x3f] - 50;
+          iRate_7 = ModArraySin[(t - 4+ (Gyro.PLC_Phase))&0x3f] - 50;
     BuffTemp[ 22] = (iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[ 23] = (iRate_7 >>  0) & 0xff;//младший байт разности счетчиков;
            
-          iRate_7 = ModArraySin32[(t - 6+ (Gyro.PLC_Phase))&0x3f] - 50;
+          iRate_7 = ModArraySin[(t - 6+ (Gyro.PLC_Phase))&0x3f] - 50;
     BuffTemp[ 24] = (iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[ 25] = (iRate_7 >>  0) & 0xff;//младший байт разности счетчиков;
         
-          iRate_7 = ModArraySin32[(t - 8+ (Gyro.PLC_Phase))&0x3f] - 50;
+          iRate_7 = ModArraySin[(t - 8+ (Gyro.PLC_Phase))&0x3f] - 50;
     BuffTemp[ 26] = (iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[ 27] = (iRate_7 >>  0) & 0xff;//младший байт разности счетчиков;
 
-          iRate_7 = ModArraySin32[(t - 10+ (Gyro.PLC_Phase))&0x3f] - 50;
+          iRate_7 = ModArraySin[(t - 10+ (Gyro.PLC_Phase))&0x3f] - 50;
     BuffTemp[ 28] = (iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[ 29] = (iRate_7 >>  0) & 0xff;//младший байт разности счетчиков;
         
-          iRate_7 = ModArraySin32[(t - 12+ (Gyro.PLC_Phase))&0x3f] - 50;
+          iRate_7 = ModArraySin[(t - 12+ (Gyro.PLC_Phase))&0x3f] - 50;
     BuffTemp[ 30] = (iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[ 31] = (iRate_7 >>  0) & 0xff;//младший байт разности счетчиков;
            
-          iRate_7 = ModArraySin32[(t - 14+ (Gyro.PLC_Phase))&0x3f] - 50;
+          iRate_7 = ModArraySin[(t - 14+ (Gyro.PLC_Phase))&0x3f] - 50;
     BuffTemp[ 32] = (iRate_7 >>  8) & 0xff;//младший байт разности счетчиков
     BuffTemp[ 33] = (iRate_7 >>  0) & 0xff;//младший байт разности счетчиков;
    
-         */
+       
          
             iRate_7 = (Spi.DAC_B - 0x7fff);
     BuffTemp[ 34] =(iRate_7 >>  8) & 0xff;//младший байт разности счетчиков