Dmitry Kovalev
/
LG2
fork
Fork of LG by
Diff: vibro.c
- Revision:
- 183:7e200f4d9b16
- Parent:
- 180:375dcd9c0cb6
- Child:
- 187:6bfb02c2831c
diff -r ebcd2bc3be8f -r 7e200f4d9b16 vibro.c --- a/vibro.c Thu Jul 14 14:10:49 2016 +0000 +++ b/vibro.c Fri Jul 15 14:03:47 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));//левая граница амплитуды @@ -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);} // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа//////////