forkd

Dependencies:   mbed

Fork of LG2 by Dmitry Kovalev

Revision:
103:e96f08947def
Parent:
102:4270092be987
Child:
104:ab1cb4ff56b2
--- a/Command.c	Wed Mar 30 13:27:39 2016 +0000
+++ b/Command.c	Wed Mar 30 14:20:03 2016 +0000
@@ -261,7 +261,7 @@
     int HFO;
     temp=BuffTemp[3];
     Consol = temp&0x3;
-    HFO    = temp&0x3;
+    HFO    = temp&0x3;// // (номер (код) ЦАПа 0...3, HFO - 3dac, PLC - 0DAC
     temp =((BuffTemp[4]<<8) | BuffTemp[5]);
     // temp=0;
     temp=temp&0xFFFF;
@@ -275,6 +275,13 @@
     Spi.DAC_B =(unsigned int)(DACF) /*(unsigned int)(temp*K_DAC+deltaDAC)*/; // K_DAC);
     }
 }
+void Gph_W()
+{
+    int Gain_A;
+    int Gain_B;
+    Gyro.Gain_A=BuffTemp[4];
+    Gyro.Gain_B=BuffTemp[5];
+}
 
 void CMD_M_vib()
 {   LoopOn
@@ -367,7 +374,12 @@
         case 0xE4: 
             lengf=8;
             break;
-       
+            
+            
+            case 0xE6: 
+            lengf=8;
+            break;
+     
     }
     
     return lengf;
@@ -446,7 +458,14 @@
                case 0xE4:
                     CMD_M_vib();
                     break; 
+               case 0xE6:
+                    Gph_W();
+                    break; 
+                    
+                    
                     Gyro.RsErrLine = 0;
+                    
+                      
      }
     }
 }