Dmitry Kovalev
/
LGfiltr
forkd
Fork of LGstaandart by
Diff: vibro.c
- Revision:
- 139:1716152517aa
- Parent:
- 129:406995a91322
- Child:
- 140:1fbf117fc120
diff -r 14a0c452cf32 -r 1716152517aa vibro.c --- 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: