Dmitry Kovalev
/
LGstaandart
forkd
Fork of LG2 by
Diff: vibro.c
- Revision:
- 108:030cdde08314
- Parent:
- 107:4d178bcc9d8a
- Child:
- 112:4a96133a1311
--- a/vibro.c Fri Apr 01 16:13:55 2016 +0000 +++ b/vibro.c Sat Apr 02 11:15:38 2016 +0000 @@ -104,7 +104,9 @@ { static int TempFaza, CountFaza; - if (Buff_Restored_sin [CountV31] > MaxAmp) {MaxAmp = Buff_Restored_sin [CountV31];} // подумать со знаком*/ +// if (Buff_Restored_sin [CountV31] > MaxAmp) {MaxAmp = Buff_Restored_sin [CountV31];} // подумать со знаком*/ + + switch(CountV31) { case 0: CalcAmpN();//расчет ошумления и амплитуды задание интервалов выставки ножек вибро. @@ -114,22 +116,30 @@ Time_vibro=0; break; case 24: - Gyro.Amp -= (MaxAmp - 350)*50; // расчет амплитудв с учетом разници + +MaxAmp = CaunAddPlus + CaunAddMin; +CaunPlus = CaunAddPlus; +CaunMin = CaunAddMin; +CaunAddPlus = 0; +CaunAddMin = 0; + + Gyro.Amp -= (MaxAmp - 5000) * 1; // расчет амплитудв с учетом разници //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// if((Gyro.Amp>>16) > 95) {Gyro.Amp= (95 << 16); // временное ограничение роста амплитуды в случае неподоженного гироскопа////////// } //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// + Gyro.AmpPer = Gyro.Amp>>16; - Gyro.AmpPer = Gyro.Amp>>16; - amp=MaxAmp; - MaxAmp=0; + +// amp=MaxAmp; +// MaxAmp=0; break; case 16: Time_vibro=0; // расчет Фазы с учетор разници - TempFaza = -4; + TempFaza = -4; for (CountFaza = 0; CountFaza <8; CountFaza++ ) { if (Buff_Restored_sin [(CountV31 -12 + CountFaza) & 0xff] > 0 ) TempFaza++; }