vr1.1

Dependencies:   FreescaleIAP mbed-rtos mbed

Fork of CDMS_RTOS_v1_1 by Team Fox

Committer:
cholletisaik777
Date:
Fri Jul 03 08:38:12 2015 +0000
Revision:
7:c270a9e37290
Parent:
6:2026890397d6
Child:
8:607ae92fa6af
cdms clean code

Who changed what in which revision?

UserRevisionLine numberNew contents of line
cholletisaik777 7:c270a9e37290 1 /*Header Files*/
cholletisaik777 0:d6e3d1e21484 2 #include "mbed.h"
cholletisaik777 0:d6e3d1e21484 3 #include "rtos.h"
cholletisaik777 0:d6e3d1e21484 4 #include "func_head.h"
pradeepvk2208 2:4c79b3dfef31 5 #include "i2c.h"
cholletisaik777 4:cc85cfaa2086 6 #include "SDCard.h"
cholletisaik777 7:c270a9e37290 7 #include "hk_cdms.h"
cholletisaik777 7:c270a9e37290 8 #include "power.h"
cholletisaik777 7:c270a9e37290 9 /*End*/
cholletisaik777 7:c270a9e37290 10
cholletisaik777 7:c270a9e37290 11 /*Hash define parameters*/
cholletisaik777 7:c270a9e37290 12 #define HK_DATA 25 //Total Hk data that is to be stored in SD card
cholletisaik777 7:c270a9e37290 13 #define HK_ITER 5 //The iterations after which the HK data will be stored in the SD card
cholletisaik777 7:c270a9e37290 14 /*End*/
cholletisaik777 7:c270a9e37290 15
cholletisaik777 0:d6e3d1e21484 16 Serial pc(USBTX,USBRX);
cholletisaik777 0:d6e3d1e21484 17
cholletisaik777 7:c270a9e37290 18 /*Configuring pins*/
cholletisaik777 7:c270a9e37290 19 InterruptIn pl_sc_data(PTC3); //interrupt from payload to send science data
cholletisaik777 7:c270a9e37290 20 InterruptIn cdms_rcv_tc(PTC12); //interrupt from comm b4 sending tc
cholletisaik777 7:c270a9e37290 21 InterruptIn bae_tm_rcv(PTC11); //interrupt from bae b4 sending tm
cholletisaik777 7:c270a9e37290 22 InterruptIn pl_tm_rcv(PTC10); ////interrupt from bae b4 sending tm
cholletisaik777 7:c270a9e37290 23 /*End*/
cholletisaik777 0:d6e3d1e21484 24
cholletisaik777 7:c270a9e37290 25 /*Delclaring extern objects*/
sakthipriya 3:0c3f7c3fabc9 26 extern I2C master;
sakthipriya 3:0c3f7c3fabc9 27 extern DigitalOut irpt_2_slv;
cholletisaik777 7:c270a9e37290 28 extern SPISlave pl_spi ; // mosi, miso, sclk, ssel --> using SPI1
cholletisaik777 7:c270a9e37290 29 /*End*/
cholletisaik777 0:d6e3d1e21484 30
cholletisaik777 7:c270a9e37290 31 /*Declaring global variables*/
sakthipriya 3:0c3f7c3fabc9 32 char i2c_data[25];
cholletisaik777 5:c77b49508927 33 int hk_count=0;
cholletisaik777 5:c77b49508927 34 uint8_t hk_data[512];
cholletisaik777 7:c270a9e37290 35 uint8_t rtc_data[8];
cholletisaik777 5:c77b49508927 36 uint64_t hk_block_number = 1;
cholletisaik777 7:c270a9e37290 37 /*End*/
pradeepvk2208 2:4c79b3dfef31 38
cholletisaik777 7:c270a9e37290 39 /*Threads used*/
cholletisaik777 7:c270a9e37290 40 Thread *ptr_t_hk_acq; //pointer to read state of one thread from another
cholletisaik777 0:d6e3d1e21484 41 Thread *ptr_t_sc_data;
cholletisaik777 0:d6e3d1e21484 42 Thread *ptr_t_tc;
cholletisaik777 0:d6e3d1e21484 43 Thread *ptr_t_tm;
cholletisaik777 0:d6e3d1e21484 44 Thread *ptr_t_fault;
cholletisaik777 0:d6e3d1e21484 45 Thread *ptr_t_wdt;
cholletisaik777 7:c270a9e37290 46 /*End*/
cholletisaik777 0:d6e3d1e21484 47
cholletisaik777 7:c270a9e37290 48 /*All Threads*/
cholletisaik777 0:d6e3d1e21484 49 void T_CDMS_RLY_TC(void const *args)
cholletisaik777 0:d6e3d1e21484 50 {
cholletisaik777 0:d6e3d1e21484 51 while(1)
cholletisaik777 0:d6e3d1e21484 52 {
cholletisaik777 0:d6e3d1e21484 53 Thread::signal_wait(0x2);
cholletisaik777 0:d6e3d1e21484 54 pc.printf("in T_CDMS_RLY_TC\r\n");
cholletisaik777 7:c270a9e37290 55 FCTN_CDMS_RLY_TC();
cholletisaik777 0:d6e3d1e21484 56 }
cholletisaik777 0:d6e3d1e21484 57 }
cholletisaik777 0:d6e3d1e21484 58
cholletisaik777 0:d6e3d1e21484 59 void T_CDMS_RLY_TM(void const *args)
cholletisaik777 0:d6e3d1e21484 60 {
cholletisaik777 0:d6e3d1e21484 61 while(1)
cholletisaik777 0:d6e3d1e21484 62 {
cholletisaik777 0:d6e3d1e21484 63 Thread::signal_wait(0x3);
cholletisaik777 0:d6e3d1e21484 64 pc.printf("in T_CDMS_RLY_TM\r\n");
cholletisaik777 7:c270a9e37290 65 FCTN_CDMS_RLY_TM();
cholletisaik777 0:d6e3d1e21484 66 }
cholletisaik777 0:d6e3d1e21484 67 }
cholletisaik777 0:d6e3d1e21484 68
cholletisaik777 0:d6e3d1e21484 69 void T_PL_RCV_SC_DATA(void const *args)
cholletisaik777 0:d6e3d1e21484 70 {
cholletisaik777 0:d6e3d1e21484 71 while(1)
cholletisaik777 0:d6e3d1e21484 72 {
cholletisaik777 0:d6e3d1e21484 73 Thread::signal_wait(0x1);
cholletisaik777 0:d6e3d1e21484 74 pc.printf("in T_PL_RCV_SC_DATA\r\n");
cholletisaik777 7:c270a9e37290 75 FCTN_PL_RCV_SC_DATA();
cholletisaik777 0:d6e3d1e21484 76 }
cholletisaik777 0:d6e3d1e21484 77 }
cholletisaik777 7:c270a9e37290 78 /*End*/
cholletisaik777 7:c270a9e37290 79
cholletisaik777 7:c270a9e37290 80 /*RTOS Scheduler*/
cholletisaik777 0:d6e3d1e21484 81 void TSC_CDMS_HK_MAIN(void const *args)
cholletisaik777 0:d6e3d1e21484 82 {
cholletisaik777 7:c270a9e37290 83 pc.printf("in FCTN_CDMS_HK_MAIN()\r\n");
cholletisaik777 7:c270a9e37290 84 FCTN_MASTER_I2C('h' , i2c_data ); //BAE hk data is collected
cholletisaik777 7:c270a9e37290 85 FCTN_CDMS_RD_RTC(rtc_data); //RTC data is read to the rtc_data.
cholletisaik777 6:2026890397d6 86 for(int i=(hk_count%(HK_ITER+1))*(HK_DATA+8);i<(hk_count%(HK_ITER+1))*(HK_DATA+8)+8;i++)
cholletisaik777 5:c77b49508927 87 {
cholletisaik777 7:c270a9e37290 88 hk_data[i] = rtc_data[i-(hk_count%(HK_ITER+1))*(HK_DATA+8)];
cholletisaik777 5:c77b49508927 89 }
cholletisaik777 6:2026890397d6 90 for(int i=(hk_count%(HK_ITER+1))*(HK_DATA+8)+8;i<(hk_count%(HK_ITER+1))*(HK_DATA+8)+8+HK_DATA;i++)
cholletisaik777 5:c77b49508927 91 {
cholletisaik777 7:c270a9e37290 92 hk_data[i] = i2c_data[i-(hk_count%(HK_ITER+1))*(HK_DATA+8)+8];
cholletisaik777 5:c77b49508927 93 }
cholletisaik777 5:c77b49508927 94 hk_count++;
cholletisaik777 7:c270a9e37290 95 if(hk_count%HK_ITER==0)
cholletisaik777 5:c77b49508927 96 {
cholletisaik777 6:2026890397d6 97 for(int i=(hk_count%(HK_ITER+1))*(HK_DATA+8)+8+HK_DATA;i<512;i++)
cholletisaik777 5:c77b49508927 98 {
cholletisaik777 5:c77b49508927 99 hk_data[i] = '/0';
cholletisaik777 5:c77b49508927 100 }
cholletisaik777 5:c77b49508927 101 hk_count = 0;
cholletisaik777 7:c270a9e37290 102 FCTN_WR_SD(hk_data,hk_block_number); // HK data is written to the SD card
cholletisaik777 5:c77b49508927 103 for(int i=0;i<512;i++)
cholletisaik777 5:c77b49508927 104 {
cholletisaik777 5:c77b49508927 105 hk_data[i] = '/0';
cholletisaik777 5:c77b49508927 106 }
cholletisaik777 7:c270a9e37290 107 FCTN_RD_SD(hk_data,hk_block_number);
cholletisaik777 7:c270a9e37290 108 hk_block_number++;
cholletisaik777 5:c77b49508927 109 printf("\n\r sd card hk data\n");
cholletisaik777 5:c77b49508927 110 for(int i=0;i<512;i++)
cholletisaik777 5:c77b49508927 111 {
cholletisaik777 5:c77b49508927 112 pc.printf("%d|",hk_data[i]);
cholletisaik777 5:c77b49508927 113 }
cholletisaik777 7:c270a9e37290 114 // FCTN_CDMS_HK_MAIN();
cholletisaik777 7:c270a9e37290 115 FCTN_POWER_MODE(80); //to check dummy power algo
cholletisaik777 5:c77b49508927 116 }
cholletisaik777 5:c77b49508927 117 pc.printf("\n\r hk exited\n");
cholletisaik777 0:d6e3d1e21484 118 }
cholletisaik777 7:c270a9e37290 119 /*End*/
cholletisaik777 0:d6e3d1e21484 120
cholletisaik777 7:c270a9e37290 121 /*All ISR's*/
cholletisaik777 0:d6e3d1e21484 122 void ISR_PL_RCV_SC_DATA()
cholletisaik777 0:d6e3d1e21484 123 {
cholletisaik777 7:c270a9e37290 124 ptr_t_sc_data->signal_set(0x1); //science thread is signalled from here
cholletisaik777 0:d6e3d1e21484 125 }
cholletisaik777 0:d6e3d1e21484 126
cholletisaik777 0:d6e3d1e21484 127 void ISR_CDMS_RLY_TC()
cholletisaik777 0:d6e3d1e21484 128 {
cholletisaik777 7:c270a9e37290 129 ptr_t_tc->signal_set(0x2); //TC thread is signalled from here
cholletisaik777 0:d6e3d1e21484 130 }
cholletisaik777 0:d6e3d1e21484 131
cholletisaik777 0:d6e3d1e21484 132 void ISR_CDMS_RLY_TM()
cholletisaik777 0:d6e3d1e21484 133 {
cholletisaik777 7:c270a9e37290 134 ptr_t_tm->signal_set(0x3); //TM thread is signalled from here whenever a interrupt comes from
cholletisaik777 0:d6e3d1e21484 135 }
cholletisaik777 7:c270a9e37290 136 /*End*/
cholletisaik777 0:d6e3d1e21484 137
cholletisaik777 7:c270a9e37290 138 /*main thread*/
cholletisaik777 7:c270a9e37290 139 int main()
cholletisaik777 7:c270a9e37290 140 {
sakthipriya 3:0c3f7c3fabc9 141 printf("\n\r CDMS Activated \n");
cholletisaik777 0:d6e3d1e21484 142 ptr_t_tc = new Thread (T_CDMS_RLY_TC);
cholletisaik777 0:d6e3d1e21484 143 ptr_t_tm = new Thread (T_CDMS_RLY_TM);
cholletisaik777 0:d6e3d1e21484 144 ptr_t_sc_data = new Thread (T_PL_RCV_SC_DATA);
sakthipriya 3:0c3f7c3fabc9 145 master.frequency(100000);
cholletisaik777 0:d6e3d1e21484 146 RtosTimer TIMER_HK_ACQ(TSC_CDMS_HK_MAIN,osTimerPeriodic);
cholletisaik777 7:c270a9e37290 147 TIMER_HK_ACQ.start(10000);
sakthipriya 3:0c3f7c3fabc9 148 irpt_2_slv = 1;
cholletisaik777 0:d6e3d1e21484 149 pl_sc_data.rise(&ISR_PL_RCV_SC_DATA);
cholletisaik777 0:d6e3d1e21484 150 cdms_rcv_tc.rise(&ISR_CDMS_RLY_TC);
cholletisaik777 0:d6e3d1e21484 151 bae_tm_rcv.rise(&ISR_CDMS_RLY_TM);
cholletisaik777 0:d6e3d1e21484 152 pl_tm_rcv.rise(&ISR_CDMS_RLY_TM);
cholletisaik777 0:d6e3d1e21484 153
cholletisaik777 0:d6e3d1e21484 154 pl_spi.format(8,3); // SPI format --> 16 bits, mode = 0
cholletisaik777 0:d6e3d1e21484 155 pl_spi.frequency(1000000);
cholletisaik777 0:d6e3d1e21484 156
cholletisaik777 7:c270a9e37290 157 FCTN_CDMS_HK_INIT();
cholletisaik777 7:c270a9e37290 158 FCTN_INIT_RTC();
cholletisaik777 7:c270a9e37290 159 int *status_sd = FCTN_INIT_SD();
pradeepvk2208 2:4c79b3dfef31 160
cholletisaik777 0:d6e3d1e21484 161 while(1);
cholletisaik777 7:c270a9e37290 162 }
cholletisaik777 7:c270a9e37290 163 /*End*/