forkd

Dependencies:   mbed

Fork of LG2 by Dmitry Kovalev

Revision:
182:ebcd2bc3be8f
Parent:
181:0b022246c43c
Child:
183:7e200f4d9b16
--- a/Command.c	Fri Jul 08 14:58:17 2016 +0000
+++ b/Command.c	Thu Jul 14 14:10:49 2016 +0000
@@ -139,9 +139,7 @@
     
     BuffTemp[ 4] = CountParam;
      switch(CountParam) {
-   
-   
-      
+  
     //F_ras  
      case 0:
            Temp = Gyro.F_ras;
@@ -300,10 +298,7 @@
     BuffTemp[ 3] =(Temp >> 0) & 0xff;//младший байт разности счетчиков
     
     BuffTemp[ 4] = CountParam;
-    switch(CountParam) {
-   
-     WriteCon("5");
-      
+    switch(CountParam) {      
     //F_ras  
      case 0:
            Temp = Gyro.F_ras;
@@ -556,7 +551,8 @@
     BuffTemp[35] = (Temp >> 0) & 0xff;
 	    
 	Temp = Gyro.Termo;
-    Temp = (0x7fff + Temp)/164;
+   // Temp = (0x7fff + Temp)/164;
+    Temp = 0x7fff+Temp;
     BuffTemp[36] =(Temp >> 8) & 0xff;//температура
     BuffTemp[37] =(Temp >> 0) & 0xff;//ADC6   sesnsor 5
 
@@ -888,8 +884,8 @@
                   TempParam=(BuffTemp[3]) & 0x90; 
                   if      (TempParam==Delta_500)       {CMD_Delta_500Hz();}
                   else if (TempParam==Delta_EXT)       {CMD_Delta_Ext();  }
-                  else if (TempParam==PDelta_500)      { UART_InitSet (1, 115200, 0x03); Gyro.ModeOut=3; Gyro.Delta500_Event=0; /*WriteCon("Delta500");*/ }
-                  else if (TempParam==PDelta_EXT)      { UART_InitSet (1, 115200, 0x03); Gyro.ModeOut=4; Gyro.DeltaEXT_Event=0;/* WriteCon("deltaEXT"); */}
+                  else if (TempParam==PDelta_500)      { Gyro.ModeOut=3; Gyro.Delta500_Event=0; /*WriteCon("Delta500");*/ }
+                  else if (TempParam==PDelta_EXT)      { Gyro.ModeOut=4; Gyro.DeltaEXT_Event=0;/* WriteCon("deltaEXT"); */}
                 break;
                
                 case 0xD8: