Dmitry Kovalev
/
LG2
fork
Fork of LG by
Diff: vibro.c
- Revision:
- 100:e197a8d2cf43
- Parent:
- 99:3d8f206ceac2
- Child:
- 101:bb7472afb947
--- a/vibro.c Tue Mar 29 17:00:59 2016 +0000 +++ b/vibro.c Wed Mar 30 10:46:50 2016 +0000 @@ -113,15 +113,16 @@ Time_vibro=0; break; case 20: -MaxAmp=Buff_Restored_sin [CountV31]; - Gyro.Amp -= (MaxAmp - 200)*2; // расчет амплитудв с учетом разници + MaxAmp=Buff_Restored_sin [CountV31]; + Gyro.Amp -= (MaxAmp - 200)*2; // расчет амплитудв с учетом разници + //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// if(Gyro.Amp>5500000) { Gyro.Amp=1200000; // временное ограничение роста амплитуды в случае неподоженного гироскопа////////// } //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// - Gyro.AmpPer = Gyro.Amp>>16; + Gyro.AmpPer =Gyro.Amp>>16; ffff=MaxAmp; MaxAmp=0; break; @@ -130,12 +131,12 @@ Time_vibro=0; // расчет Фазы с учетор разници - TempFaza = -4; + /* TempFaza = -4; for (CountFaza = 0; CountFaza <8; CountFaza++ ) { if (Buff_Restored_sin [(CountV255 - 12 + CountFaza) & 0xff] > 0 ) TempFaza++; } - // FrecTp=Buff_Restored_sin [(CountV31 - 12 + CountFaza) & 0xff]; - // Gyro.Frq -=TempFaza*1000; + FrecTp=Buff_Restored_sin [(CountV31 - 12 + CountFaza) & 0xff]; + Gyro.Frq -=TempFaza*1000;*/ break; }