Diff: vibro.c

Revision:

183:7e200f4d9b16

Parent:

180:375dcd9c0cb6

Child:

187:6bfb02c2831c

--- a/vibro.c	Thu Jul 14 14:10:49 2016 +0000
+++ b/vibro.c	Fri Jul 15 14:03:47 2016 +0000
@@ -59,7 +59,10 @@
         if (Cheng_AMP_Flag==0) { //сейчас малая амплитуда?
             if((Gyro.AmpPer+Gyro.AmpPerDel)>90) {
                 Gyro.AmpPer=90-Gyro.AmpPerDel;   //проверка верхней граници амплитуды
-            }  
+            }   
+            else if((Gyro.AmpPer+Gyro.AmpPerDel)<18) {
+            Gyro.AmpPer=18+Gyro.AmpPerDel;   //проверка нижней граници амплитуды
+            }
             //                      239  
           Nmax =(unsigned int)((100000/(Gyro.Frq>>16))-1); 
           Gyro.AmpN1=(unsigned int)((Nmax*(100-Gyro.AmpPer))/(Gyro.Frq>>16));            //левая граница амплитуды
@@ -71,6 +74,9 @@
             if((Gyro.AmpPer+Gyro.AmpPerDel)>90) {
                 Gyro.AmpPer=90-Gyro.AmpPerDel;   //проверка верхней граници амплитуды
             }
+       else if((Gyro.AmpPer+Gyro.AmpPerDel)<18) {
+                Gyro.AmpPer=18+Gyro.AmpPerDel;   //проверка нижней граници амплитуды
+            }
          Nmax =(unsigned int)((100000/(Gyro.Frq>>16))-1);      
          Gyro.AmpN1=(unsigned int)((Nmax*(100-Gyro.AmpPer+Gyro.AmpPerDel))/(Gyro.Frq>>16));//левая граница амплитуды
         // Gyro.AmpN1=(unsigned int)((Nmax*(100-(Gyro.AmpPer-Gyro.AmpPerDel)))/(Gyro.Frq>>16));//левая граница амплитуды
@@ -103,7 +109,7 @@
 	CaunAddMin = 0;
 			
   	Gyro.MaxAmp = Gyro.CaunPlus + Gyro.CaunMin;//расчет максимальной амплитуды из востановленного синуса р-р.
-    Gyro.Amp   -= (Gyro.MaxAmp - 3000) * 1;  // расчет амплитуды ВП с учетом разници
+    Gyro.Amp   -= (Gyro.MaxAmp - 4000) * 1;  // расчет амплитуды ВП с учетом разници
     
     if((Gyro.Amp>>16) > 95)   {Gyro.Amp= (95 << 16);}   // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа//////////