ACS data acq changed completely. Tested and working. Deals all faults.

Dependencies:   FreescaleIAP mbed-rtos mbed

Fork of QM_BAE_review_1 by Team Fox

Revision:
9:194afacf7449
Parent:
8:82250e41da81
Child:
10:f93407b97750
--- a/TCTM.cpp	Sat Mar 12 12:54:14 2016 +0000
+++ b/TCTM.cpp	Fri Apr 01 21:13:16 2016 +0000
@@ -9,8 +9,8 @@
 #include "stdint.h"
 #include "cassert"
 
-extern DigitalOut gpo1; // enable of att sens2 switch
-extern DigitalOut gpo2; // enable of att sens switch
+extern DigitalOut ATS1_SW_ENABLE; // enable of att sens2 switch
+extern DigitalOut ATS2_SW_ENABLE; // enable of att sens switch
 
 extern DigitalOut TRXY_SW;  //TR XY Switch
 extern DigitalOut TRZ_SW;  //TR Z Switch
@@ -79,7 +79,7 @@
                            return tm;
                        }
                        //.........................
-                       case 0x0010:
+                     /*  case 0x0010:
                        {
                            printf("Read MUX DATA\r\n");
                            tm[0] = 0x60;
@@ -97,7 +97,7 @@
                            tm[132] = (uint8_t)((crc16&0xFF00)>>8);
                            tm[133] = (uint8_t)(crc16&0x00FF); 
                            return tm;
-                       }
+                       }*/
                        //..........................................
                        case 0x2:
                        {
@@ -424,7 +424,7 @@
                             tm[0]=0xB0;
                             tm[1]=tc[0];
                             tm[2]=1;
-                            gpo1 = 0;
+                            ATS1_SW_ENABLE = 0;
                             for(uint8_t i=3;i<11;i++)
                             {
                                 tm[i]=0x00;
@@ -444,7 +444,7 @@
                             //ACK_L234_TM
                             tm[0]=0xB0;
                             tm[1]=tc[0];
-                            gpo2 = 0;
+                            ATS2_SW_ENABLE = 0;
                             tm[2]=1;
                             for(uint8_t i=3;i<11;i++)
                             {
@@ -529,7 +529,7 @@
                             tm[0]=0xB0;
                             tm[1]=tc[0];
                             tm[2]=1;
-                            gpo1 = 1;
+                            ATS1_SW_ENABLE = 1;
                             for(uint8_t i=3;i<11;i++)
                             {
                                 tm[i]=0x00;
@@ -550,7 +550,7 @@
                             tm[0]=0xB0;
                             tm[1]=tc[0];
                             tm[2]=1;
-                            gpo2 = 1;
+                            ATS2_SW_ENABLE = 1;
                             for(uint8_t i=3;i<11;i++)
                             {
                                 tm[i]=0x00;
@@ -634,9 +634,9 @@
                             tm[0]=0xB0;
                             tm[1]=tc[0];
                             tm[2]=1;
-                            gpo1 = 1;
+                            ATS1_SW_ENABLE = 1;
                             wait_us(1);
-                            gpo1 = 0;
+                            ATS1_SW_ENABLE = 0;
                             for(uint8_t i=3;i<11;i++)
                             {
                                 tm[i]=0x00;
@@ -680,9 +680,9 @@
                             tm[0]=0xB0;
                             tm[1]=tc[0];
                             tm[2]=1;
-                            gpo1 = 1;
+                            ATS1_SW_ENABLE = 1;
                             wait_us(1);
-                            gpo1 = 0;
+                            ATS1_SW_ENABLE = 0;
                             for(uint8_t i=3;i<11;i++)
                             {
                                 tm[i]=0x00;