
Repository for CDMS code
Dependencies: SimpleDMA mbed-rtos mbed eeprom
Fork of COM_MNG_TMTC_SIMPLE by
common_functions.h@301:701ac67649b7, 2016-09-04 (annotated)
- Committer:
- ee12b079
- Date:
- Sun Sep 04 11:12:00 2016 +0000
- Revision:
- 301:701ac67649b7
- Parent:
- 264:f7d8f9f361e3
- Child:
- 275:605dd29161ad
- Child:
- 318:978d72f191f9
Correcting CDMS_HK
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
krishanprajapat | 117:bfdc807f3d3c | 1 | #define get_tc_list(tm_ptr, thePSC){\ |
krishanprajapat | 117:bfdc807f3d3c | 2 | uint8_t TM_PSC = 0xFF;\ |
krishanprajapat | 117:bfdc807f3d3c | 3 | uint8_t TC_PSC = thePSC;\ |
krishanprajapat | 117:bfdc807f3d3c | 4 | int overflowCount = 0;\ |
krishanprajapat | 117:bfdc807f3d3c | 5 | uint8_t TC_LIST_TAG = 0x00;\ |
krishanprajapat | 117:bfdc807f3d3c | 6 | Base_tc *temp_tc = gHEAD_NODE_TCL;\ |
krishanprajapat | 117:bfdc807f3d3c | 7 | bool first_time = true;\ |
krishanprajapat | 117:bfdc807f3d3c | 8 | Base_tm *current_tm = NULL;\ |
krishanprajapat | 117:bfdc807f3d3c | 9 | while( temp_tc != NULL ){\ |
krishanprajapat | 117:bfdc807f3d3c | 10 | if( overflowCount < TCL_OVERFLOW_CONSTANT ){\ |
krishanprajapat | 117:bfdc807f3d3c | 11 | TM_PSC = TM_PSC + 1;\ |
krishanprajapat | 117:bfdc807f3d3c | 12 | /*Increment TM_PSC for every new TM pointer created*/\ |
krishanprajapat | 117:bfdc807f3d3c | 13 | Base_tm *temp_tm = new Long_tm;\ |
krishanprajapat | 117:bfdc807f3d3c | 14 | temp_tm->next_TM = NULL;\ |
krishanprajapat | 117:bfdc807f3d3c | 15 | temp_tm->TM_string[0] = 0x38;\ |
krishanprajapat | 117:bfdc807f3d3c | 16 | /*Frame type(1) = 0; TMID = 0111; Spare = 000*/\ |
krishanprajapat | 117:bfdc807f3d3c | 17 | temp_tm->TM_string[1] = TC_PSC;\ |
krishanprajapat | 117:bfdc807f3d3c | 18 | temp_tm->TM_string[3] = TM_PSC;\ |
krishanprajapat | 117:bfdc807f3d3c | 19 | int indexCustom = 4, num_of_short_tc = 0;\ |
krishanprajapat | 117:bfdc807f3d3c | 20 | while(temp_tc != NULL){\ |
krishanprajapat | 117:bfdc807f3d3c | 21 | if( overflowCount < TCL_OVERFLOW_CONSTANT ){\ |
krishanprajapat | 117:bfdc807f3d3c | 22 | if( GETshort_or_long_tc(temp_tc) == SHORT_TC_CODE ){\ |
krishanprajapat | 117:bfdc807f3d3c | 23 | for( int i = 0 ; i < TC_SHORT_SIZE ; ++i ){\ |
krishanprajapat | 117:bfdc807f3d3c | 24 | temp_tm->TM_string[indexCustom + i] = temp_tc->TC_string[i];\ |
krishanprajapat | 117:bfdc807f3d3c | 25 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 26 | indexCustom = indexCustom + TC_SHORT_SIZE;\ |
krishanprajapat | 117:bfdc807f3d3c | 27 | ++overflowCount;\ |
krishanprajapat | 117:bfdc807f3d3c | 28 | /*INCREMENT STUFF*/\ |
krishanprajapat | 117:bfdc807f3d3c | 29 | temp_tc = temp_tc->next_TC;\ |
krishanprajapat | 117:bfdc807f3d3c | 30 | num_of_short_tc = num_of_short_tc + 1;\ |
krishanprajapat | 117:bfdc807f3d3c | 31 | if (temp_tc == NULL){\ |
krishanprajapat | 117:bfdc807f3d3c | 32 | for (int i = indexCustom ; i < TM_LONG_SIZE-2 ; ++i){\ |
krishanprajapat | 117:bfdc807f3d3c | 33 | temp_tm->TM_string[i] = 0;\ |
krishanprajapat | 117:bfdc807f3d3c | 34 | /*Fill remaining values with 0*/\ |
krishanprajapat | 117:bfdc807f3d3c | 35 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 36 | TC_LIST_TAG = num_of_short_tc;\ |
krishanprajapat | 117:bfdc807f3d3c | 37 | break;\ |
krishanprajapat | 117:bfdc807f3d3c | 38 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 39 | if( (GETshort_or_long_tc(temp_tc) == LONG_TC_CODE) || (num_of_short_tc == OBOSC_TCL_MAX_SHORT_SIZE) ){\ |
krishanprajapat | 117:bfdc807f3d3c | 40 | /*Next TC is long or memory is filled*/\ |
krishanprajapat | 117:bfdc807f3d3c | 41 | for(int i = indexCustom; i < TM_LONG_SIZE-2 ; ++i){\ |
krishanprajapat | 117:bfdc807f3d3c | 42 | temp_tm->TM_string[i] = 0;\ |
krishanprajapat | 117:bfdc807f3d3c | 43 | /*Fill remaining values with 0*/\ |
krishanprajapat | 117:bfdc807f3d3c | 44 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 45 | TC_LIST_TAG = num_of_short_tc;\ |
krishanprajapat | 117:bfdc807f3d3c | 46 | break;\ |
krishanprajapat | 117:bfdc807f3d3c | 47 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 48 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 49 | else if (TC_LIST_TAG == OBOSC_TCL_TAG_LONG_FIRST_HALF){\ |
krishanprajapat | 117:bfdc807f3d3c | 50 | /*Long TC, 2nd half*/\ |
krishanprajapat | 117:bfdc807f3d3c | 51 | for (int i = 0; i < OBOSC_LONG_TC_SECOND_HALF_SIZE ; ++i){\ |
krishanprajapat | 117:bfdc807f3d3c | 52 | temp_tm->TM_string[indexCustom + i] = temp_tc->TC_string[OBOSC_LONG_TC_FIRST_HALF_SIZE + i];\ |
krishanprajapat | 117:bfdc807f3d3c | 53 | /*Fill the TM with TC_values*/\ |
krishanprajapat | 117:bfdc807f3d3c | 54 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 55 | for (int i = OBOSC_LONG_TC_SECOND_HALF_SIZE + indexCustom ; i < TM_LONG_SIZE-2 ; ++i ){\ |
krishanprajapat | 117:bfdc807f3d3c | 56 | temp_tm->TM_string[i] = 0;\ |
krishanprajapat | 117:bfdc807f3d3c | 57 | /*Fill remaining values with 0*/\ |
krishanprajapat | 117:bfdc807f3d3c | 58 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 59 | temp_tc = temp_tc->next_TC;\ |
krishanprajapat | 117:bfdc807f3d3c | 60 | TC_LIST_TAG = OBOSC_TCL_TAG_LONG_SECOND_HALF;\ |
krishanprajapat | 117:bfdc807f3d3c | 61 | ++overflowCount;\ |
krishanprajapat | 117:bfdc807f3d3c | 62 | break;\ |
krishanprajapat | 117:bfdc807f3d3c | 63 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 64 | else{\ |
krishanprajapat | 117:bfdc807f3d3c | 65 | /*Long TC, 1st half */\ |
krishanprajapat | 117:bfdc807f3d3c | 66 | for (int i = 0; i < OBOSC_LONG_TC_FIRST_HALF_SIZE; ++i){\ |
krishanprajapat | 117:bfdc807f3d3c | 67 | /*gPC.printf("indexCustom = %d\r\n", indexCustom);*/\ |
krishanprajapat | 117:bfdc807f3d3c | 68 | temp_tm->TM_string[indexCustom + i] = temp_tc->TC_string[i];\ |
krishanprajapat | 117:bfdc807f3d3c | 69 | /*Fill the TM with TC_values*/\ |
krishanprajapat | 117:bfdc807f3d3c | 70 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 71 | for (int i = OBOSC_LONG_TC_FIRST_HALF_SIZE + indexCustom ; i < TM_LONG_SIZE-2 ; ++i ){\ |
krishanprajapat | 117:bfdc807f3d3c | 72 | temp_tm->TM_string[i] = 0;\ |
krishanprajapat | 117:bfdc807f3d3c | 73 | /*Fill remaining values with 0*/\ |
krishanprajapat | 117:bfdc807f3d3c | 74 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 75 | TC_LIST_TAG = OBOSC_TCL_TAG_LONG_FIRST_HALF;\ |
krishanprajapat | 117:bfdc807f3d3c | 76 | break;\ |
krishanprajapat | 117:bfdc807f3d3c | 77 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 78 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 79 | else{\ |
aniruddhv | 262:752c8689944a | 80 | RESET_CDMS;\ |
krishanprajapat | 117:bfdc807f3d3c | 81 | break;\ |
krishanprajapat | 117:bfdc807f3d3c | 82 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 83 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 84 | temp_tm->TM_string[2] = TC_LIST_TAG;\ |
krishanprajapat | 117:bfdc807f3d3c | 85 | /*TC_LIST_TAG as is updated in the inner while loop*/\ |
krishanprajapat | 117:bfdc807f3d3c | 86 | uint16_t crc16 = crc16_gen(temp_tm->TM_string, TM_LONG_SIZE-2);\ |
krishanprajapat | 117:bfdc807f3d3c | 87 | temp_tm->TM_string[TM_LONG_SIZE-2] = (crc16 & 0xFF00) >> 8 ;\ |
krishanprajapat | 117:bfdc807f3d3c | 88 | temp_tm->TM_string[TM_LONG_SIZE-1] = crc16 & 0x00FF;\ |
krishanprajapat | 117:bfdc807f3d3c | 89 | /*Attach this new node to the TM linked list*/\ |
krishanprajapat | 117:bfdc807f3d3c | 90 | if( first_time ){\ |
krishanprajapat | 117:bfdc807f3d3c | 91 | first_time = false;\ |
krishanprajapat | 117:bfdc807f3d3c | 92 | tm_ptr = temp_tm;\ |
krishanprajapat | 117:bfdc807f3d3c | 93 | current_tm = temp_tm;\ |
krishanprajapat | 117:bfdc807f3d3c | 94 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 95 | else{\ |
krishanprajapat | 117:bfdc807f3d3c | 96 | current_tm->next_TM = temp_tm;\ |
krishanprajapat | 117:bfdc807f3d3c | 97 | current_tm = current_tm->next_TM;\ |
krishanprajapat | 117:bfdc807f3d3c | 98 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 99 | /*Attach this new node at the end*/\ |
krishanprajapat | 117:bfdc807f3d3c | 100 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 101 | else{\ |
aniruddhv | 262:752c8689944a | 102 | RESET_CDMS;\ |
krishanprajapat | 117:bfdc807f3d3c | 103 | break;\ |
krishanprajapat | 117:bfdc807f3d3c | 104 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 105 | }\ |
krishanprajapat | 117:bfdc807f3d3c | 106 | } |
krishanprajapat | 117:bfdc807f3d3c | 107 | |
krishanprajapat | 122:b99f8be0a51a | 108 | #define put_crc_l1_ack(tm_ptr) {\ |
krishanprajapat | 122:b99f8be0a51a | 109 | /*TC LIST STATUS*/\ |
aniruddhv | 262:752c8689944a | 110 | tm_ptr->TM_string[3] |= (gMASTER_STATE << 6) & 0xC0;\ |
krishanprajapat | 122:b99f8be0a51a | 111 | /*PA HOT*/\ |
krishanprajapat | 122:b99f8be0a51a | 112 | if( gFLAGS & COM_PA_HOT_FLAG ){\ |
aniruddhv | 262:752c8689944a | 113 | tm_ptr->TM_string[3] |= (1 << 5);\ |
aniruddhv | 262:752c8689944a | 114 | }\ |
aniruddhv | 262:752c8689944a | 115 | else{\ |
aniruddhv | 262:752c8689944a | 116 | tm_ptr->TM_string[3] &= ~(1 << 5);\ |
aniruddhv | 262:752c8689944a | 117 | }\ |
aniruddhv | 262:752c8689944a | 118 | /*PA OC*/\ |
aniruddhv | 262:752c8689944a | 119 | if( gFLAGS & COM_PA_OC_FLAG ){\ |
krishanprajapat | 122:b99f8be0a51a | 120 | tm_ptr->TM_string[3] |= (1 << 4);\ |
krishanprajapat | 122:b99f8be0a51a | 121 | }\ |
krishanprajapat | 122:b99f8be0a51a | 122 | else{\ |
krishanprajapat | 122:b99f8be0a51a | 123 | tm_ptr->TM_string[3] &= ~(1 << 4);\ |
krishanprajapat | 122:b99f8be0a51a | 124 | }\ |
krishanprajapat | 122:b99f8be0a51a | 125 | uint16_t crc_checksum = crc16_gen(tm_ptr->TM_string, TM_SHORT_SIZE-2);\ |
krishanprajapat | 122:b99f8be0a51a | 126 | tm_ptr->TM_string[TM_SHORT_SIZE-2] = (crc_checksum >> 8) & 0xFF;\ |
krishanprajapat | 122:b99f8be0a51a | 127 | tm_ptr->TM_string[TM_SHORT_SIZE-1] = crc_checksum & 0xFF;\ |
krishanprajapat | 122:b99f8be0a51a | 128 | } |
krishanprajapat | 122:b99f8be0a51a | 129 | |
krishanprajapat | 122:b99f8be0a51a | 130 | #define fill_l1_ack(tm_ptr) {\ |
krishanprajapat | 122:b99f8be0a51a | 131 | tm_ptr->next_TM = NULL;\ |
krishanprajapat | 122:b99f8be0a51a | 132 | tm_ptr->TM_string[0] = TMID_ACK_L1 << 4;\ |
krishanprajapat | 122:b99f8be0a51a | 133 | tm_ptr->TM_string[1] = gTOTAL_INCORRECT_SIZE_TC & 0xFF;\ |
krishanprajapat | 122:b99f8be0a51a | 134 | tm_ptr->TM_string[2] = gTOTAL_CRC_FAIL_TC & 0xFF;\ |
krishanprajapat | 122:b99f8be0a51a | 135 | } |
krishanprajapat | 122:b99f8be0a51a | 136 | |
aniruddhv | 262:752c8689944a | 137 | #define P_COM_HK{\ |
aniruddhv | 262:752c8689944a | 138 | uint8_t returnHere;\ |
aniruddhv | 262:752c8689944a | 139 | isPAhot(returnHere);\ |
aniruddhv | 262:752c8689944a | 140 | if (returnHere == 0xFF)\ |
aniruddhv | 264:f7d8f9f361e3 | 141 | gFLAGS = gFLAGS | COM_PA_HOT_FLAG;\ |
aniruddhv | 262:752c8689944a | 142 | else\ |
aniruddhv | 264:f7d8f9f361e3 | 143 | gFLAGS = gFLAGS & ~(COM_PA_HOT_FLAG);\ |
aniruddhv | 262:752c8689944a | 144 | if (gFLAGS & COM_PA_OC_FLAG){\ |
aniruddhv | 262:752c8689944a | 145 | COM_TX_CNTRL = 1;\ |
aniruddhv | 262:752c8689944a | 146 | wait_ms(5);\ |
aniruddhv | 262:752c8689944a | 147 | }\ |
aniruddhv | 262:752c8689944a | 148 | isPAoc(returnHere);\ |
aniruddhv | 262:752c8689944a | 149 | if (returnHere == 0xFF)\ |
aniruddhv | 264:f7d8f9f361e3 | 150 | gFLAGS = gFLAGS | COM_PA_OC_FLAG;\ |
aniruddhv | 262:752c8689944a | 151 | else\ |
aniruddhv | 264:f7d8f9f361e3 | 152 | gFLAGS = gFLAGS & ~(COM_PA_OC_FLAG);\ |
aniruddhv | 262:752c8689944a | 153 | /*P_CDMS_HANDLE_HW_FAULTS*/\ |
aniruddhv | 262:752c8689944a | 154 | } |
aniruddhv | 262:752c8689944a | 155 | |
krishanprajapat | 122:b99f8be0a51a | 156 | #define isPAhot(returnHere){\ |
aniruddhv | 262:752c8689944a | 157 | uint8_t pa_temp = 0;\ |
aniruddhv | 262:752c8689944a | 158 | uint8_t pa_temp_quant = 0;\ |
aniruddhv | 262:752c8689944a | 159 | SelectLinec0=0;\ |
aniruddhv | 262:752c8689944a | 160 | SelectLinec1=0;\ |
aniruddhv | 262:752c8689944a | 161 | SelectLinec2=0;\ |
aniruddhv | 262:752c8689944a | 162 | SelectLinec3=1;\ |
aniruddhv | 262:752c8689944a | 163 | pa_temp = TempInput.read();\ |
aniruddhv | 262:752c8689944a | 164 | pa_temp = pa_temp * 3.3;\ |
aniruddhv | 262:752c8689944a | 165 | int resistance;\ |
aniruddhv | 262:752c8689944a | 166 | resistance = 24000 * pa_temp/(3.3 - pa_temp);\ |
aniruddhv | 262:752c8689944a | 167 | if(pa_temp > 1.47) {\ |
aniruddhv | 262:752c8689944a | 168 | pa_temp = 3694/log(24.032242*resistance);\ |
aniruddhv | 262:752c8689944a | 169 | }\ |
aniruddhv | 262:752c8689944a | 170 | else{\ |
aniruddhv | 262:752c8689944a | 171 | pa_temp = 3365.4/log(7.60573*resistance);\ |
aniruddhv | 262:752c8689944a | 172 | }\ |
aniruddhv | 262:752c8689944a | 173 | pa_temp_quant = quantiz(tstart_thermistor,tstep_thermistor,pa_temp);\ |
aniruddhv | 264:f7d8f9f361e3 | 174 | pa_temp_quant = 0;\ |
aniruddhv | 262:752c8689944a | 175 | if (pa_temp_quant > COM_PA_TMP_HIGH){\ |
aniruddhv | 264:f7d8f9f361e3 | 176 | returnHere = 0xFF;\ |
aniruddhv | 264:f7d8f9f361e3 | 177 | gPC.puts("PA is measured HOT\r\n");\ |
aniruddhv | 262:752c8689944a | 178 | }\ |
aniruddhv | 262:752c8689944a | 179 | else{\ |
aniruddhv | 264:f7d8f9f361e3 | 180 | returnHere = 0;\ |
aniruddhv | 264:f7d8f9f361e3 | 181 | gPC.puts("PA is measured not HOT\r\n");\ |
aniruddhv | 262:752c8689944a | 182 | }\ |
aniruddhv | 262:752c8689944a | 183 | } |
aniruddhv | 262:752c8689944a | 184 | |
aniruddhv | 262:752c8689944a | 185 | #define isPAoc(returnHere){\ |
aniruddhv | 264:f7d8f9f361e3 | 186 | if (COM_TX_OC_FAULT){\ |
aniruddhv | 264:f7d8f9f361e3 | 187 | returnHere = 0xFF;\ |
aniruddhv | 264:f7d8f9f361e3 | 188 | }\ |
aniruddhv | 264:f7d8f9f361e3 | 189 | else{\ |
aniruddhv | 262:752c8689944a | 190 | returnHere = 0;\ |
aniruddhv | 264:f7d8f9f361e3 | 191 | }\ |
aniruddhv | 264:f7d8f9f361e3 | 192 | returnHere = 0;\ |
krishanprajapat | 122:b99f8be0a51a | 193 | } |
krishanprajapat | 122:b99f8be0a51a | 194 | |
krishanprajapat | 117:bfdc807f3d3c | 195 | #define get_call_sign(tm_ptr) {\ |
krishanprajapat | 117:bfdc807f3d3c | 196 | Base_tm* call_sign_tm = new Short_tm;\ |
krishanprajapat | 117:bfdc807f3d3c | 197 | call_sign_tm->next_TM = NULL;\ |
krishanprajapat | 117:bfdc807f3d3c | 198 | tm_ptr = call_sign_tm;\ |
krishanprajapat | 117:bfdc807f3d3c | 199 | for( int i = 0 ; i < TM_SHORT_SIZE ; ++i ){\ |
krishanprajapat | 117:bfdc807f3d3c | 200 | call_sign_tm->TM_string[i] = gCALL_SIGN_STRING[i];\ |
krishanprajapat | 117:bfdc807f3d3c | 201 | }\ |
krishanprajapat | 119:2b5632bc78ab | 202 | } |
krishanprajapat | 119:2b5632bc78ab | 203 | |
krishanprajapat | 119:2b5632bc78ab | 204 | #define get_ack_l1( tm_ptr ){\ |
krishanprajapat | 119:2b5632bc78ab | 205 | Base_tc *current_TC = gHEAD_NODE_TCL;\ |
krishanprajapat | 119:2b5632bc78ab | 206 | Base_tm *l1_ack = new Short_tm;\ |
krishanprajapat | 119:2b5632bc78ab | 207 | /*APPEND TO THE tm_ptr HERE*/\ |
krishanprajapat | 119:2b5632bc78ab | 208 | tm_ptr = l1_ack;\ |
krishanprajapat | 119:2b5632bc78ab | 209 | fill_l1_ack(l1_ack);\ |
krishanprajapat | 119:2b5632bc78ab | 210 | int TC_count = 0;\ |
krishanprajapat | 119:2b5632bc78ab | 211 | int overflowCountL1 = 0;\ |
krishanprajapat | 119:2b5632bc78ab | 212 | while(current_TC != NULL){\ |
krishanprajapat | 119:2b5632bc78ab | 213 | if( overflowCountL1 < TCL_OVERFLOW_CONSTANT ){\ |
krishanprajapat | 119:2b5632bc78ab | 214 | /*IF CRC PASS*/\ |
krishanprajapat | 119:2b5632bc78ab | 215 | if( (GETcrc_pass(current_TC) == 1) ){\ |
krishanprajapat | 119:2b5632bc78ab | 216 | if(TC_count > 4){\ |
krishanprajapat | 119:2b5632bc78ab | 217 | put_crc_l1_ack( l1_ack );\ |
krishanprajapat | 119:2b5632bc78ab | 218 | /*extend the TM linked list*/\ |
krishanprajapat | 119:2b5632bc78ab | 219 | TC_count = 0;\ |
krishanprajapat | 119:2b5632bc78ab | 220 | l1_ack->next_TM = new Short_tm;\ |
krishanprajapat | 119:2b5632bc78ab | 221 | l1_ack = l1_ack->next_TM;\ |
krishanprajapat | 119:2b5632bc78ab | 222 | fill_l1_ack(l1_ack);\ |
krishanprajapat | 119:2b5632bc78ab | 223 | }\ |
krishanprajapat | 119:2b5632bc78ab | 224 | /*PSC starts from 7th byte*/\ |
krishanprajapat | 119:2b5632bc78ab | 225 | l1_ack->TM_string[6+TC_count] = GETpacket_seq_count(current_TC);\ |
krishanprajapat | 119:2b5632bc78ab | 226 | /*TC exec status*/\ |
krishanprajapat | 119:2b5632bc78ab | 227 | switch(TC_count){\ |
krishanprajapat | 119:2b5632bc78ab | 228 | case 0:\ |
krishanprajapat | 119:2b5632bc78ab | 229 | l1_ack->TM_string[3] = (GETexec_status(current_TC)) & 0x0F;\ |
krishanprajapat | 119:2b5632bc78ab | 230 | break;\ |
krishanprajapat | 119:2b5632bc78ab | 231 | case 1:\ |
krishanprajapat | 119:2b5632bc78ab | 232 | l1_ack->TM_string[4] = (GETexec_status(current_TC) << 4) & 0xF0;\ |
krishanprajapat | 119:2b5632bc78ab | 233 | break;\ |
krishanprajapat | 119:2b5632bc78ab | 234 | case 2:\ |
krishanprajapat | 119:2b5632bc78ab | 235 | l1_ack->TM_string[4] |= (GETexec_status(current_TC)) & 0x0F;\ |
krishanprajapat | 119:2b5632bc78ab | 236 | break;\ |
krishanprajapat | 119:2b5632bc78ab | 237 | case 3:\ |
krishanprajapat | 119:2b5632bc78ab | 238 | l1_ack->TM_string[5] = (GETexec_status(current_TC) << 4) & 0xF0;\ |
krishanprajapat | 119:2b5632bc78ab | 239 | break;\ |
krishanprajapat | 119:2b5632bc78ab | 240 | case 4:\ |
krishanprajapat | 119:2b5632bc78ab | 241 | l1_ack->TM_string[5] |= (GETexec_status(current_TC)) & 0x0F;\ |
krishanprajapat | 119:2b5632bc78ab | 242 | }\ |
krishanprajapat | 119:2b5632bc78ab | 243 | ++TC_count;\ |
krishanprajapat | 119:2b5632bc78ab | 244 | }\ |
krishanprajapat | 119:2b5632bc78ab | 245 | current_TC = current_TC->next_TC;\ |
krishanprajapat | 119:2b5632bc78ab | 246 | ++overflowCountL1;\ |
krishanprajapat | 119:2b5632bc78ab | 247 | }\ |
krishanprajapat | 119:2b5632bc78ab | 248 | else{\ |
aniruddhv | 262:752c8689944a | 249 | RESET_CDMS;\ |
krishanprajapat | 119:2b5632bc78ab | 250 | break;\ |
krishanprajapat | 119:2b5632bc78ab | 251 | }\ |
krishanprajapat | 119:2b5632bc78ab | 252 | }\ |
krishanprajapat | 119:2b5632bc78ab | 253 | /*FILL UP THE REMAINING FIELDS WITH 0x00 as PSC, AND 0xF as tc exec status*/\ |
krishanprajapat | 119:2b5632bc78ab | 254 | if( (TC_count < 5) && (TC_count != 0) ){\ |
krishanprajapat | 119:2b5632bc78ab | 255 | while(TC_count < 5){\ |
krishanprajapat | 119:2b5632bc78ab | 256 | l1_ack->TM_string[6+TC_count] = 0x00;\ |
krishanprajapat | 119:2b5632bc78ab | 257 | switch(TC_count){\ |
krishanprajapat | 119:2b5632bc78ab | 258 | case 1:\ |
krishanprajapat | 119:2b5632bc78ab | 259 | l1_ack->TM_string[4] = 0xF0;\ |
krishanprajapat | 119:2b5632bc78ab | 260 | break;\ |
krishanprajapat | 119:2b5632bc78ab | 261 | case 2:\ |
krishanprajapat | 119:2b5632bc78ab | 262 | l1_ack->TM_string[4] |= 0x0F;\ |
krishanprajapat | 119:2b5632bc78ab | 263 | break;\ |
krishanprajapat | 119:2b5632bc78ab | 264 | case 3:\ |
krishanprajapat | 119:2b5632bc78ab | 265 | l1_ack->TM_string[5] = 0xF0;\ |
krishanprajapat | 119:2b5632bc78ab | 266 | break;\ |
krishanprajapat | 119:2b5632bc78ab | 267 | case 4:\ |
krishanprajapat | 119:2b5632bc78ab | 268 | l1_ack->TM_string[5] |= 0x0F;\ |
krishanprajapat | 119:2b5632bc78ab | 269 | }\ |
krishanprajapat | 119:2b5632bc78ab | 270 | ++TC_count;\ |
krishanprajapat | 119:2b5632bc78ab | 271 | }\ |
krishanprajapat | 119:2b5632bc78ab | 272 | }\ |
krishanprajapat | 119:2b5632bc78ab | 273 | put_crc_l1_ack(l1_ack);\ |
krishanprajapat | 117:bfdc807f3d3c | 274 | } |