Diff: vibro.c

Revision:

100:e197a8d2cf43

Parent:

99:3d8f206ceac2

Child:

101:bb7472afb947

--- a/vibro.c	Tue Mar 29 17:00:59 2016 +0000
+++ b/vibro.c	Wed Mar 30 10:46:50 2016 +0000
@@ -113,15 +113,16 @@
             Time_vibro=0;
             break;
         case 20:
-MaxAmp=Buff_Restored_sin [CountV31];  
-            Gyro.Amp -= (MaxAmp - 200)*2;  // расчет амплитудв с учетом разници
+            MaxAmp=Buff_Restored_sin [CountV31];  
+           Gyro.Amp -= (MaxAmp - 200)*2;  // расчет амплитудв с учетом разници
+      
             ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
             if(Gyro.Amp>5500000) {
                 Gyro.Amp=1200000;   // временное ограничение роста амплитуды в случае неподоженного гироскопа//////////
             }
             ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
 
-            Gyro.AmpPer = Gyro.Amp>>16;
+            Gyro.AmpPer =Gyro.Amp>>16;
             ffff=MaxAmp;
             MaxAmp=0;
             break;
@@ -130,12 +131,12 @@
             Time_vibro=0;
 
 // расчет Фазы с учетор разници
-     TempFaza = -4;
+  /*   TempFaza = -4;
             for (CountFaza = 0; CountFaza <8; CountFaza++ ) {
                 if (Buff_Restored_sin [(CountV255 - 12  + CountFaza) & 0xff] > 0 ) TempFaza++;
             } 
-          //  FrecTp=Buff_Restored_sin [(CountV31 - 12  + CountFaza) & 0xff];
-         //   Gyro.Frq -=TempFaza*1000;
+          FrecTp=Buff_Restored_sin [(CountV31 - 12  + CountFaza) & 0xff];
+          Gyro.Frq -=TempFaza*1000;*/
             break;
     }