Diff: vibro.c

Revision:

171:d227a6045305

Parent:

169:140743e3bb96

Child:

179:2b4e6bc277df

--- a/vibro.c	Wed Jun 08 14:06:03 2016 +0000
+++ b/vibro.c	Thu Jun 09 10:19:23 2016 +0000
@@ -104,7 +104,7 @@
   	Gyro.MaxAmp = Gyro.CaunPlus + Gyro.CaunMin;//расчет максимальной амплитуды из востановленного синуса р-р.
     Gyro.Amp   -= (Gyro.MaxAmp - 5000) * 1;  // расчет амплитуды ВП с учетом разници
     if((Gyro.Amp>>16) > 95)   {Gyro.Amp= (95 << 16);}   // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа//////////
-    Gyro.AmpPer = Gyro.Amp>>16; //приведение амплитуды ВП к виду 0%-100%
+    if(Gyro.RgConA&0x20)     {Gyro.AmpPer = Gyro.Amp>>16;} //приведение амплитуды ВП к виду 0%-100%
 }
 
 void VibroFrqRegul(void)// расчет Фазы с учетор разници(подстройка частоты)
@@ -112,7 +112,7 @@
    	static int TempFaza, CountFaza;
    	TempFaza = -4;
     for (CountFaza = 0; CountFaza <8; CountFaza++ )     {if (Buff_Restored_sin [(CountV31 -12  + CountFaza) & 0xff] > 0 ) TempFaza++;} 
-    if(Gyro.RgConA&0x1)     {Gyro.Frq += TempFaza*1000;}
+    if(Gyro.RgConA&0x40)     {Gyro.Frq += TempFaza*1000;}
 }
 
 //////////////////////////////////////////////////////////////////////////////