Dmitry Kovalev
/
LG2
fork
Fork of LG by
Diff: SPI.c
- Revision:
- 217:15cd8752bb6c
- Parent:
- 216:189b0ea1dc38
- Child:
- 218:b4067cac75c0
diff -r 189b0ea1dc38 -r 15cd8752bb6c SPI.c --- a/SPI.c Mon Sep 04 12:09:55 2017 +0000 +++ b/SPI.c Mon Sep 04 12:55:13 2017 +0000 @@ -108,9 +108,9 @@ if(count>128) { count=0; - Gyro.PLC_Eror_count = (SinMns+SinPls>>7); - sprintf((Time)," %d %d %d %d \r\n",SinPls>>7,(SinMns>>7), Gyro.PLC_Eror_count,Gyro.PLC_Phase); - WriteCon(Time); + Gyro.PLC_Eror_count = (SinMns+SinPls)>>7; + /*sprintf((Time)," %d %d %d %d \r\n",SinPls>>7,(SinMns>>7), Gyro.PLC_Eror_count,Gyro.PLC_Phase); + WriteCon(Time);*/ SinPls=0; SinMns=0; if(Gyro.RgConA&0x8) @@ -184,8 +184,13 @@ countHFO=0; if(Gyro.RgConA&0x2) { + DeltaRegul=DeltaRegul>>17; - tempDeltaRegul=DeltaRegul>>17; + + sprintf((Time)," %d %d \r\n",DeltaRegul,DeltaRegul>>16); + WriteCon(Time); + + tempDeltaRegul=DeltaRegul>>16; Spi.DAC_A-=DeltaRegul*Gyro.HFO_Gain; timer=10; }