Dmitry Kovalev / Mbed 2 deprecated LG2

fork

Dependencies:   mbed

Fork of LG by igor Apu

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;