fork

Dependencies:   mbed

Fork of LG by igor Apu

Revision:
209:224e7331a061
Parent:
208:19150d2b528f
Child:
211:ac8251b067d2
--- a/pin.c	Tue Feb 07 10:11:35 2017 +0000
+++ b/pin.c	Thu Apr 13 14:14:45 2017 +0000
@@ -38,10 +38,13 @@
       
      if (Gyro.Discharg)
       {   
-          Spi.DAC_A = GyroP.Str.DAC_current_Start;
+          Spi.DAC_A =(((int)(GyroP.Str.DAC_current_Start*0.98+0x7fff)  & 0xffff));
           Gyro.Discharg = Gyro.Discharg >> 1;
+          if(!Gyro.LaserOn)
+          {
           Gyro.RgConA = 0x0000;
           Gyro.RgConB = 0x0000;
+          }
          //Проверка здвигового поля(последовательности) поджига
          //если последний бит 1 то установить бит поджига в еденицу, иначе в 0;
           if (Gyro.Discharg & 0x1) Gyro.PinReg |= PinRegBitD; 
@@ -62,28 +65,24 @@
                       Try++;
                      }
                   }
+               
+                    
+                 
                  else
                   { 
-                    Spi.DAC_A = GyroP.Str.DAC_current_Work;
+                   // 
+                    if(!Gyro.LaserOn)
+                    {
                     Gyro.LaserOn=1;
-                    Gyro.RgConA = 0xffff;
-                    Gyro.RgConB = 0xffff;
+                    Gyro.RgConA = 0xfd;
+                    Gyro.RgConB = 0x4;
+                    }
                     TimeDischarg=5;
                     Try=0;
+                    Spi.DAC_A = ((((int)(GyroP.Str.DAC_current_Work+0x7fff)  & 0xffff)+22544)*0.65);
                   }
           } 
        } 
-       else
-       {
-          /* if(Spi.ADC5>30000) { Gyro.LaserOn=0;  Gyro.RgConA = 0x0;  Gyro.RgConB = 0x0;}
-           else 
-                {  
-                  //Gyro.RgConA = 0xffff;
-                 // Gyro.RgConB = 0xffff;
-                  Gyro.LaserOn=1;
-                  Try=0;
-                }*/
-       }   
 }
 void BackLight ()
 {