fork

Dependencies:   mbed

Fork of LG by igor Apu

Revision:
124:9ae09249f842
Parent:
122:fbacb932a30b
Child:
134:caf4c9cd5052
--- a/MTimer.c	Thu Apr 07 20:16:24 2016 +0000
+++ b/MTimer.c	Fri Apr 08 14:20:35 2016 +0000
@@ -13,7 +13,7 @@
 //unsigned int CountVf=0 ;
 unsigned int CountV31=0;
 unsigned int CountV255=0,f ;
-
+int loop=0;
 
 
 
@@ -34,16 +34,13 @@
 {   int i,t;
     
     if (Event1Hz)	
-    {
-
-   
-        
-       
+    {  
+       Gyro.Rate1_Event = 1; 
        Event1Hz--;
        Time1Hz++;
        Discharg ();
        BackLight ();
-       if(Rate_Flag == 1) CMD_Rate();
+       
     }
 }
 /////////////////////////////////////////////////////
@@ -55,19 +52,35 @@
     {
         Event1K --;
         Time1K++;//первый ++ работает каждые 125 (event100kHz)второй был в 100 кГц
-        
-    /*
-     */ 
+        Time500Hz++;
+     LoopOn
         if (Time1K == 1000) 
         {
             Time1K = 0;
             Event1Hz ++;
-            /*Time1Hz++;*/
+           
         }
-       // LoopOff
+        if (Time500Hz == 2) 
+        {
+            Time500Hz = 0;
+            Event500Hz ++;
+       }
+       LoopOff
           
     }
 }
+void Event_500Hz(void)// событие раз в 500 Гц
+{
+	if(Event500Hz)
+	{  // if(loop=0)BackLightON 
+	   // else {BackLightOFF loop=1;}
+		BackLightON 
+		Event500Hz--;
+		Gyro.Delta500_Event=1;
+		BackLightOFF
+		
+	}
+}
 /////////////////////////////////////////////////////
 ///////////////////// 100kHz //////////////////////////
 /////////////////////////////////////////////////////
@@ -75,20 +88,19 @@
 {
     if (Event100K)	{
         Event100K --;
-BackLightON       
+//BackLightON       
         
-        if (OutBufCon1Count)  {
-            OutBufCon1Count--;   // обратный отсчет для управления ногой и формирование задержки на выдачу
-        }
-        
-        PinCheng();	// чтение регистра состояния выводов(вибро, полсветка, поджиг, LED) и управление выводами.
+        if (OutBufCon1Count)OutBufCon1Count--;  // обратный отсчет для управления ногой и формирование задержки на выдачу
+       
+         PinCheng();	// чтение регистра состояния выводов(вибро, полсветка, поджиг, LED) и управление выводами.
         
         Time100K++;
-        if (Time100K == 100) {//(было 100)  125 так 1кГц и 1 Гц ближе к правде.
+        if (Time100K == 100)
+         {
             Time100K = 0;
             Event1K ++;
-        }
-BackLightOFF
+         }
+//BackLightOFF
     }
 }
 /////////////////////////////////////////////////////
@@ -149,7 +161,7 @@
 //////////////////////////////////////////////////////////////////////
 unsigned int Init_TIM2 (void)
 {
-    LPC_TIM2->MR0 = 250;
+    LPC_TIM2->MR0 = 257;
     LPC_TIM2->MCR = 3;				/* Interrupt and Reset on MR0 */
     NVIC_EnableIRQ(TIMER2_IRQn);
     return 1;
@@ -207,7 +219,7 @@
 {
     LPC_TIM2->IR = 1;
 
-LoopOn  
+
     Global_Time++;
 
     Time_UART++;
@@ -217,5 +229,5 @@
     Gyro.VibroOutF=1;
     
     Event100K ++;
-LoopOff
+
 }
\ No newline at end of file