fork

Dependencies:   mbed

Fork of LG by igor Apu

Revision:
205:775d54fdf646
Parent:
204:e7e9762bf609
Child:
207:d1ce992f5d17
--- a/vibro.c	Fri Nov 25 06:22:37 2016 +0000
+++ b/vibro.c	Mon Dec 19 14:08:31 2016 +0000
@@ -8,9 +8,9 @@
 
 
 __irq void EINT3_IRQHandler()
-{   
-   Gyro.DeltaEXT_Event=1;
-   Gyro.B_Delta_EventEXT=1;
+{  Gyro.EXT_Latch=1; 
+ //  Gyro.DeltaEXT_Event=1;
+  // Gyro.B_Delta_EventEXT=1;
    LPC_GPIOINT->IO0IntClr |= (1<<1);
   // CMD_Delta_Bins(); 
 }
@@ -43,7 +43,7 @@
     }
 }
 
-
+/*
 void Calc2AmpN(void)//расчет точек старта и стопа импульса вибропривода и расчет частоты ошумления.
 {
     Gyro.AmpSC=0;
@@ -76,8 +76,8 @@
      }                         //8046
    
     LPC_TIM1->MR0 =(unsigned int)(103000000/((Gyro.Frq)>>11));//запись в таймер нового  значение частоты вибро
-}
-
+}*/
+/*
 void CalcAmpN(void)//расчет точек старта и стопа импульса вибропривода и расчет частоты ошумления.
 {
     Gyro.AmpSC=0;
@@ -106,7 +106,7 @@
     LPC_TIM1->MR0 =(unsigned int)(103000000/((Gyro.Frq)>>11));//запись в таймер нового  значение частоты вибро
 }
 
-
+*/
 
 
 void CalcAmpD(void)
@@ -172,7 +172,7 @@
 
 
 
-
+/*
 
 void CalcAmpI(void)//расчет точек старта и стопа импульса вибропривода и расчет частоты ошумления.
 {
@@ -212,7 +212,7 @@
      }                         //8046
     LPC_TIM1->MR0 =(unsigned int)(103000000/((Gyro.Frq)>>11));//запись в таймер нового  значение частоты вибро
 }
-
+*/
 
 
 void OLDCalcAmpN(void)//расчет точек старта и стопа импульса вибропривода и расчет частоты ошумления.
@@ -328,14 +328,13 @@
       Gyro.tempdelta2 += (Buff_Restored_sin2[i])
      } 
      */  
-     if(Gyro.LogHZ)
+     if(Gyro.Log)
      {
 	 sprintf((Time),"%d %d %d\r\n",ADCDIF,(ADCDIF>>5),(ADCDIF>>10));
 	 WriteCon(Time);
 	  ADCDIF=0;
 	 Gyro.CuruAngle=0;
-	 Gyro.tempdelta=0;
-	 Gyro.tempdelta2=0;
+
      } /*
      if(Gyro.ModJump==2) {            ///прыжок с моды на моду. (-->) 
        Gyro.ModJump=0;
@@ -374,13 +373,13 @@
  
     if (Gyro.VibroFrqRegulF == 1) {Gyro.VibroFrqRegulF = 0;	 VibroFrqRegul();	}	// Регулеровка частоты виброподвеса    
     if (Gyro.VibroAMPRegulF == 1) {Gyro.VibroAMPRegulF = 0;	 VibroAMPRegul();   }	// Регулеровка Амплитуды виброподвеса
-    if (Gyro.VibroNoiseF    == 1) 
-    { 
+    if (Gyro.VibroNoiseF    == 1) {Gyro.VibroNoiseF = 0; OLDCalcAmpN();}
+ /*   { 
       switch(Gyro.flag) {
   	   case 1: Gyro.VibroNoiseF = 0; OLDCalcAmpN();                             break;
        case 2: Gyro.AmpMin =3;Gyro.AmpTD =10;Gyro.VibroNoiseF = 0;Calc2AmpN();  break;
        case 3: Gyro.AmpMin =1;Gyro.AmpTD =10;Gyro.VibroNoiseF = 0;CalcAmpD();   break; 
-	  } 
-    }	// регулеровка ошумления, наверно нужно объеденить с регулеровкой ампитуды
+	  }
+    }	 */// регулеровка ошумления, наверно нужно объеденить с регулеровкой ампитуды
     //if (Gyro.VibroOutF      == 1) {Gyro.VibroOutF = 0; VibroOut();}	// установка ног в регисторе тоже подумать , зачем отделный флаг? наверно 
 }