Diff: vibro.c

Revision:

108:030cdde08314

Parent:

107:4d178bcc9d8a

Child:

112:4a96133a1311

diff -r 4d178bcc9d8a -r 030cdde08314 vibro.c
--- a/vibro.c	Fri Apr 01 16:13:55 2016 +0000
+++ b/vibro.c	Sat Apr 02 11:15:38 2016 +0000
@@ -104,7 +104,9 @@
 {  
     static int TempFaza, CountFaza;
  
-    if (Buff_Restored_sin [CountV31] > MaxAmp) {MaxAmp = Buff_Restored_sin [CountV31];}  // подумать со знаком*/
+//   if (Buff_Restored_sin [CountV31] > MaxAmp) {MaxAmp = Buff_Restored_sin [CountV31];}  // подумать со знаком*/
+    
+    
     switch(CountV31) {
         case 0:
             CalcAmpN();//расчет ошумления и амплитуды задание интервалов выставки ножек вибро.
@@ -114,22 +116,30 @@
             Time_vibro=0;
             break;
         case 24:
-            Gyro.Amp -= (MaxAmp - 350)*50;  // расчет амплитудв с учетом разници
+
+MaxAmp = CaunAddPlus + CaunAddMin;
+CaunPlus = CaunAddPlus;
+CaunMin  = CaunAddMin;
+CaunAddPlus = 0;
+CaunAddMin = 0;
+        
+            Gyro.Amp -= (MaxAmp - 5000) * 1;  // расчет амплитудв с учетом разници
             ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
             if((Gyro.Amp>>16) > 95) {Gyro.Amp= (95 << 16);   // временное ограничение роста амплитуды в случае неподоженного гироскопа//////////
             }
             ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
+			Gyro.AmpPer = Gyro.Amp>>16;
 
-            Gyro.AmpPer = Gyro.Amp>>16;
-            amp=MaxAmp;
-            MaxAmp=0;
+            
+//            amp=MaxAmp;
+//            MaxAmp=0;
             break;
 
         case 16:
             Time_vibro=0;
 
 // расчет Фазы с учетор разници
-     TempFaza = -4;
+     	TempFaza = -4;
             for (CountFaza = 0; CountFaza <8; CountFaza++ ) {
                 if (Buff_Restored_sin [(CountV31 -12  + CountFaza) & 0xff] > 0 ) TempFaza++;
             }