Diff: vibro.c

Revision:

104:ab1cb4ff56b2

Parent:

99:3d8f206ceac2

Child:

105:bd01d8d20fb6

--- a/vibro.c	Wed Mar 30 14:20:03 2016 +0000
+++ b/vibro.c	Thu Mar 31 10:16:56 2016 +0000
@@ -113,8 +113,8 @@
             Time_vibro=0;
             break;
         case 20:
-MaxAmp=Buff_Restored_sin [CountV31];  
-            Gyro.Amp -= (MaxAmp - 200)*2;  // расчет амплитудв с учетом разници
+MaxAmp = Buff_Restored_sin [CountV31];  
+            Gyro.Amp -= (MaxAmp - 300)*2;  // расчет амплитудв с учетом разници
             ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
             if(Gyro.Amp>5500000) {
                 Gyro.Amp=1200000;   // временное ограничение роста амплитуды в случае неподоженного гироскопа//////////
@@ -132,10 +132,12 @@
 // расчет Фазы с учетор разници
      TempFaza = -4;
             for (CountFaza = 0; CountFaza <8; CountFaza++ ) {
-                if (Buff_Restored_sin [(CountV255 - 12  + CountFaza) & 0xff] > 0 ) TempFaza++;
+                if (Buff_Restored_sin [(CountV31 -12  + CountFaza) & 0xff] > 0 ) TempFaza++;
             } 
           //  FrecTp=Buff_Restored_sin [(CountV31 - 12  + CountFaza) & 0xff];
-         //   Gyro.Frq -=TempFaza*1000;
+          if(Gyro.RgConA&0x1){
+           Gyro.Frq += TempFaza*1000;/// перепутан вибро 1 вибро 2
+            }   
             break;
     }