Diff: vibro.c

Revision:

227:2774b56bfab0

Parent:

226:4a4d5bd5fcd7

--- a/vibro.c	Tue Dec 26 05:14:09 2017 +0000
+++ b/vibro.c	Fri Jan 05 08:14:38 2018 +0000
@@ -14,54 +14,6 @@
  
  	Gyro.EXT_Latch=1; 
    LPC_GPIOINT->IO0IntClr |= (1<<1);
-   LoopOn
-    LoopOn
-     LoopOn
-      LoopOn
-       LoopOn
-       
-        LoopOn
-         LoopOn
-          LoopOn
-           LoopOn
-            LoopOn
-             LoopOn
-                LoopOn
-    LoopOn
-     LoopOn
-      LoopOn
-       LoopOn
-       
-        LoopOn
-         LoopOn
-          LoopOn
-           LoopOn
-            LoopOn
-             LoopOn
-                LoopOn
-    LoopOn
-     LoopOn
-      LoopOn
-       LoopOn
-       
-        LoopOn
-         LoopOn
-          LoopOn
-           LoopOn
-            LoopOn
-             LoopOn
-                LoopOn
-    LoopOn
-     LoopOn
-      LoopOn
-       LoopOn
-       
-        LoopOn
-         LoopOn
-          LoopOn
-           LoopOn
-            LoopOn
-             LoopOn
       
 }
 
@@ -211,9 +163,9 @@
   				temp=temp>>6;
    			 	LowDZ	=	((Gyro.AmpSpeed<<3)*(-1));
     			HiDZ	=	(Gyro.AmpSpeed<<3);
-    			Gyro.Amp   -= temp>>4; // расчет амплитуды ВП с учетом разници
-  				if((Gyro.Amp>>16) > (Gyro.AmpPerMax))   {Gyro.Amp = (Gyro.AmpPerMax << 16);}   // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа//////////
- 				if((Gyro.Amp>>16) < (Gyro.AmpPerMin))   {Gyro.Amp = (Gyro.AmpPerMin << 16);}  // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа//////////
+    			Gyro.Amp   -= temp>>4; // расчет амплитуды ВП с учетом разници(Gyro.AmpPer<<17)/100;
+  				if((Gyro.AmpPer) > (Gyro.AmpPerMax))   {Gyro.Amp = ((Gyro.AmpPerMax<<17)/100);}   // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа//////////
+ 				if((Gyro.AmpPer) < (Gyro.AmpPerMin))   {Gyro.Amp = ((Gyro.AmpPerMin<<17)/100);}  // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа//////////
        // Gyro.AmpPer = (Gyro.Amp)>>16; //приведение амплитуды ВП к виду 0%-100%
     		}
        	LPC_MCPWM->MAT1 = T_vib_1;