Dmitry Kovalev
/
LGfiltr
forkd
Fork of LGstaandart by
Diff: Command.c
- Revision:
- 180:375dcd9c0cb6
- Parent:
- 179:2b4e6bc277df
- Child:
- 181:0b022246c43c
--- a/Command.c Tue Jul 05 14:00:50 2016 +0000 +++ b/Command.c Wed Jul 06 08:28:15 2016 +0000 @@ -568,6 +568,8 @@ temp1 =((BuffTemp[4]<<8) | BuffTemp[5]); temp1=temp1&0xFFFF; + (unsigned int)((7680000*16/(Gyro.Frq>>12))); + Gyro.Frq=(122880000/temp1)<<12; temp2 =((BuffTemp[6]<<8) | BuffTemp[7]); temp2=temp2&0xFFFF;