Dmitry Kovalev
/
LG2
fork
Fork of LG by
Diff: Command.c
- 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;