Dmitry Kovalev
/
LGfiltr
forkd
Fork of LGstaandart by
Diff: vibro.c
- Revision:
- 187:6bfb02c2831c
- Parent:
- 183:7e200f4d9b16
- Child:
- 188:4c523cc373cc
diff -r c7a9c309086c -r 6bfb02c2831c vibro.c --- a/vibro.c Sun Jul 31 06:19:02 2016 +0000 +++ b/vibro.c Mon Aug 01 14:03:08 2016 +0000 @@ -59,7 +59,10 @@ if (Cheng_AMP_Flag==0) { //сейчас малая амплитуда? if((Gyro.AmpPer+Gyro.AmpPerDel)>90) { Gyro.AmpPer=90-Gyro.AmpPerDel; //проверка верхней граници амплитуды - } + } + else if((Gyro.AmpPer+Gyro.AmpPerDel)<18) { + Gyro.AmpPer=18+Gyro.AmpPerDel; //проверка нижней граници амплитуды + } // 239 Nmax =(unsigned int)((100000/(Gyro.Frq>>16))-1); Gyro.AmpN1=(unsigned int)((Nmax*(100-Gyro.AmpPer))/(Gyro.Frq>>16)); //левая граница амплитуды @@ -71,6 +74,9 @@ if((Gyro.AmpPer+Gyro.AmpPerDel)>90) { Gyro.AmpPer=90-Gyro.AmpPerDel; //проверка верхней граници амплитуды } + else if((Gyro.AmpPer+Gyro.AmpPerDel)<18) { + Gyro.AmpPer=18+Gyro.AmpPerDel; //проверка нижней граници амплитуды + } Nmax =(unsigned int)((100000/(Gyro.Frq>>16))-1); Gyro.AmpN1=(unsigned int)((Nmax*(100-Gyro.AmpPer+Gyro.AmpPerDel))/(Gyro.Frq>>16));//левая граница амплитуды // Gyro.AmpN1=(unsigned int)((Nmax*(100-(Gyro.AmpPer-Gyro.AmpPerDel)))/(Gyro.Frq>>16));//левая граница амплитуды @@ -81,7 +87,7 @@ Gyro.AmpT = (rand() % Gyro.AmpTD+Gyro.AmpMin);// ОШУМЛЕНИЕ amp } else { - PeriodCount++;//таймер амплитуды + PeriodCount++;//таймер амплитуды 26214400 } switch( Gyro.StrayHZ_flag) { @@ -103,7 +109,7 @@ CaunAddMin = 0; Gyro.MaxAmp = Gyro.CaunPlus + Gyro.CaunMin;//расчет максимальной амплитуды из востановленного синуса р-р. - Gyro.Amp -= (Gyro.MaxAmp - 3000) * 1; // расчет амплитуды ВП с учетом разници + Gyro.Amp -= (Gyro.MaxAmp - 4000) * 1; // расчет амплитуды ВП с учетом разници if((Gyro.Amp>>16) > 95) {Gyro.Amp= (95 << 16);} // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа//////////