Diff: vibro.c

Revision:

139:1716152517aa

Parent:

129:406995a91322

Child:

140:1fbf117fc120

--- a/vibro.c	Sat Apr 23 15:00:20 2016 +0000
+++ b/vibro.c	Mon Apr 25 10:30:21 2016 +0000
@@ -90,7 +90,15 @@
     } else {
         PeriodCount++;//таймер амплитуды
     }
-    LPC_TIM1->MR0 =(unsigned int)(100000000/(Gyro.Frq>>11));//запись в таймер 1 значение частоты вибро
+    switch(Stray_flag) {
+    case 0:
+    LPC_TIM1->MR0 =(unsigned int)(100000000/((Gyro.Frq)>>11));//запись в таймер 1 значение частоты вибро
+    break;
+    
+    case 1:
+    LPC_TIM1->MR0 =(unsigned int)((100000000/((Gyro.Frq+Stray)>>11))+Stray);//запись в таймер 1 значение частоты вибро
+    break;
+    }
 }
 
 void VibroAMPRegul(void)  //подстройка амплитуды ВП
@@ -111,7 +119,8 @@
    	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;} /// перепутан вибро 1 вибро 2
+   // if(Gyro.RgConA&0x1)     {Gyro.Frq += TempFaza*3000;} /// возможно перепутан вибро 1 вибро 2
+   if(Gyro.RgConA&0x1)     {Gyro.Frq += TempFaza*1000;}
 }
 
 //////////////////////////////////////////////////////////////////////////////
@@ -129,8 +138,6 @@
           
             Time_vibro=0;
             Gyro.VibroNoiseF=1;
-           
-
      break;
   
 	 case 16: