Diff: vibro.c

Revision:

107:4d178bcc9d8a

Parent:

106:250ddd8629c6

Child:

108:030cdde08314

--- a/vibro.c	Fri Apr 01 10:05:35 2016 +0000
+++ b/vibro.c	Fri Apr 01 16:13:55 2016 +0000
@@ -4,7 +4,7 @@
 //volatile int Temp = 0 ;
 volatile unsigned int Flag=0;
 unsigned int FrecTemp=0;
-unsigned int FrecTp=0,ffff=0;
+unsigned int FrecTp=0,amp=0;
 
 
 void Discharg ()//проверка битового поля поджига  и  установка значения бита поджига
@@ -71,7 +71,7 @@
             Gyro.AmpN1=(unsigned int)((Nmax*(100-Gyro.AmpPer))/400);            //левая граница амплитуды
             Gyro.AmpN2=(unsigned int)((Nmax/2)-Gyro.AmpN1);                     //правая граница амплитуды
             Flag=1;
-            Gyro.tau = Gyro.AmpN2-Gyro.AmpN1;
+           
         }
 
         else {
@@ -83,7 +83,7 @@
             Gyro.AmpN1=(unsigned int)((Nmax*(100-Gyro.AmpPer+Gyro.AmpPerDel))/400);//левая граница амплитуды
             Gyro.AmpN2=(unsigned int)((Nmax/2)-Gyro.AmpN1);                        //правая граница амплитуды
             Flag=0;
-            Gyro.tau = Gyro.AmpN2-Gyro.AmpN1;
+            
         }
 
         //Tnoise=55;
@@ -103,9 +103,9 @@
 void cheng(void)
 {  
     static int TempFaza, CountFaza;
-    //if (Buff_Restored_sin [CountV255] > MaxAmp) {MaxAmp=Buff_Restored_sin [CountV255];}  // подумать со знаком
-
-     switch(CountV31) {
+ 
+    if (Buff_Restored_sin [CountV31] > MaxAmp) {MaxAmp = Buff_Restored_sin [CountV31];}  // подумать со знаком*/
+    switch(CountV31) {
         case 0:
             CalcAmpN();//расчет ошумления и амплитуды задание интервалов выставки ножек вибро.
             //Vib.Frq = ((unsigned int) ((7680000*16/Output.Str.T_Vibro)))*16*16*16; //прием частоты из аск_глд старый протокол
@@ -113,17 +113,15 @@
 //            Output.Str.T_Vibro=(unsigned int)((7680000*16/Gyro.Frq)*4096); //запись частоты для выдачи в аск_глд старый протокол
             Time_vibro=0;
             break;
-        case 20:
-            MaxAmp = Buff_Restored_sin [CountV31];  
-            Gyro.Amp -= (MaxAmp - 150)*2;  // расчет амплитудв с учетом разници
+        case 24:
+            Gyro.Amp -= (MaxAmp - 350)*50;  // расчет амплитудв с учетом разници
             ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
-            if(Gyro.Amp>5500000) {
-                Gyro.Amp=1200000;   // временное ограничение роста амплитуды в случае неподоженного гироскопа//////////
+            if((Gyro.Amp>>16) > 95) {Gyro.Amp= (95 << 16);   // временное ограничение роста амплитуды в случае неподоженного гироскопа//////////
             }
             ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
 
             Gyro.AmpPer = Gyro.Amp>>16;
-            ffff=MaxAmp;
+            amp=MaxAmp;
             MaxAmp=0;
             break;