Diff: Command.c

Revision:

115:e5a230e5af52

Parent:

113:8be429494918

Child:

116:66f1f0ff2dab

--- a/Command.c	Tue Apr 05 02:44:26 2016 +0000
+++ b/Command.c	Tue Apr 05 10:31:28 2016 +0000
@@ -35,8 +35,9 @@
 void CMD_Rate(void)
 {
   
+     
    	unsigned int Temp;
-			
+   
     unsigned int Cnt_PlsL , Cnt_PlsH;			// Счетчик +.
     unsigned int Cnt_MnsL , Cnt_MnsH;			// Счетчик -.
     unsigned int Cnt_DifL , Cnt_DifH;			// Разность счетчиков.
@@ -173,10 +174,11 @@
 	Temp = Gyro.DeltaT;
     BuffTemp[34] = (Temp >> 8) & 0xff;//дельта
     BuffTemp[35] = (Temp >> 0) & 0xff;
-	
-	Temp = Gyro.Termo;
+	    
+	Temp = ((Gyro.Termo)/0xa4)-0x111;//0xa4=164
+
     BuffTemp[36] =(Temp >> 8) & 0xff;//температура
-    BuffTemp[37] =(Temp >> 0) & 0xff;//ADC6
+    BuffTemp[37] =(Temp >> 0) & 0xff;//ADC6   sesnsor 5
 
     BuffTemp[38] =0x00;
     BuffTemp[39] =0x00;
@@ -304,7 +306,7 @@
 }
 
 void CMD_M_vib()
-{   LoopOn
+{   
     unsigned int temp1,temp2;
 
     temp1 =((BuffTemp[4]<<8) | BuffTemp[5]);