Dmitry Kovalev
/
LGstaandart
forkd
Fork of LG2 by
Diff: Command.c
- Revision:
- 221:53b256368ca1
- Parent:
- 220:04c54405b82d
- Child:
- 222:7de7b3bf3a1d
--- a/Command.c Fri Oct 20 13:16:32 2017 +0000 +++ b/Command.c Mon Oct 23 05:31:10 2017 +0000 @@ -156,40 +156,40 @@ int Temp1; float Temp2; int Shift = -11463; - static unsigned int t=15; + static unsigned int t=16; BuffTemp[0] = Gyro.SOC_Out; BuffTemp[1] = Gyro.My_Addres; - iRate_7 =(BuffADC_10v[(t - Gyro.PLC_Phase)&0x3f])&0xffff; + iRate_7 =(BuffADC_10v_F[(t)&0x3f])&0xffff; BuffTemp[ 2] =(iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[ 3] =(iRate_7 >> 0) & 0xff;//младший байт разности счетчиков - iRate_7 =(BuffADC_10v[((t - 2) - (Gyro.PLC_Phase ))&0x3f])&0xffff; + iRate_7 =(BuffADC_10v_F[(t - 2)&0x3f])&0xffff; BuffTemp[ 4] =(iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[ 5] =(iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; - iRate_7 =(BuffADC_10v[((t - 4) - (Gyro.PLC_Phase))&0x3f])&0xffff; + iRate_7 =(BuffADC_10v_F[((t - 4))&0x3f])&0xffff; BuffTemp[ 6] =(iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[ 7] =(iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; - iRate_7 =(BuffADC_10v[((t - 6) - (Gyro.PLC_Phase))&0x3f])&0xffff; + iRate_7 =(BuffADC_10v_F[((t - 6))&0x3f])&0xffff; BuffTemp[ 8] =(iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[ 9] =(iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; - iRate_7 =(BuffADC_10v[((t - 8) - (Gyro.PLC_Phase))&0x3f])&0xffff; + iRate_7 =(BuffADC_10v_F[((t - 8))&0x3f])&0xffff; BuffTemp[10] =(iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[11] =(iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; - iRate_7 =(BuffADC_10v[((t - 10) - (Gyro.PLC_Phase))&0x3f])&0xffff; + iRate_7 =(BuffADC_10v[((t - 10))&0x3f])&0xffff; BuffTemp[12] =(iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[13] =(iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; - iRate_7 =(BuffADC_10v[((t - 12) - (Gyro.PLC_Phase))&0x3f])&0xffff; + iRate_7 =(BuffADC_10v_F[((t - 12))&0x3f])&0xffff; BuffTemp[14] =(iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[15] =(iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; - iRate_7 = (BuffADC_10v[((t - 14) - (Gyro.PLC_Phase))&0x3f])&0xffff; + iRate_7 = (BuffADC_10v_F[((t - 14))&0x3f])&0xffff; BuffTemp[16] =(iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[17] =(iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; @@ -197,39 +197,39 @@ - /* iRate_7 = ModArraySin32[(t)+ (Gyro.PLC_Phase)] - 50; + iRate_7 = ModArraySin[(t)+ (Gyro.PLC_Phase)] - 50; BuffTemp[ 18] = (iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[ 19] = (iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; - iRate_7 = ModArraySin32[(t - 2+ (Gyro.PLC_Phase))&0x3f] - 50; + iRate_7 = ModArraySin[(t - 2+ (Gyro.PLC_Phase))&0x3f] - 50; BuffTemp[ 20] = (iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[ 21] = (iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; - iRate_7 = ModArraySin32[(t - 4+ (Gyro.PLC_Phase))&0x3f] - 50; + iRate_7 = ModArraySin[(t - 4+ (Gyro.PLC_Phase))&0x3f] - 50; BuffTemp[ 22] = (iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[ 23] = (iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; - iRate_7 = ModArraySin32[(t - 6+ (Gyro.PLC_Phase))&0x3f] - 50; + iRate_7 = ModArraySin[(t - 6+ (Gyro.PLC_Phase))&0x3f] - 50; BuffTemp[ 24] = (iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[ 25] = (iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; - iRate_7 = ModArraySin32[(t - 8+ (Gyro.PLC_Phase))&0x3f] - 50; + iRate_7 = ModArraySin[(t - 8+ (Gyro.PLC_Phase))&0x3f] - 50; BuffTemp[ 26] = (iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[ 27] = (iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; - iRate_7 = ModArraySin32[(t - 10+ (Gyro.PLC_Phase))&0x3f] - 50; + iRate_7 = ModArraySin[(t - 10+ (Gyro.PLC_Phase))&0x3f] - 50; BuffTemp[ 28] = (iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[ 29] = (iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; - iRate_7 = ModArraySin32[(t - 12+ (Gyro.PLC_Phase))&0x3f] - 50; + iRate_7 = ModArraySin[(t - 12+ (Gyro.PLC_Phase))&0x3f] - 50; BuffTemp[ 30] = (iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[ 31] = (iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; - iRate_7 = ModArraySin32[(t - 14+ (Gyro.PLC_Phase))&0x3f] - 50; + iRate_7 = ModArraySin[(t - 14+ (Gyro.PLC_Phase))&0x3f] - 50; BuffTemp[ 32] = (iRate_7 >> 8) & 0xff;//младший байт разности счетчиков BuffTemp[ 33] = (iRate_7 >> 0) & 0xff;//младший байт разности счетчиков; - */ + iRate_7 = (Spi.DAC_B - 0x7fff); BuffTemp[ 34] =(iRate_7 >> 8) & 0xff;//младший байт разности счетчиков