Diff: QEI.c

Revision:

210:b02fa166315d

Parent:

209:224e7331a061

Child:

211:ac8251b067d2

--- a/QEI.c	Thu Apr 13 14:14:45 2017 +0000
+++ b/QEI.c	Mon Apr 24 05:43:54 2017 +0000
@@ -83,8 +83,8 @@
     	if(Buff_Restored_sin [CountV31] > 0)    Gyro.CaunPlusReperAdd  +=  Buff_1Point[(CountV31-Gyro.FrqPhase)&0x1f];  // счетчик положительных импульсов
     	else 								  	Gyro.CaunMinReperAdd   -=  Buff_1Point[(CountV31-Gyro.FrqPhase)&0x1f];  // счетчик отрицательных импульсов // расчет амплитуды
     	**/
-      	if(Buff_Restored_sin [CountV31]>0)      Gyro.CaunPlusReperAdd  +=  Buff_1Point[(CountV255-7)&0xff];  // счетчик положительных импульсов
-    	else 								  	Gyro.CaunMinReperAdd   -=  Buff_1Point[(CountV255-7)&0xff];  // счетчик отрицательных импульсов // расчет амплитуды
+      	if(Buff_Restored_sin [CountV31]>0)      Gyro.CaunPlusReperAdd  +=  Buff_1Point[(CountV255 - 8/*Gyro.FrqPhase */)&0xff];  // счетчик положительных импульсов
+    	else 								  	Gyro.CaunMinReperAdd   -=  Buff_1Point[(CountV255 - 8/*Gyro.FrqPhase*/ )&0xff];  // счетчик отрицательных импульсов // расчет амплитуды
   
     	/*if((Buff_1Point[CountV31]) > 0)       	Gyro.CaunPlusReperAdd  +=  Buff_1Point[(CountV255-7)&0xff];  // счетчик положительных импульсов
     	else 								  	Gyro.CaunMinReperAdd   -=  Buff_1Point[(CountV255-7)&0xff];  // счетчик отрицательных импульсов // расчет амплитуды*/
@@ -96,17 +96,24 @@
         Gyro.CaunMinRateAdd  = 0; 
         Gyro.CaunPlusRateAdd = 0;
         break;
-        case 10: 
-        Gyro.CaunMinReper  = Gyro.CaunMinReperAdd;
-        Gyro.CaunPlusReper = Gyro.CaunPlusReperAdd;
-        Gyro.CaunMinReperAdd  = 0; 
-        Gyro.CaunPlusReperAdd = 0;
-       
-    	    /*  sprintf((Time)," %d %d \r\n", Gyro.CaunMinReper, Gyro.CaunPlusReper);
-   			  WriteCon(Time); 	*/
+        /*   case 10:  
+    	   
+    	    Gyro.CaunMinReper  = Gyro.CaunMinReperAdd;
+            Gyro.CaunPlusReper = Gyro.CaunPlusReperAdd;
+            Gyro.CaunMinReperAdd  = 0; 
+            Gyro.CaunPlusReperAdd = 0;
+         sprintf((Time)," %d %d \r\n", Gyro.CaunMinReper, Gyro.CaunPlusReper);
+   			 WriteCon(Time); 	*/
+   			 
         break;
         }
-    	
+    	if(Gyro.FrqPhase==CountV31)
+    	{
+    		Gyro.CaunMinReper  = Gyro.CaunMinReperAdd;
+            Gyro.CaunPlusReper = Gyro.CaunPlusReperAdd;
+            Gyro.CaunMinReperAdd  = 0; 
+            Gyro.CaunPlusReperAdd = 0;
+        }
     	if(Buff_Restored_sin [CountV31] > 0)	
     	{
     		if(Gyro.Reper_Event)tempReper=0;
@@ -116,8 +123,14 @@
     	{
     		if(tempReper)
     		{ 
+    		
+    		
+
      		  tempReper=0;
     		  Gyro.Reper_Event=1;
+       
+
+
     		}
 	   	}