Dmitry Kovalev
/
LG2
fork
Fork of LG by
Diff: pin.c
- Revision:
- 211:ac8251b067d2
- Parent:
- 209:224e7331a061
- Child:
- 213:9953db9543d6
diff -r b02fa166315d -r ac8251b067d2 pin.c --- a/pin.c Mon Apr 24 05:43:54 2017 +0000 +++ b/pin.c Mon Jul 03 05:50:08 2017 +0000 @@ -38,7 +38,9 @@ if (Gyro.Discharg) { - Spi.DAC_A =(((int)(GyroP.Str.DAC_current_Start*0.98+0x7fff) & 0xffff)); + if(Gyro.LG_Type==1) Spi.DAC_A = (unsigned int)(32767-(GyroP.Str.DAC_current_Work>>1)); + else Spi.DAC_A =(((int)(GyroP.Str.DAC_current_Start*0.98+0x7fff) & 0xffff)); + Gyro.Discharg = Gyro.Discharg >> 1; if(!Gyro.LaserOn) { @@ -55,7 +57,7 @@ TimeDischarg++; if(TimeDischarg==1) { - if (Spi.ADC5>25000) + if (Spi.ADC5>35000) { if (Try<10) { @@ -74,12 +76,14 @@ if(!Gyro.LaserOn) { Gyro.LaserOn=1; - Gyro.RgConA = 0xfd; + if(Gyro.LG_Type==1) Gyro.RgConA = 0xff; + else Gyro.RgConA = 0xfd; Gyro.RgConB = 0x4; } TimeDischarg=5; Try=0; - Spi.DAC_A = ((((int)(GyroP.Str.DAC_current_Work+0x7fff) & 0xffff)+22544)*0.65); + if(Gyro.LG_Type==1) Spi.DAC_A = (unsigned int)(32767-(GyroP.Str.DAC_current_Work>>1)); + else Spi.DAC_A = ((((int)(GyroP.Str.DAC_current_Work+0x7fff) & 0xffff)+22544)*0.65); } } }