CDMS code for testing sbc

Dependencies:   FreescaleIAP SimpleDMA mbed-rtos mbed

Fork of CDMS_CODE by shubham c

Committer:
chaithanyarss
Date:
Sun Jul 03 11:35:55 2016 +0000
Revision:
217:93505a6f8db7
Parent:
216:570251b23c7b
merging Completed.

Who changed what in which revision?

UserRevisionLine numberNew 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{\
chaithanyarss 217:93505a6f8db7 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{\
chaithanyarss 217:93505a6f8db7 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*/\
chaithanyarss 217:93505a6f8db7 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 ){\
chaithanyarss 217:93505a6f8db7 113 tm_ptr->TM_string[3] |= (1 << 5);\
chaithanyarss 217:93505a6f8db7 114 }\
chaithanyarss 217:93505a6f8db7 115 else{\
chaithanyarss 217:93505a6f8db7 116 tm_ptr->TM_string[3] &= ~(1 << 5);\
chaithanyarss 217:93505a6f8db7 117 }\
chaithanyarss 217:93505a6f8db7 118 /*PA OC*/\
chaithanyarss 217:93505a6f8db7 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
chaithanyarss 217:93505a6f8db7 137 #define P_COM_HK{\
chaithanyarss 217:93505a6f8db7 138 uint8_t returnHere;\
chaithanyarss 217:93505a6f8db7 139 isPAhot(returnHere);\
chaithanyarss 217:93505a6f8db7 140 if (returnHere == 0xFF)\
chaithanyarss 217:93505a6f8db7 141 gFLAGS = gFLAGS & ~(COM_PA_HOT_FLAG);\
chaithanyarss 217:93505a6f8db7 142 else\
chaithanyarss 217:93505a6f8db7 143 gFLAGS = gFLAGS | COM_PA_HOT_FLAG;\
chaithanyarss 217:93505a6f8db7 144 if (gFLAGS & COM_PA_OC_FLAG){\
chaithanyarss 217:93505a6f8db7 145 COM_TX_CNTRL = 1;\
chaithanyarss 217:93505a6f8db7 146 wait_ms(5);\
chaithanyarss 217:93505a6f8db7 147 }\
chaithanyarss 217:93505a6f8db7 148 isPAoc(returnHere);\
chaithanyarss 217:93505a6f8db7 149 if (returnHere == 0xFF)\
chaithanyarss 217:93505a6f8db7 150 gFLAGS = gFLAGS & ~(COM_PA_OC_FLAG);\
chaithanyarss 217:93505a6f8db7 151 else\
chaithanyarss 217:93505a6f8db7 152 gFLAGS = gFLAGS | COM_PA_OC_FLAG;\
chaithanyarss 217:93505a6f8db7 153 /*P_CDMS_HANDLE_HW_FAULTS*/\
chaithanyarss 217:93505a6f8db7 154 }
chaithanyarss 217:93505a6f8db7 155
krishanprajapat 122:b99f8be0a51a 156 #define isPAhot(returnHere){\
krishanprajapat 122:b99f8be0a51a 157 /*PENDING : COMPLETE THIS FUNCTION*/\
krishanprajapat 122:b99f8be0a51a 158 returnHere = 0xFF;\
krishanprajapat 122:b99f8be0a51a 159 }
krishanprajapat 122:b99f8be0a51a 160
chaithanyarss 217:93505a6f8db7 161 #define isPAoc(returnHere){\
chaithanyarss 217:93505a6f8db7 162 /*PENDING : COMPLETE THIS FUNCTION*/\
chaithanyarss 217:93505a6f8db7 163 returnHere = 0xFF;\
chaithanyarss 217:93505a6f8db7 164 }
chaithanyarss 217:93505a6f8db7 165
krishanprajapat 117:bfdc807f3d3c 166 #define get_call_sign(tm_ptr) {\
krishanprajapat 117:bfdc807f3d3c 167 Base_tm* call_sign_tm = new Short_tm;\
krishanprajapat 117:bfdc807f3d3c 168 call_sign_tm->next_TM = NULL;\
krishanprajapat 117:bfdc807f3d3c 169 tm_ptr = call_sign_tm;\
krishanprajapat 117:bfdc807f3d3c 170 for( int i = 0 ; i < TM_SHORT_SIZE ; ++i ){\
krishanprajapat 117:bfdc807f3d3c 171 call_sign_tm->TM_string[i] = gCALL_SIGN_STRING[i];\
krishanprajapat 117:bfdc807f3d3c 172 }\
krishanprajapat 119:2b5632bc78ab 173 }
krishanprajapat 119:2b5632bc78ab 174
krishanprajapat 119:2b5632bc78ab 175 #define get_ack_l1( tm_ptr ){\
krishanprajapat 119:2b5632bc78ab 176 Base_tc *current_TC = gHEAD_NODE_TCL;\
krishanprajapat 119:2b5632bc78ab 177 Base_tm *l1_ack = new Short_tm;\
krishanprajapat 119:2b5632bc78ab 178 /*APPEND TO THE tm_ptr HERE*/\
krishanprajapat 119:2b5632bc78ab 179 tm_ptr = l1_ack;\
krishanprajapat 119:2b5632bc78ab 180 fill_l1_ack(l1_ack);\
krishanprajapat 119:2b5632bc78ab 181 int TC_count = 0;\
krishanprajapat 119:2b5632bc78ab 182 int overflowCountL1 = 0;\
krishanprajapat 119:2b5632bc78ab 183 while(current_TC != NULL){\
krishanprajapat 119:2b5632bc78ab 184 if( overflowCountL1 < TCL_OVERFLOW_CONSTANT ){\
krishanprajapat 119:2b5632bc78ab 185 /*IF CRC PASS*/\
krishanprajapat 119:2b5632bc78ab 186 if( (GETcrc_pass(current_TC) == 1) ){\
krishanprajapat 119:2b5632bc78ab 187 if(TC_count > 4){\
krishanprajapat 119:2b5632bc78ab 188 put_crc_l1_ack( l1_ack );\
krishanprajapat 119:2b5632bc78ab 189 /*extend the TM linked list*/\
krishanprajapat 119:2b5632bc78ab 190 TC_count = 0;\
krishanprajapat 119:2b5632bc78ab 191 l1_ack->next_TM = new Short_tm;\
krishanprajapat 119:2b5632bc78ab 192 l1_ack = l1_ack->next_TM;\
krishanprajapat 119:2b5632bc78ab 193 fill_l1_ack(l1_ack);\
krishanprajapat 119:2b5632bc78ab 194 }\
krishanprajapat 119:2b5632bc78ab 195 /*PSC starts from 7th byte*/\
krishanprajapat 119:2b5632bc78ab 196 l1_ack->TM_string[6+TC_count] = GETpacket_seq_count(current_TC);\
krishanprajapat 119:2b5632bc78ab 197 /*TC exec status*/\
krishanprajapat 119:2b5632bc78ab 198 switch(TC_count){\
krishanprajapat 119:2b5632bc78ab 199 case 0:\
krishanprajapat 119:2b5632bc78ab 200 l1_ack->TM_string[3] = (GETexec_status(current_TC)) & 0x0F;\
krishanprajapat 119:2b5632bc78ab 201 break;\
krishanprajapat 119:2b5632bc78ab 202 case 1:\
krishanprajapat 119:2b5632bc78ab 203 l1_ack->TM_string[4] = (GETexec_status(current_TC) << 4) & 0xF0;\
krishanprajapat 119:2b5632bc78ab 204 break;\
krishanprajapat 119:2b5632bc78ab 205 case 2:\
krishanprajapat 119:2b5632bc78ab 206 l1_ack->TM_string[4] |= (GETexec_status(current_TC)) & 0x0F;\
krishanprajapat 119:2b5632bc78ab 207 break;\
krishanprajapat 119:2b5632bc78ab 208 case 3:\
krishanprajapat 119:2b5632bc78ab 209 l1_ack->TM_string[5] = (GETexec_status(current_TC) << 4) & 0xF0;\
krishanprajapat 119:2b5632bc78ab 210 break;\
krishanprajapat 119:2b5632bc78ab 211 case 4:\
krishanprajapat 119:2b5632bc78ab 212 l1_ack->TM_string[5] |= (GETexec_status(current_TC)) & 0x0F;\
krishanprajapat 119:2b5632bc78ab 213 }\
krishanprajapat 119:2b5632bc78ab 214 ++TC_count;\
krishanprajapat 119:2b5632bc78ab 215 }\
krishanprajapat 119:2b5632bc78ab 216 current_TC = current_TC->next_TC;\
krishanprajapat 119:2b5632bc78ab 217 ++overflowCountL1;\
krishanprajapat 119:2b5632bc78ab 218 }\
krishanprajapat 119:2b5632bc78ab 219 else{\
chaithanyarss 217:93505a6f8db7 220 RESET_CDMS;\
krishanprajapat 119:2b5632bc78ab 221 break;\
krishanprajapat 119:2b5632bc78ab 222 }\
krishanprajapat 119:2b5632bc78ab 223 }\
krishanprajapat 119:2b5632bc78ab 224 /*FILL UP THE REMAINING FIELDS WITH 0x00 as PSC, AND 0xF as tc exec status*/\
krishanprajapat 119:2b5632bc78ab 225 if( (TC_count < 5) && (TC_count != 0) ){\
krishanprajapat 119:2b5632bc78ab 226 while(TC_count < 5){\
krishanprajapat 119:2b5632bc78ab 227 l1_ack->TM_string[6+TC_count] = 0x00;\
krishanprajapat 119:2b5632bc78ab 228 switch(TC_count){\
krishanprajapat 119:2b5632bc78ab 229 case 1:\
krishanprajapat 119:2b5632bc78ab 230 l1_ack->TM_string[4] = 0xF0;\
krishanprajapat 119:2b5632bc78ab 231 break;\
krishanprajapat 119:2b5632bc78ab 232 case 2:\
krishanprajapat 119:2b5632bc78ab 233 l1_ack->TM_string[4] |= 0x0F;\
krishanprajapat 119:2b5632bc78ab 234 break;\
krishanprajapat 119:2b5632bc78ab 235 case 3:\
krishanprajapat 119:2b5632bc78ab 236 l1_ack->TM_string[5] = 0xF0;\
krishanprajapat 119:2b5632bc78ab 237 break;\
krishanprajapat 119:2b5632bc78ab 238 case 4:\
krishanprajapat 119:2b5632bc78ab 239 l1_ack->TM_string[5] |= 0x0F;\
krishanprajapat 119:2b5632bc78ab 240 }\
krishanprajapat 119:2b5632bc78ab 241 ++TC_count;\
krishanprajapat 119:2b5632bc78ab 242 }\
krishanprajapat 119:2b5632bc78ab 243 }\
krishanprajapat 119:2b5632bc78ab 244 put_crc_l1_ack(l1_ack);\
krishanprajapat 117:bfdc807f3d3c 245 }