Dmitry Kovalev
/
LGfiltr
forkd
Fork of LGstaandart by
Diff: vibro.c
- Revision:
- 96:1c8536458119
- Parent:
- 92:c892f0311aa7
- Child:
- 98:95b8e79f13e1
diff -r dd51e577e114 -r 1c8536458119 vibro.c --- a/vibro.c Mon Mar 28 11:33:45 2016 +0000 +++ b/vibro.c Mon Mar 28 15:23:40 2016 +0000 @@ -127,11 +127,11 @@ Time_vibro=0; // расчет Фазы с учетор разници - /* TempFaza = -4; + TempFaza = -4; for (CountFaza = 0; CountFaza < 8; CountFaza++ ) { - if (Buff_Restored_sin [(CountV255- 12 + CountFaza) & 0xff] > 65535) TempFaza++; + if (Buff_Restored_sin [(CountV255- 12 + CountFaza) & 0xff] > 0 ) TempFaza++; } // расчет Фазы с учетор разници - Gyro.Frq -=TempFaza*1000;*/ + Gyro.Frq -=TempFaza*1000; break; }