sakthi priya amirtharaj
/
BAE_hw_test1_5
with i2c
Fork of BAE_b4hw_test by
Diff: fault.cpp
- Revision:
- 0:ebdf4f859dca
diff -r 000000000000 -r ebdf4f859dca fault.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/fault.cpp Fri Dec 19 06:47:25 2014 +0000 @@ -0,0 +1,171 @@ +#include "fault.h" +#include "HK.h" + + +DigitalIn fault0(FAULT0,PullUp); +DigitalIn fault1(FAULT1,PullUp); +DigitalIn fault2(FAULT2,PullUp); +DigitalIn fault3(FAULT3,PullUp); +DigitalIn fault4(FAULT4,PullUp); +//DigitalIn fault5(FAULT5,PullUp); +//DigitalIn fault6(FAULT6,PullUp); +//DigitalIn fault7(FAULT7,PullUp); +//DigitalIn fault8(FAULT8,PullUp); + + +InterruptIn fault_IR1(FAULT5); +InterruptIn fault_IR2(FAULT6); +InterruptIn fault_IR3(FAULT7); +InterruptIn fault_IR4(FAULT8); +InterruptIn fault_IR5(FAULT9); + + + +DigitalOut clear1(FAULT_CLEAR1,0); +DigitalOut clear2(FAULT_CLEAR2,0); +DigitalOut clear3(FAULT_CLEAR3,0); +DigitalOut clear4(FAULT_CLEAR4,0); +DigitalOut clear5(FAULT_CLEAR5); +DigitalOut clear6(FAULT_CLEAR6); +DigitalOut clear7(FAULT_CLEAR7); +DigitalOut clear8(FAULT_CLEAR8); +DigitalOut clear9(FAULT_CLEAR9); + + +DigitalOut acs_active(ACS); + + +BusIn fault_poll(FAULT0,FAULT1,FAULT2,FAULT3,FAULT4); +BusIn fault_ir(FAULT5,FAULT6,FAULT7,FAULT8,FAULT9); + +BusOut clear_poll(FAULT_CLEAR1,FAULT_CLEAR2,FAULT_CLEAR3,FAULT_CLEAR4);//to send fault data along with hk +BusOut clear_ir(FAULT_CLEAR5,FAULT_CLEAR6,FAULT_CLEAR7,FAULT_CLEAR8,FAULT_CLEAR9); + + +extern SensorDataQuantised SensorQuantised; +extern int beacon_sc; //to switch beacon between low and high power mode +extern int acs_pflag; //to activate/deactivate control algo +char out_poll; +char out_ir; + +void FUNC_HK_FAULTS() +{ + + printf("Entered Fault management \n"); + /*if(fault0==0)printf("CHARGER IS CHARGING THE BATTERY "); + if(fault0==1)printf("CHRGER GONE OFFLINE, BATTERY DRAINING"); + + if(fault1==0) + { clear1=1;printf("");} + else + { clear1=0;} + + if(fault2==0) + { clear2=1;printf("");} + else + { clear2=0;} + + if(fault3==0) + { clear3=1;printf("");} + else + { clear3=0;} + + if(fault4==0) + { clear4=1;printf("");} + else + { clear4=0;}*/ + + + + + + + + + //clear1 = !fault1; + //clear2 = !fault2; + //clear3 = !fault3; + //clear4 = !fault4; + //clear5 = !fault5; + //clear6 = !fault6; + //clear7 = !fault7; + //clear8 = !fault8; + + + // out_poll = clear_poll; + //out_ir = clear_ir; + SensorQuantised.faultpoll = fault_poll ; + SensorQuantised.faultir=fault_ir ; + printf(" %d , %d \n ",SensorQuantised.faultpoll, SensorQuantised.faultir ) ; + +} + + + +void Clear_IR1() +{clear5=!clear5; +} + +void Clear_IR2() +{clear6=!clear6; +} + +void Clear_IR3() +{clear7=!clear7; +} + +void Clear_IR4() +{clear8=!clear8; +} + +void Clear_IR5() +{clear9=!clear9; +} + +void interrupt_fault() +{ + fault_IR1.rise(&Clear_IR1); + fault_IR2.rise(&Clear_IR2); + fault_IR3.rise(&Clear_IR3); + fault_IR4.rise(&Clear_IR4); + fault_IR5.rise(&Clear_IR5); + fault_IR1.fall(&Clear_IR1); + fault_IR2.fall(&Clear_IR2); + fault_IR3.fall(&Clear_IR3); + fault_IR4.fall(&Clear_IR4); + fault_IR5.fall(&Clear_IR5); +} + + +void FUNC_HK_POWER(char flag) //flag corresponds to the power mode +{ + printf("Entered Power Management \n"); + printf("Entering mode %c \n", flag); + switch (flag) + { + case '0': beacon_sc = 6; //least power mode + acs_pflag = 0; + acs_active = 0; //switching off a component of acs + break; + case '1': beacon_sc = 3; + acs_pflag = 0; + acs_active = 0; + break; + case '2': beacon_sc = 3; + acs_pflag = 0; + acs_active = 0; + break; + case '3': beacon_sc = 3; //normal mode + acs_pflag = 1; + acs_active = 1; + break; + } + /* if (flag == '0') + beacon_sc = 30; + else + beacon_sc = 3; + if (flag == '3') + acs_pflag = 1; + else + acs_pflag = 0; */ +} \ No newline at end of file