Diff: Command.c

Revision:

105:bd01d8d20fb6

Parent:

104:ab1cb4ff56b2

Child:

106:250ddd8629c6

--- a/Command.c	Thu Mar 31 10:16:56 2016 +0000
+++ b/Command.c	Thu Mar 31 14:03:40 2016 +0000
@@ -52,7 +52,7 @@
 
    
 //	Gyro .T_Vib=(unsigned int)((7680000*16/Gyro.Frq)*4096);
-    Gyro.T_Vib=(unsigned int)((7680000*16/(Gyro.Frq>>12)));
+//  Gyro.T_Vib=(unsigned int)((7680000*16/(Gyro.Frq>>12)));
     Gyro.Firmware_Version=0xff; /// промежуточная затычка
 
     T_VibH   = ( Gyro.T_Vib>>8  ) TakeByte;
@@ -69,7 +69,10 @@
 
     F_rasH   = ( Gyro.F_ras>>8  ) TakeByte;
     F_rasL   = ( Gyro.F_ras     ) TakeByte;
-
+    
+    F_rasH =0;
+    F_rasL=1;
+ 
     ADC1H    = ( Spi.ADC1>>8    ) TakeByte;
     ADC1L	 = ( Spi.ADC1       ) TakeByte;
 
@@ -200,18 +203,34 @@
     
     if(SR) {
     	 switch (Bit_num){
+    	 	
     	 case 0x06:
-    	 //FrqOff
     	 FrqON
+    	 break;
+    	 
     	 case 0x03:
-    	 //FrqOff
-    	// AHFOON
+    	 HFOON
+    	 break;
+    	 
+    	 case 0x01:
+    	 PlcON
+    	 break;
     	 }
     } 
    else{
    switch (Bit_num){
-   	 case 0x06:
+   	     
+   	     case 0x06:
     	 FrqOff
+    	 break;
+    	 
+    	 case 0x03:
+    	 HFOOFF
+    	 break;
+    	 
+    	 case 0x01:
+    	 PlcOFF
+    	 break;
     	}
    }