Team Fox / Mbed 2 deprecated BAE_QM_MAR9

Dependencies:   FreescaleIAP mbed-rtos mbed

Fork of workinQM_5thJan_azad by Team Fox

Revision:
54:d6a45982ace1
Parent:
53:459b71b1861c
Child:
56:32b1fb074138
--- a/TCTM.cpp	Fri Aug 05 19:33:09 2016 +0000
+++ b/TCTM.cpp	Sat Aug 06 18:06:51 2016 +0000
@@ -345,7 +345,7 @@
 
                                                                 /*taking some varible till we find some thing more useful*/
                                                                 //uint8_t ref_val=0x01;
-                                                                telemetry[0] = 0x60;
+                                                                telemetry[0] = 0x30;
                                                                 telemetry[1] = tc[0];
                                                                 telemetry[2] = ACK_CODE;
                                                                 /*random or with bcn_tx_sw_enable assuming it is 1 bit in length
@@ -539,7 +539,7 @@
                                                     case 0x0001:
                                                             {
                                                                 gpc.printf("\r\nhk data tm");
-                                                                telemetry[0] = 0x60;
+                                                                telemetry[0] = 0x30;
                                                                 telemetry[1] = tc[0];
                                                                 telemetry[2] = ACK_CODE;
 
@@ -918,9 +918,9 @@
                                                                 uint16_t assign_val;
                                     
                                                                 float PWM_tc[3];
-                                                                PWM_tc[0]=(float(tc[4]))/32768 - 1;
-                                                                PWM_tc[1]=(float(tc[5]))/32768 - 1;
-                                                                PWM_tc[2]=(float(tc[6]))/32768 - 1;
+                                                                PWM_tc[0]=(float(tc[4]))/256;
+                                                                PWM_tc[1]=(float(tc[5]))/256;
+                                                                PWM_tc[2]=(float(tc[6]))/256;
                                                                 
                                                                 DRV_Z_EN = 1;
                                                                 DRV_XY_EN = 1;  
@@ -1084,7 +1084,8 @@
                                                                         ACS_ATS_STATUS = (ACS_ATS_STATUS&0xF0)|0x07;
                                                                         SENSOR_NO = 2;
                                                                     }
-                                                                    
+                                                                
+                                                                SENSOR_NO = 1;    
                                                                 assign_val = float_to_uint16(-1000,1000,actual_data.Bvalue_actual[0]);
                                                                 telemetry[17] = (assign_val>>8); 
                                                                 telemetry[18] = assign_val;