fork

Dependencies:   mbed

Fork of LG by igor Apu

Revision:
125:9400e64d0636
Parent:
124:9ae09249f842
Child:
128:1e4675a36c93
--- a/Command.c	Fri Apr 08 14:20:35 2016 +0000
+++ b/Command.c	Fri Apr 08 17:52:16 2016 +0000
@@ -397,7 +397,7 @@
   
 Temp = Gyro.CuruAngle;
 Gyro.CuruAngle = 0;
-
+Temp = Gyro.AD_Fast >> 16;
     BuffTemp[ 6] =(Temp >> 8) & 0xff;//старший байт разности счетчиков
     BuffTemp[ 7] =(Temp >> 0) & 0xff;//младший байт разности счетчиков
 
@@ -430,7 +430,7 @@
     BuffTemp[21] = 0x00;
 
 
-//	if (Spi.DAC_B < 0x7fff) Temp = Spi.DAC_B - 0x7fff; else Temp = 0x7fff - Spi.DAC_B ; 
+
  Temp = Spi.DAC_B - 0x7fff;
     BuffTemp[22] =  (Temp >> 8) & 0xff;
     BuffTemp[23] =  (Temp >> 0) & 0xff;
@@ -440,7 +440,8 @@
     BuffTemp[24] = (Temp >> 8) & 0xff;
     BuffTemp[25] = (Temp >> 0) & 0xff;// ХЗ
     
- Temp = 100;
+Temp = 100;
+Temp = Gyro.AD_Slow >> 16;
     BuffTemp[26] =  (Temp >> 8) & 0xff;
     BuffTemp[27] =  (Temp >> 0) & 0xff;