Team Fox
/
BAE_QM_MAR9
Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: FreescaleIAP mbed-rtos mbed
Fork of
workinQM_5thJan_azad
by 
Team Fox
Diff: TCTM.cpp
- Revision:
- 52:daa685b0e390
- Parent:
- 49:61c9f28332ba
- Child:
- 53:459b71b1861c
--- a/TCTM.cpp Fri Jul 22 17:32:41 2016 +0000
+++ b/TCTM.cpp Fri Jul 22 22:21:05 2016 +0000
@@ -108,8 +108,8 @@
extern DigitalOut DRV_Z_EN;
extern DigitalOut DRV_XY_EN;
-extern DigitalOut TRXY_SW; //TR XY Switch if any TR_SW error arises then it is same as TR_SW_EN
-extern DigitalOut TRZ_SW; //TR Z Switch
+//extern DigitalOut TRXY_SW; //TR XY Switch if any TR_SW error arises then it is same as TR_SW_EN
+//extern DigitalOut TRZ_SW; //TR Z Switch
extern DigitalOut phase_TR_x;
extern DigitalOut phase_TR_y;
@@ -932,7 +932,7 @@
wait_ms(ACS_DEMAG_TIME_DELAY);
ATS2_SW_ENABLE = 1;
wait_ms(5);
- ATS1_SW_ENABLE = 0;
+ ATS1_SW_ENABLE = 1;
wait_ms(5);
//will it lead to causing delay in i2c interrupt
init1 = SENSOR_INIT();
@@ -940,7 +940,7 @@
{
data1 = SENSOR_DATA_ACQ();
}
- ATS1_SW_ENABLE = 1;
+ ATS1_SW_ENABLE = 0;
wait_ms(5);
ATS2_SW_ENABLE = 0;
wait_ms(5);
@@ -1003,21 +1003,21 @@
SENSOR_NO = 0;
if(data1 == 2)
{
- ATS1_SW_ENABLE = 0;
+ ATS1_SW_ENABLE = 1;
wait_ms(5);
ACS_ATS_STATUS = (ACS_ATS_STATUS&0xF0)|0x06;
SENSOR_NO = 1;
}
else if(data1 == 3)
{
- ATS1_SW_ENABLE = 0;
+ ATS1_SW_ENABLE = 1;
wait_ms(5);
ACS_ATS_STATUS = (ACS_ATS_STATUS&0xF0)|0x07;
SENSOR_NO = 1;
}
else if(data1 == 1)
{
- ATS1_SW_ENABLE = 0;
+ ATS1_SW_ENABLE = 1;
wait_ms(5);
ACS_ATS_STATUS = (ACS_ATS_STATUS&0xF0)|0x05;
SENSOR_NO = 0;
@@ -1031,7 +1031,7 @@
{
ATS2_SW_ENABLE = 1;
wait_ms(5);
- ATS1_SW_ENABLE = 0;
+ ATS1_SW_ENABLE = 1;
wait_ms(5);
ACS_ATS_STATUS = (ACS_ATS_STATUS&0xF0)|0x01;
ACS_ATS_STATUS = (ACS_ATS_STATUS&0x0F)|0x60;
@@ -1041,7 +1041,7 @@
{
ATS2_SW_ENABLE = 1;
wait_ms(5);
- ATS1_SW_ENABLE = 0;
+ ATS1_SW_ENABLE = 1;
wait_ms(5);
ACS_ATS_STATUS = (ACS_ATS_STATUS&0xF0)|0x01;
ACS_ATS_STATUS = (ACS_ATS_STATUS&0x0F)|0x70;
@@ -1061,7 +1061,7 @@
{
ATS2_SW_ENABLE = 1;
wait_ms(5);
- ATS1_SW_ENABLE = 0;
+ ATS1_SW_ENABLE = 1;
wait_ms(5);
ACS_ATS_STATUS = (ACS_ATS_STATUS&0xF0)|0x02;
ACS_ATS_STATUS = (ACS_ATS_STATUS&0x0F)|0x70;
@@ -1568,7 +1568,7 @@
ATS2_SW_ENABLE = 1; // making sure we switch off the other
//ACS_ATS_STATUS = (ACS_ATS_STATUS & 0xF3) | 0x0C ;
ACS_ATS_STATUS = (ACS_ATS_STATUS & 0xF0) | 0x0C ;
- ATS1_SW_ENABLE = 0;
+ ATS1_SW_ENABLE = 1;
//ACS_ATS_STATUS = (ACS_ATS_STATUS & 0x3F);
ACS_ATS_STATUS = (ACS_ATS_STATUS & 0x0F)|0x40;
telemetry[2]=ACK_CODE;
@@ -1591,7 +1591,7 @@
//ACK_L234_TM
telemetry[0]=0xB0;
telemetry[1]=tc[0];
- ATS1_SW_ENABLE = 1; //make sure u switch off the other
+ ATS1_SW_ENABLE = 0; //make sure u switch off the other
ACS_ATS_STATUS = (ACS_ATS_STATUS & 0x0F) | 0xC0 ;
ATS2_SW_ENABLE = 0;
ACS_ATS_STATUS = (ACS_ATS_STATUS & 0xF0)|0x04;
@@ -1616,6 +1616,7 @@
telemetry[0]=0xB0;
telemetry[1]=tc[0];
DRV_XY_EN = 1;//1 SWITCH enable here
+ ACS_TR_XY_ENABLE = 1;
ACS_TR_XY_SW_STATUS=0x01;
telemetry[2]=ACK_CODE;
for(uint8_t i=3;i<11;i++)
@@ -1638,6 +1639,7 @@
telemetry[0]=0xB0;
telemetry[1]=tc[0];
DRV_Z_EN = 1;
+ ACS_TR_Z_ENABLE = 1;
ACS_TR_Z_SW_STATUS=0x01;
telemetry[2]=ACK_CODE;
for(uint8_t i=3;i<11;i++)
@@ -1681,7 +1683,7 @@
//ACK_L234_TM
telemetry[0]=0xB0;
telemetry[1]=tc[0];
- ATS1_SW_ENABLE = 1;
+ ATS1_SW_ENABLE = 0;
ACS_ATS_STATUS = (ACS_ATS_STATUS & 0x3F) | 0xC0 ;
telemetry[2]=ACK_CODE;
@@ -1737,7 +1739,7 @@
//ACK_L234_TM
telemetry[0]=0xB0;
telemetry[1]=tc[0];
- TRXY_SW= 0;
+ ACS_TR_XY_ENABLE = 0;
ACS_TR_XY_SW_STATUS=0x03;
telemetry[2]=ACK_CODE;
for(uint8_t i=3;i<11;i++)
@@ -1759,7 +1761,7 @@
//ACK_L234_TM
telemetry[0]=0xB0;
telemetry[1]=tc[0];
- TRZ_SW = 0;
+ ACS_TR_Z_ENABLE = 0;
ACS_TR_Z_SW_STATUS=0x03;
telemetry[2]=ACK_CODE;
for(uint8_t i=3;i<11;i++)
@@ -1804,9 +1806,9 @@
telemetry[0]=0xB0;
telemetry[1]=tc[0];
ATS2_SW_ENABLE = 1;//as ats switched off
- ATS1_SW_ENABLE = 1;
+ ATS1_SW_ENABLE = 0;
wait_ms(5);
- ATS1_SW_ENABLE = 0;
+ ATS1_SW_ENABLE = 1;
telemetry[2]=ACK_CODE;
for(uint8_t i=3;i<11;i++)
{
@@ -1827,7 +1829,7 @@
//ACK_L234_TM
telemetry[0]=0xB0;
telemetry[1]=tc[0];
- ATS1_SW_ENABLE = 1;//as ats1 switched off
+ ATS1_SW_ENABLE = 0;//as ats1 switched off
ATS2_SW_ENABLE = 1;
wait_ms(5);
ATS2_SW_ENABLE = 0;
@@ -1851,9 +1853,9 @@
//ACK_L234_TM
telemetry[0]=0xB0;
telemetry[1]=tc[0];
- TRXY_SW= 0;
+ ACS_TR_XY_ENABLE= 0;
wait_ms(5);
- TRXY_SW= 1;
+ ACS_TR_XY_ENABLE= 1;
telemetry[2]=ACK_CODE;
for(uint8_t i=3;i<11;i++)
{
@@ -1874,9 +1876,9 @@
//ACK_L234_TM
telemetry[0]=0xB0;
telemetry[1]=tc[0];
- TRZ_SW= 0;
+ ACS_TR_Z_ENABLE= 0;
wait_ms(5);
- TRZ_SW= 1;
+ ACS_TR_Z_ENABLE= 1;
telemetry[2]=ACK_CODE;
for(uint8_t i=3;i<11;i++)
{