Dmitry Kovalev
/
LGstaandart
forkd
Fork of LG2 by
Diff: vibro.c
- Revision:
- 171:d227a6045305
- Parent:
- 169:140743e3bb96
- Child:
- 179:2b4e6bc277df
diff -r d099c3025f87 -r d227a6045305 vibro.c --- a/vibro.c Wed Jun 08 14:06:03 2016 +0000 +++ b/vibro.c Thu Jun 09 10:19:23 2016 +0000 @@ -104,7 +104,7 @@ Gyro.MaxAmp = Gyro.CaunPlus + Gyro.CaunMin;//расчет максимальной амплитуды из востановленного синуса р-р. Gyro.Amp -= (Gyro.MaxAmp - 5000) * 1; // расчет амплитуды ВП с учетом разници if((Gyro.Amp>>16) > 95) {Gyro.Amp= (95 << 16);} // временное ограничение роста амплитуды ВП в случае неподоженного гироскопа////////// - Gyro.AmpPer = Gyro.Amp>>16; //приведение амплитуды ВП к виду 0%-100% + if(Gyro.RgConA&0x20) {Gyro.AmpPer = Gyro.Amp>>16;} //приведение амплитуды ВП к виду 0%-100% } void VibroFrqRegul(void)// расчет Фазы с учетор разници(подстройка частоты) @@ -112,7 +112,7 @@ static int TempFaza, CountFaza; TempFaza = -4; for (CountFaza = 0; CountFaza <8; CountFaza++ ) {if (Buff_Restored_sin [(CountV31 -12 + CountFaza) & 0xff] > 0 ) TempFaza++;} - if(Gyro.RgConA&0x1) {Gyro.Frq += TempFaza*1000;} + if(Gyro.RgConA&0x40) {Gyro.Frq += TempFaza*1000;} } //////////////////////////////////////////////////////////////////////////////