Dmitry Kovalev
/
LGstaandart
forkd
Fork of LG2 by
Diff: vibro.c
- Revision:
- 104:ab1cb4ff56b2
- Parent:
- 99:3d8f206ceac2
- Child:
- 105:bd01d8d20fb6
diff -r e96f08947def -r ab1cb4ff56b2 vibro.c --- a/vibro.c Wed Mar 30 14:20:03 2016 +0000 +++ b/vibro.c Thu Mar 31 10:16:56 2016 +0000 @@ -113,8 +113,8 @@ Time_vibro=0; break; case 20: -MaxAmp=Buff_Restored_sin [CountV31]; - Gyro.Amp -= (MaxAmp - 200)*2; // расчет амплитудв с учетом разници +MaxAmp = Buff_Restored_sin [CountV31]; + Gyro.Amp -= (MaxAmp - 300)*2; // расчет амплитудв с учетом разници //////////////////////////////////////////////////////////////////////////////////////////////////////////////////////// if(Gyro.Amp>5500000) { Gyro.Amp=1200000; // временное ограничение роста амплитуды в случае неподоженного гироскопа////////// @@ -132,10 +132,12 @@ // расчет Фазы с учетор разници TempFaza = -4; for (CountFaza = 0; CountFaza <8; CountFaza++ ) { - if (Buff_Restored_sin [(CountV255 - 12 + CountFaza) & 0xff] > 0 ) TempFaza++; + if (Buff_Restored_sin [(CountV31 -12 + CountFaza) & 0xff] > 0 ) TempFaza++; } // FrecTp=Buff_Restored_sin [(CountV31 - 12 + CountFaza) & 0xff]; - // Gyro.Frq -=TempFaza*1000; + if(Gyro.RgConA&0x1){ + Gyro.Frq += TempFaza*1000;/// перепутан вибро 1 вибро 2 + } break; }