SBC_TEST_CDMS_CODE - CDMS code for testing sbc

Users » ee12b079 » Code » SBC_TEST_CDMS_CODE

shubham c / Mbed 2 deprecated SBC_TEST_CDMS_CODE

CDMS code for testing sbc

Dependencies: FreescaleIAP SimpleDMA mbed-rtos mbed

COM_MNG_TMTC.h@264:f7d8f9f361e3, 2016-07-14 (annotated)

Committer:: aniruddhv
Date:: Thu Jul 14 23:05:09 2016 +0000
Revision:: 264:f7d8f9f361e3
Parent:: 263:3b872778b8c7
Child:: 265:ab1b6b569b69
Child:: 266:ae588e75cfa4

Latest_code - Partially Integrated aniruddh's revision, made changes in i2c , PA_HOT, OC_SW to be tested later, Long Beacon not received somtimes alternatively

Who changed what in which revision?

User	Revision	Line number	New contents of line
shreeshas95	0:f016e9e8d48b	1	// 8 Jul
shreeshas95	0:f016e9e8d48b	2	// did flowchart of states
shreeshas95	0:f016e9e8d48b	3
shreeshas95	0:f016e9e8d48b	4	// handle sd card with cdms team
shreeshas95	0:f016e9e8d48b	5
shreeshas95	0:f016e9e8d48b	6	// Jun 6
shreeshas95	0:f016e9e8d48b	7	// WHAT IS TC exec code in L1 ack ?
shreeshas95	0:f016e9e8d48b	8
aniruddhv	52:0bd68655c651	9	//Jan 7
aniruddhv	52:0bd68655c651	10	//added RLY_TMTC function
aniruddhv	52:0bd68655c651	11	//added included related files
aniruddhv	52:0bd68655c651	12
ee12b079	210:f4acf895b598	13	//#include "Flash.h"
ee12b079	210:f4acf895b598	14
chaithanyarss	228:335da5b0d3e4	15	//DigitalIn tm_status_4m_slv(PIN39); //I2C interrupt to CDMS from BAE
ee12b079	210:f4acf895b598	16	//DigitalIn tm_status_4m_pl(PIN61); //I2C interrupt to CDMS from PL
chaithanyarss	224:3ac1f91e0ebc	17	#define RESET_CDMS NVIC_SystemReset()
aniruddhv	52:0bd68655c651	18
ee12b079	232:bfce738e43e8	19
aniruddhv	52:0bd68655c651	20	uint8_t received = 0;
aniruddhv	52:0bd68655c651	21	uint16_t mid1;
aniruddhv	52:0bd68655c651	22	uint16_t mid2;
aniruddhv	52:0bd68655c651	23	uint16_t Nbytes;
aniruddhv	52:0bd68655c651	24	uint32_t Data[2];
aniruddhv	52:0bd68655c651	25	uint16_t nbytes;
aniruddhv	52:0bd68655c651	26	uint8_t flash_counter = 0;
aniruddhv	52:0bd68655c651	27	uint16_t crc16;
aniruddhv	52:0bd68655c651	28	uint16_t mid;
aniruddhv	52:0bd68655c651	29	uint32_t block;
aniruddhv	52:0bd68655c651	30
ee12b079	210:f4acf895b598	31	uint8_t ACK_CODE;
ee12b079	210:f4acf895b598	32
ee12b079	210:f4acf895b598	33	void TM_PMS_PL_SCHEDULE(Base_tm* tm_pointer1,uint8_t psc);
chaithanyarss	261:1e54415b34d3	34	void ACK_L234(Base_tm* tm_pointer_short1,uint8_t ackCode,uint8_t psc);
ee12b079	210:f4acf895b598	35
shreeshas95	0:f016e9e8d48b	36	#define delete_TC(tc_ptr) {\
shreeshas95	0:f016e9e8d48b	37	if(tc_ptr == gHEAD_NODE_TCL){\
shreeshas95	0:f016e9e8d48b	38	gHEAD_NODE_TCL = tc_ptr->next_TC;\
shreeshas95	0:f016e9e8d48b	39	}\
shreeshas95	0:f016e9e8d48b	40	delete tc_ptr;\
shreeshas95	0:f016e9e8d48b	41	}
shreeshas95	0:f016e9e8d48b	42
shreeshas95	0:f016e9e8d48b	43	// typeof tm_ptr: Base_tm
shreeshas95	0:f016e9e8d48b	44	// typeof tc_ptr: Base_tc
shreeshas95	0:f016e9e8d48b	45	// typeof temp_xxxx: uint8_t
krishanprajapat	122:b99f8be0a51a	46
shreeshas95	0:f016e9e8d48b	47
krishanprajapat	122:b99f8be0a51a	48
shreeshas95	0:f016e9e8d48b	49
aniruddhv	262:752c8689944a	50	#define detect_ack(tm_ptr, temp_ack) {\
shreeshas95	5:ab276a17ca07	51	if( tm_ptr != NULL ){\
aniruddhv	14:08c2c887ea09	52	int length = TM_SHORT_SIZE;\
shreeshas95	102:80c911a6e736	53	if( GETshort_or_long_tm(tm_ptr) == SHORT_TM_CODE ){\
aniruddhv	14:08c2c887ea09	54	length = TM_SHORT_SIZE;\
aniruddhv	14:08c2c887ea09	55	}\
aniruddhv	14:08c2c887ea09	56	else{\
aniruddhv	14:08c2c887ea09	57	length = TM_LONG_SIZE;\
aniruddhv	14:08c2c887ea09	58	}\
aniruddhv	14:08c2c887ea09	59	uint16_t crc = crc16_gen(tm_ptr->TM_string, length-2);\
shreeshas95	5:ab276a17ca07	60	if( (((crc & 0xFF00) >> 8) == tm_ptr->TM_string[length-2]) && ( (crc & 0x00FF) == tm_ptr->TM_string[length-1] ) ){\
shreeshas95	4:104dd82c99b8	61	uint8_t temp8;\
shreeshas95	4:104dd82c99b8	62	temp8 = tm_ptr->TM_string[TM_ACK_CODE_INDEX];\
shreeshas95	4:104dd82c99b8	63	temp8 = temp8 & 0xE0;\
shreeshas95	4:104dd82c99b8	64	if( (temp8 == 0xC0) \|\| (temp8 == 0xA0) )\
shreeshas95	4:104dd82c99b8	65	temp_ack = 0x01;\
shreeshas95	4:104dd82c99b8	66	else{\
aniruddhv	262:752c8689944a	67	temp_ack = 0x02;\
shreeshas95	4:104dd82c99b8	68	/CHECK FOR NACK CODE: CRC FAIL NACK/\
shreeshas95	4:104dd82c99b8	69	temp8 = tm_ptr->TM_string[TM_ACK_CODE_INDEX];\
shreeshas95	4:104dd82c99b8	70	temp8 = temp8 & 0x0F;\
shreeshas95	5:ab276a17ca07	71	if( temp8 == CRC_FAIL_NACK_CODE ){\
aniruddhv	262:752c8689944a	72	temp_ack = 0x04;\
shreeshas95	4:104dd82c99b8	73	}\
shreeshas95	4:104dd82c99b8	74	}\
shreeshas95	4:104dd82c99b8	75	}\
shreeshas95	0:f016e9e8d48b	76	else\
aniruddhv	262:752c8689944a	77	temp_ack = 0x03;\
shreeshas95	0:f016e9e8d48b	78	}\
shreeshas95	4:104dd82c99b8	79	else{\
aniruddhv	262:752c8689944a	80	temp_ack = 0x02;\
shreeshas95	4:104dd82c99b8	81	}\
shreeshas95	0:f016e9e8d48b	82	}
shreeshas95	0:f016e9e8d48b	83
shreeshas95	0:f016e9e8d48b	84	#define isit_obosc(tc_ptr, temp_obosc) {\
shreeshas95	0:f016e9e8d48b	85	temp_obosc = 0x00;\
aniruddhv	52:0bd68655c651	86	if( GETapid(tc_ptr) == APID_COM ){\
aniruddhv	52:0bd68655c651	87	if( ((tc_ptr->TC_string[2]) >> 4) == SERVICE_OBOSC ){\
aniruddhv	52:0bd68655c651	88	temp_obosc = 0x01;\
shreeshas95	0:f016e9e8d48b	89	}\
shreeshas95	0:f016e9e8d48b	90	}\
shreeshas95	0:f016e9e8d48b	91	}
shreeshas95	0:f016e9e8d48b	92
shreeshas95	0:f016e9e8d48b	93	#define isit_sdcard(tc_ptr, temp_sdcard) {\
shreeshas95	0:f016e9e8d48b	94	temp_sdcard = 0x00;\
aniruddhv	52:0bd68655c651	95	if( GETapid(tc_ptr) == APID_COM ){\
aniruddhv	52:0bd68655c651	96	if( ( (tc_ptr->TC_string[2]) >> 4) == SERVICE_OBSRS ){\
aniruddhv	52:0bd68655c651	97	temp_sdcard = 0x01;\
shreeshas95	0:f016e9e8d48b	98	}\
shreeshas95	0:f016e9e8d48b	99	}\
shreeshas95	0:f016e9e8d48b	100	}
shreeshas95	0:f016e9e8d48b	101
krishanprajapat	122:b99f8be0a51a	102
shreeshas95	2:2caf2a9a13aa	103
shreeshas95	2:2caf2a9a13aa	104	void after_cooling_pa(){
shreeshas95	2:2caf2a9a13aa	105	gCOM_MNG_TMTC_THREAD->signal_set(COM_MNG_TMTC_SIGNAL_UART_INT);
shreeshas95	2:2caf2a9a13aa	106	}
shreeshas95	2:2caf2a9a13aa	107
shreeshas95	0:f016e9e8d48b	108	/*
shreeshas95	0:f016e9e8d48b	109	@brief: check for missing tc, also check crc, i.e.
shreeshas95	0:f016e9e8d48b	110	if true execution can be started else have to wait
shreeshas95	0:f016e9e8d48b	111	decide the next state
shreeshas95	0:f016e9e8d48b	112	@param: none
shreeshas95	0:f016e9e8d48b	113	@return: bool indicating whether there are missing tc
shreeshas95	0:f016e9e8d48b	114	*/
shreeshas95	0:f016e9e8d48b	115	// PENDING: LAST FRAME BIT
shreeshas95	0:f016e9e8d48b	116	/*
shreeshas95	0:f016e9e8d48b	117	for loop: check for missing tc
shreeshas95	0:f016e9e8d48b	118	if: check for incorrect sized tc
shreeshas95	0:f016e9e8d48b	119	if: check for last frame bit
shreeshas95	0:f016e9e8d48b	120	*/
shreeshas95	0:f016e9e8d48b	121	#define continueToExecute(returnHere) {\
shreeshas95	0:f016e9e8d48b	122	uint8_t tempReturn = 0x00;\
shreeshas95	5:ab276a17ca07	123	/search for missing psc/\
shreeshas95	15:1c1ca992b43b	124	for(uint8_t p = 0x00 ; p < (gTOTAL_VALID_TC) ; ++p){\
shreeshas95	0:f016e9e8d48b	125	bool flag = false;\
shreeshas95	0:f016e9e8d48b	126	Base_tc *node_ptr = gHEAD_NODE_TCL;\
shreeshas95	0:f016e9e8d48b	127	while(node_ptr != NULL){\
shreeshas95	0:f016e9e8d48b	128	if( (GETpacket_seq_count(node_ptr) == p) && (GETcrc_pass(node_ptr) == 1) ){\
shreeshas95	0:f016e9e8d48b	129	flag = true;\
shreeshas95	0:f016e9e8d48b	130	break;\
shreeshas95	0:f016e9e8d48b	131	}\
shreeshas95	0:f016e9e8d48b	132	else{\
shreeshas95	0:f016e9e8d48b	133	node_ptr = node_ptr->next_TC;\
shreeshas95	0:f016e9e8d48b	134	}\
shreeshas95	0:f016e9e8d48b	135	}\
shreeshas95	0:f016e9e8d48b	136	if(flag == false){\
shreeshas95	0:f016e9e8d48b	137	tempReturn = 0x02;\
shreeshas95	0:f016e9e8d48b	138	break;\
shreeshas95	0:f016e9e8d48b	139	}\
shreeshas95	0:f016e9e8d48b	140	}\
shreeshas95	5:ab276a17ca07	141	/search for last packet bit/\
shreeshas95	5:ab276a17ca07	142	tempReturn = tempReturn + 0x01;\
shreeshas95	0:f016e9e8d48b	143	Base_tc *tcp = gHEAD_NODE_TCL;\
shreeshas95	0:f016e9e8d48b	144	while(tcp != NULL){\
rohit3342	16:538de1b20b3a	145	if(GETpacket_seq_count(tcp) == (gTOTAL_VALID_TC - 1)){\
shreeshas95	5:ab276a17ca07	146	if( ( (tcp->TC_string[1]) & 0x20 ) == 0x20 ){\
shreeshas95	5:ab276a17ca07	147	tempReturn = tempReturn - 0x01;\
shreeshas95	0:f016e9e8d48b	148	}\
shreeshas95	0:f016e9e8d48b	149	break;\
shreeshas95	0:f016e9e8d48b	150	}\
shreeshas95	0:f016e9e8d48b	151	tcp = tcp->next_TC;\
shreeshas95	0:f016e9e8d48b	152	}\
shreeshas95	0:f016e9e8d48b	153	returnHere = tempReturn;\
shreeshas95	5:ab276a17ca07	154	/UPDATE gMASTER STATE/\
shreeshas95	5:ab276a17ca07	155	if( (returnHere == 0x00) ){\
aniruddhv	37:c9a739750806	156	if( (gMASTER_STATE == TCL_STATE_INCOMPLETE) \|\| (gMASTER_STATE == TCL_STATE_COMPLETED) \|\| (gMASTER_STATE == TCL_STATE_ABORTED) ){\
aniruddhv	37:c9a739750806	157	gMASTER_STATE = TCL_STATE_EXECUTING;\
shreeshas95	5:ab276a17ca07	158	}\
shreeshas95	5:ab276a17ca07	159	}\
shreeshas95	5:ab276a17ca07	160	else{\
ee12b079	210:f4acf895b598	161	if( (gMASTER_STATE == TCL_STATE_INCOMPLETE) \|\| (gMASTER_STATE == TCL_STATE_COMPLETED) \|\| (gMASTER_STATE == TCL_STATE_ABORTED) ){\
shreeshas95	5:ab276a17ca07	162	gMASTER_STATE = TCL_STATE_INCOMPLETE;\
shreeshas95	5:ab276a17ca07	163	}\
shreeshas95	5:ab276a17ca07	164	}\
shreeshas95	0:f016e9e8d48b	165	}
shreeshas95	0:f016e9e8d48b	166
shreeshas95	0:f016e9e8d48b	167	/*
shreeshas95	2:2caf2a9a13aa	168	return 1 if code match
shreeshas95	2:2caf2a9a13aa	169	return 0 if code mismatch
shreeshas95	2:2caf2a9a13aa	170	*/
shreeshas95	2:2caf2a9a13aa	171	#define GScodeVerification(returnHere){\
shreeshas95	2:2caf2a9a13aa	172	Base_tc *testTC = gHEAD_NODE_TCL;\
shreeshas95	2:2caf2a9a13aa	173	uint16_t overflowCount = 0;\
shreeshas95	15:1c1ca992b43b	174	returnHere = 0xFF;\
shreeshas95	2:2caf2a9a13aa	175	while( (overflowCount < TCL_OVERFLOW_CONSTANT) && (testTC != NULL) ){\
shreeshas95	2:2caf2a9a13aa	176	if( (GETpacket_seq_count(testTC) == PSC_CALLSIGN) && (GETapid(testTC) == APID_CALLSIGN) ){\
aniruddhv	37:c9a739750806	177	/uint8_t temp8 = testTC->TC_string[1];/\
aniruddhv	37:c9a739750806	178	if( true ){\
shreeshas95	2:2caf2a9a13aa	179	for( int i = 2 ; i <= 8 ; ++i ){\
shreeshas95	2:2caf2a9a13aa	180	if( testTC->TC_string[i] != gGSCODE[i-2] ){\
shreeshas95	2:2caf2a9a13aa	181	returnHere = 0;\
shreeshas95	2:2caf2a9a13aa	182	break;\
shreeshas95	2:2caf2a9a13aa	183	}\
shreeshas95	2:2caf2a9a13aa	184	}\
shreeshas95	2:2caf2a9a13aa	185	}\
shreeshas95	2:2caf2a9a13aa	186	break;\
shreeshas95	2:2caf2a9a13aa	187	}\
shreeshas95	2:2caf2a9a13aa	188	testTC = testTC->next_TC;\
shreeshas95	2:2caf2a9a13aa	189	++overflowCount;\
shreeshas95	2:2caf2a9a13aa	190	}\
shreeshas95	2:2caf2a9a13aa	191	}
shreeshas95	2:2caf2a9a13aa	192
shreeshas95	2:2caf2a9a13aa	193	/*
shreeshas95	0:f016e9e8d48b	194	@brief: DELETE THE CRC FAILED TC FROM THE LIST TO FREE-UP MEMORY AND UPDATE
shreeshas95	0:f016e9e8d48b	195	THE TOTAL VALID TC AND GENERATE L1_ACK_TM
shreeshas95	0:f016e9e8d48b	196	@param: none
shreeshas95	0:f016e9e8d48b	197	@return: none
shreeshas95	0:f016e9e8d48b	198	*/
shreeshas95	4:104dd82c99b8	199	/tm_ptr is the next_TM of a linked list, and should have the value NULL, i.e. tm_ptr should be the next_TM pointer of thte last node /
shreeshas95	4:104dd82c99b8	200
shreeshas95	4:104dd82c99b8	201	/tm_ptr is the next_TM of a linked list, and should have the value NULL, i.e. tm_ptr should be the next_TM pointer of thte last node /
shreeshas95	0:f016e9e8d48b	202
shreeshas95	0:f016e9e8d48b	203	// CDMS TEAM CODE START
chaithanyarss	261:1e54415b34d3	204	void ACK_L234(Base_tm* tm_pointer_short1,uint8_t ackCode,uint8_t psc)
ee12b079	210:f4acf895b598	205	{
chaithanyarss	261:1e54415b34d3	206	tm_pointer_short1->TM_string[0] = 0xB0;
chaithanyarss	261:1e54415b34d3	207	tm_pointer_short1->TM_string[1] = psc;
chaithanyarss	261:1e54415b34d3	208	tm_pointer_short1->TM_string[2] = ackCode;
chaithanyarss	261:1e54415b34d3	209	tm_pointer_short1->TM_string[3] = 0x00;
chaithanyarss	261:1e54415b34d3	210	tm_pointer_short1->TM_string[4] = 0x00;
ee12b079	210:f4acf895b598	211	for(uint8_t i=0;i<6;i++)
chaithanyarss	261:1e54415b34d3	212	tm_pointer_short1->TM_string[i+5] = 0;
chaithanyarss	261:1e54415b34d3	213	crc16 = crc16_gen(tm_pointer_short1->TM_string,11);
chaithanyarss	261:1e54415b34d3	214	tm_pointer_short1->TM_string[11] = (uint8_t)((crc16&0xFF00)>>8);
chaithanyarss	261:1e54415b34d3	215	tm_pointer_short1->TM_string[12] = (uint8_t)(crc16&0x00FF);
chaithanyarss	261:1e54415b34d3	216	tm_pointer_short1->next_TM = NULL;
ee12b079	210:f4acf895b598	217	}
ee12b079	210:f4acf895b598	218	void TM_PMS_PL_SCHEDULE(Base_tm *tm_pointer1,uint8_t psc)
ee12b079	210:f4acf895b598	219	{
ee12b079	210:f4acf895b598	220	Base_tm *tm_pointer2 = NULL;
ee12b079	210:f4acf895b598	221	if(!(tm_pointer2 = new Long_tm))
ee12b079	210:f4acf895b598	222	{
ee12b079	210:f4acf895b598	223	gPC.printf("\n\rError: out of memory");
ee12b079	210:f4acf895b598	224	return;
ee12b079	210:f4acf895b598	225	}
ee12b079	210:f4acf895b598	226	Base_tm *tm_pointer3 = NULL;
ee12b079	210:f4acf895b598	227	if(!(tm_pointer3 = new Long_tm))
ee12b079	210:f4acf895b598	228	{
ee12b079	210:f4acf895b598	229	gPC.printf("\n\rError: out of memory");
ee12b079	210:f4acf895b598	230	return;
ee12b079	210:f4acf895b598	231	}
ee12b079	210:f4acf895b598	232	Base_tm *tm_pointer4 = NULL;
ee12b079	210:f4acf895b598	233	if(!(tm_pointer4 = new Long_tm))
ee12b079	210:f4acf895b598	234	{
ee12b079	210:f4acf895b598	235	gPC.printf("\n\rError: out of memory");
ee12b079	210:f4acf895b598	236	return;
ee12b079	210:f4acf895b598	237	}
ee12b079	210:f4acf895b598	238	Base_tm *tm_pointer5 = NULL;
ee12b079	210:f4acf895b598	239	if(!(tm_pointer5 = new Long_tm))
ee12b079	210:f4acf895b598	240	{
ee12b079	210:f4acf895b598	241	gPC.printf("\n\rError: out of memory");
ee12b079	210:f4acf895b598	242	return;
ee12b079	210:f4acf895b598	243	}
ee12b079	210:f4acf895b598	244	Base_tm *tm_pointer6 = NULL;
ee12b079	210:f4acf895b598	245	if(!(tm_pointer6 = new Long_tm))
ee12b079	210:f4acf895b598	246	{
ee12b079	210:f4acf895b598	247	gPC.printf("\n\rError: out of memory");
ee12b079	210:f4acf895b598	248	return;
ee12b079	210:f4acf895b598	249	}
ee12b079	210:f4acf895b598	250	tm_pointer1->TM_string[0] = 0x48;
ee12b079	210:f4acf895b598	251	tm_pointer1->TM_string[1] = psc;
ee12b079	210:f4acf895b598	252	tm_pointer1->TM_string[2] = 0xA0;
ee12b079	210:f4acf895b598	253	tm_pointer1->TM_string[3] = 0x01;
ee12b079	210:f4acf895b598	254	for(uint8_t i=0;i<128;i+=4)
ee12b079	210:f4acf895b598	255	{
ee12b079	210:f4acf895b598	256	tm_pointer1->TM_string[i+4] = (uint8_t)((pl_block[i/4] & 0xFF000000)>>24);
ee12b079	210:f4acf895b598	257	tm_pointer1->TM_string[i+5] = (uint8_t)((pl_block[i/4] & 0x00FF0000)>>16);
ee12b079	210:f4acf895b598	258	tm_pointer1->TM_string[i+6] = (uint8_t)((pl_block[i/4] & 0x0000FF00)>>8);
ee12b079	210:f4acf895b598	259	tm_pointer1->TM_string[i+7] = (uint8_t)((pl_block[i/4] & 0x000000FF));
ee12b079	210:f4acf895b598	260	}
ee12b079	210:f4acf895b598	261	crc16 = crc16_gen(tm_pointer1->TM_string,132);
ee12b079	210:f4acf895b598	262	tm_pointer1->TM_string[132] = (uint8_t)((crc16&0xFF00)>>8);
ee12b079	210:f4acf895b598	263	tm_pointer1->TM_string[133] = (uint8_t)(crc16&0x00FF);
ee12b079	210:f4acf895b598	264	tm_pointer1->next_TM = tm_pointer2;
ee12b079	210:f4acf895b598	265
ee12b079	210:f4acf895b598	266	tm_pointer2->TM_string[0] = 0x48;
ee12b079	210:f4acf895b598	267	tm_pointer2->TM_string[1] = psc;
ee12b079	210:f4acf895b598	268	tm_pointer2->TM_string[2] = 0xA0;
ee12b079	210:f4acf895b598	269	tm_pointer2->TM_string[3] = 0x02;
ee12b079	210:f4acf895b598	270	for(uint8_t i=0;i<128;i+=4)
ee12b079	210:f4acf895b598	271	{
ee12b079	210:f4acf895b598	272	tm_pointer2->TM_string[i+4] = (uint8_t)((pl_block[(i/4)+32] & 0xFF000000)>>24);
ee12b079	210:f4acf895b598	273	tm_pointer2->TM_string[i+5] = (uint8_t)((pl_block[(i/4)+32] & 0x00FF0000)>>16);
ee12b079	210:f4acf895b598	274	tm_pointer2->TM_string[i+6] = (uint8_t)((pl_block[(i/4)+32] & 0x0000FF00)>>8);
ee12b079	210:f4acf895b598	275	tm_pointer2->TM_string[i+7] = (uint8_t)((pl_block[(i/4)+32] & 0x000000FF));
ee12b079	210:f4acf895b598	276	}
ee12b079	210:f4acf895b598	277	crc16 = crc16_gen(tm_pointer2->TM_string,132);
ee12b079	210:f4acf895b598	278	tm_pointer2->TM_string[132] = (uint8_t)((crc16&0xFF00)>>8);
ee12b079	210:f4acf895b598	279	tm_pointer2->TM_string[133] = (uint8_t)(crc16&0x00FF);
ee12b079	210:f4acf895b598	280	tm_pointer2->next_TM = tm_pointer3;
ee12b079	210:f4acf895b598	281
ee12b079	210:f4acf895b598	282	tm_pointer3->TM_string[0] = 0x48;
ee12b079	210:f4acf895b598	283	tm_pointer3->TM_string[1] = psc;
ee12b079	210:f4acf895b598	284	tm_pointer3->TM_string[2] = 0xA0;
ee12b079	210:f4acf895b598	285	tm_pointer3->TM_string[3] = 0x03;
ee12b079	210:f4acf895b598	286	for(uint8_t i=0;i<128;i+=4)
ee12b079	210:f4acf895b598	287	{
ee12b079	210:f4acf895b598	288	tm_pointer3->TM_string[i+4] = (uint8_t)((pl_block[(i/4)+64] & 0xFF000000)>>24);
ee12b079	210:f4acf895b598	289	tm_pointer3->TM_string[i+5] = (uint8_t)((pl_block[(i/4)+64] & 0x00FF0000)>>16);
ee12b079	210:f4acf895b598	290	tm_pointer3->TM_string[i+6] = (uint8_t)((pl_block[(i/4)+64] & 0x0000FF00)>>8);
ee12b079	210:f4acf895b598	291	tm_pointer3->TM_string[i+7] = (uint8_t)((pl_block[(i/4)+64] & 0x000000FF));
ee12b079	210:f4acf895b598	292	}
ee12b079	210:f4acf895b598	293	crc16 = crc16_gen(tm_pointer3->TM_string,132);
ee12b079	210:f4acf895b598	294	tm_pointer3->TM_string[132] = (uint8_t)((crc16&0xFF00)>>8);
ee12b079	210:f4acf895b598	295	tm_pointer3->TM_string[133] = (uint8_t)(crc16&0x00FF);
ee12b079	210:f4acf895b598	296	tm_pointer3->next_TM = tm_pointer4;
ee12b079	210:f4acf895b598	297
ee12b079	210:f4acf895b598	298	tm_pointer4->TM_string[0] = 0x48;
ee12b079	210:f4acf895b598	299	tm_pointer4->TM_string[1] = psc;
ee12b079	210:f4acf895b598	300	tm_pointer4->TM_string[2] = 0xA0;
ee12b079	210:f4acf895b598	301	tm_pointer4->TM_string[3] = 0x04;
ee12b079	210:f4acf895b598	302	for(uint8_t i=0;i<128;i+=4)
ee12b079	210:f4acf895b598	303	{
ee12b079	210:f4acf895b598	304	tm_pointer4->TM_string[i+4] = (uint8_t)((pl_block[(i/4)+96] & 0xFF000000)>>24);
ee12b079	210:f4acf895b598	305	tm_pointer4->TM_string[i+5] = (uint8_t)((pl_block[(i/4)+96] & 0x00FF0000)>>16);
ee12b079	210:f4acf895b598	306	tm_pointer4->TM_string[i+6] = (uint8_t)((pl_block[(i/4)+96] & 0x0000FF00)>>8);
ee12b079	210:f4acf895b598	307	tm_pointer4->TM_string[i+7] = (uint8_t)((pl_block[(i/4)+96] & 0x000000FF));
ee12b079	210:f4acf895b598	308	}
ee12b079	210:f4acf895b598	309	crc16 = crc16_gen(tm_pointer4->TM_string,132);
ee12b079	210:f4acf895b598	310	tm_pointer4->TM_string[132] = (uint8_t)((crc16&0xFF00)>>8);
ee12b079	210:f4acf895b598	311	tm_pointer4->TM_string[133] = (uint8_t)(crc16&0x00FF);
ee12b079	210:f4acf895b598	312	tm_pointer4->next_TM = tm_pointer5;
ee12b079	210:f4acf895b598	313
ee12b079	210:f4acf895b598	314	tm_pointer5->TM_string[0] = 0x48;
ee12b079	210:f4acf895b598	315	tm_pointer5->TM_string[1] = psc;
ee12b079	210:f4acf895b598	316	tm_pointer5->TM_string[2] = 0xA0;
ee12b079	210:f4acf895b598	317	tm_pointer5->TM_string[3] = 0x05;
ee12b079	210:f4acf895b598	318	for(uint8_t i=0;i<128;i+=4)
ee12b079	210:f4acf895b598	319	{
ee12b079	210:f4acf895b598	320	tm_pointer5->TM_string[i+4] = (uint8_t)((pl_block[(i/4)+128] & 0xFF000000)>>24);
ee12b079	210:f4acf895b598	321	tm_pointer5->TM_string[i+5] = (uint8_t)((pl_block[(i/4)+128] & 0x00FF0000)>>16);
ee12b079	210:f4acf895b598	322	tm_pointer5->TM_string[i+6] = (uint8_t)((pl_block[(i/4)+128] & 0x0000FF00)>>8);
ee12b079	210:f4acf895b598	323	tm_pointer5->TM_string[i+7] = (uint8_t)((pl_block[(i/4)+128] & 0x000000FF));
ee12b079	210:f4acf895b598	324	}
ee12b079	210:f4acf895b598	325	crc16 = crc16_gen(tm_pointer5->TM_string,132);
ee12b079	210:f4acf895b598	326	tm_pointer5->TM_string[132] = (uint8_t)((crc16&0xFF00)>>8);
ee12b079	210:f4acf895b598	327	tm_pointer5->TM_string[133] = (uint8_t)(crc16&0x00FF);
ee12b079	210:f4acf895b598	328	tm_pointer5->next_TM = tm_pointer6;
ee12b079	210:f4acf895b598	329
ee12b079	210:f4acf895b598	330	tm_pointer6->TM_string[0] = 0x48;
ee12b079	210:f4acf895b598	331	tm_pointer6->TM_string[1] = psc;
ee12b079	210:f4acf895b598	332	tm_pointer6->TM_string[2] = 0xA0;
ee12b079	210:f4acf895b598	333	tm_pointer6->TM_string[3] = 0x06;
ee12b079	210:f4acf895b598	334	for(uint8_t i=0;i<128;i+=4)
ee12b079	210:f4acf895b598	335	{
ee12b079	210:f4acf895b598	336	tm_pointer6->TM_string[i+4] = (uint8_t)((pl_block[(i/4)+160] & 0xFF000000)>>24);
ee12b079	210:f4acf895b598	337	tm_pointer6->TM_string[i+5] = (uint8_t)((pl_block[(i/4)+160] & 0x00FF0000)>>16);
ee12b079	210:f4acf895b598	338	tm_pointer6->TM_string[i+6] = (uint8_t)((pl_block[(i/4)+160] & 0x0000FF00)>>8);
ee12b079	210:f4acf895b598	339	tm_pointer6->TM_string[i+7] = (uint8_t)((pl_block[(i/4)+160] & 0x000000FF));
ee12b079	210:f4acf895b598	340	}
ee12b079	210:f4acf895b598	341	crc16 = crc16_gen(tm_pointer6->TM_string,132);
ee12b079	210:f4acf895b598	342	tm_pointer6->TM_string[132] = (uint8_t)((crc16&0xFF00)>>8);
ee12b079	210:f4acf895b598	343	tm_pointer6->TM_string[133] = (uint8_t)(crc16&0x00FF);
ee12b079	210:f4acf895b598	344	tm_pointer6->next_TM = NULL;
ee12b079	210:f4acf895b598	345	}
ee12b079	210:f4acf895b598	346	Base_tm* FCTN_CDMS_RLY_TMTC(Base_tc *tc_ptr)
ee12b079	210:f4acf895b598	347	{
ee12b079	210:f4acf895b598	348	//uint8_t ACKCODE = 0xB0;
ee12b079	210:f4acf895b598	349	bool y;
ee12b079	210:f4acf895b598	350	//gPC.printf("\rTC execution in progress\r\n");
chaithanyarss	261:1e54415b34d3	351	Base_tm *tm_pointer = new Long_tm;
aniruddhv	52:0bd68655c651	352	Base_tm *tm_ptr = tm_pointer;
chaithanyarss	261:1e54415b34d3	353	//Base_tm *tm_ptr = new Long_tm;
chaithanyarss	261:1e54415b34d3	354	Base_tm *tm_pointer_short = new Short_tm;
chaithanyarss	261:1e54415b34d3	355	Base_tm *tm_ptr_short = tm_pointer_short;
aniruddhv	52:0bd68655c651	356	received = 0;
ee12b079	210:f4acf895b598	357	switch(GETapid(tc_ptr)) //checking APID's
aniruddhv	52:0bd68655c651	358	{
aniruddhv	52:0bd68655c651	359	case 1: //apid=01 implies it corresponds to bae
aniruddhv	52:0bd68655c651	360	{
ee12b079	210:f4acf895b598	361	BAE_I2C_mutex.lock();
chaithanyarss	261:1e54415b34d3	362	//BAE_TC;
ee12b079	161:a63672bf4423	363	gPC.printf("Telecommand is for BAE\r\n");
ee12b079	210:f4acf895b598	364	gPC.printf("Sending TC to BAE...\r\n"); //interrupt to be sent to the bae
ee12b079	210:f4acf895b598	365	y = FCTN_I2C_WRITE((char*)tc_ptr->TC_string,TC_LONG_SIZE); // Check for SHORT and LONG TC and then send
ee12b079	210:f4acf895b598	366
ee12b079	210:f4acf895b598	367	if(y==1)
aniruddhv	264:f7d8f9f361e3	368	{
aniruddhv	264:f7d8f9f361e3	369	gPC.printf("BAE write fail\r\n");
chaithanyarss	261:1e54415b34d3	370	ACK_L234(tm_ptr_short,0x03,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	371	return tm_ptr_short;
ee12b079	210:f4acf895b598	372	}
ee12b079	210:f4acf895b598	373	else if(y==0)
aniruddhv	52:0bd68655c651	374	{
aniruddhv	264:f7d8f9f361e3	375	gPC.printf("BAE write succe\r\n");
ee12b079	210:f4acf895b598	376	//wait(0.2);
aniruddhv	264:f7d8f9f361e3	377	int poll=0;
aniruddhv	264:f7d8f9f361e3	378	while(poll<9000 && BAE_I2C_GPIO==0)
aniruddhv	52:0bd68655c651	379	{
aniruddhv	264:f7d8f9f361e3	380	wait_us(10);
ee12b079	210:f4acf895b598	381	poll+=1;
aniruddhv	264:f7d8f9f361e3	382	}
aniruddhv	264:f7d8f9f361e3	383	//while(BAE_I2C_GPIO==0){}
ee12b079	210:f4acf895b598	384	if(BAE_I2C_GPIO == 1) //name to be changed later
ee12b079	210:f4acf895b598	385	{
ee12b079	210:f4acf895b598	386	gPC.printf("BAE_I2C_GPIO is high\r\n");
ee12b079	162:48fda0b8d573	387
ee12b079	210:f4acf895b598	388	y=FCTN_I2C_READ((char*)tm_pointer->TM_string,TM_LONG_SIZE); //rify later about the size
ee12b079	210:f4acf895b598	389	if(y==0)
ee12b079	210:f4acf895b598	390	{
aniruddhv	264:f7d8f9f361e3	391	gPC.printf("BAE read success\r\n");
ee12b079	210:f4acf895b598	392	tm_pointer->next_TM=NULL;
ee12b079	210:f4acf895b598	393	return tm_ptr;
ee12b079	210:f4acf895b598	394	}
ee12b079	210:f4acf895b598	395	else if(y==1)
ee12b079	198:17200a427e71	396	{
aniruddhv	264:f7d8f9f361e3	397	gPC.printf("BAE read fail\r\n");
chaithanyarss	261:1e54415b34d3	398	ACK_L234(tm_ptr_short,0x85,GETpacket_seq_count(tc_ptr));
ee12b079	210:f4acf895b598	399	//gPC.printf("\n\rPTE->PDIR = 0x%08X",PTE->PDIR);
chaithanyarss	261:1e54415b34d3	400	return tm_ptr_short;
ee12b079	210:f4acf895b598	401	break;
ee12b079	210:f4acf895b598	402	}
aniruddhv	52:0bd68655c651	403	}
ee12b079	210:f4acf895b598	404	else if(BAE_I2C_GPIO == 0) //name to be changed later
aniruddhv	52:0bd68655c651	405	{
ee12b079	210:f4acf895b598	406	gPC.printf("BAE_I2C_GPIO is not high\r\n");
chaithanyarss	261:1e54415b34d3	407	ACK_L234(tm_ptr_short,0x84,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	408	return tm_ptr_short;
aniruddhv	52:0bd68655c651	409	}
aniruddhv	52:0bd68655c651	410	}
ee12b079	210:f4acf895b598	411	BAE_I2C_mutex.unlock();
aniruddhv	52:0bd68655c651	412	}
ee12b079	210:f4acf895b598	413
ee12b079	210:f4acf895b598	414	case 2: // APID = 2 corresponds to CDMS
aniruddhv	52:0bd68655c651	415	{
ee12b079	88:b9beee1a7a3e	416	//gPC.printf("Telecommand is for CDMS\r\n"); //apid = 10 corresponds to cdms
aniruddhv	52:0bd68655c651	417	switch(GETservice_type(tc_ptr))
aniruddhv	52:0bd68655c651	418	{
chaithanyarss	258:7d404e9dc9e2	419	case 0x60: //service type = 0x6
aniruddhv	52:0bd68655c651	420	{
ee12b079	210:f4acf895b598	421	gPC.printf("service:MMS\r\n");
ee12b079	210:f4acf895b598	422	switch(GETservice_subtype(tc_ptr))
aniruddhv	52:0bd68655c651	423	{
ee12b079	210:f4acf895b598	424	case 0x2: //service subtye
ee12b079	210:f4acf895b598	425	{
ee12b079	210:f4acf895b598	426	//gPC.printf("sub_service:Read LONG_RAM_Memory\r\n");
ee12b079	210:f4acf895b598	427	mid=((uint16_t)(tc_ptr->TC_string[3]<<4))+((uint16_t)(tc_ptr->TC_string[4]));
ee12b079	210:f4acf895b598	428	if(mid!=0x0000 && mid!=0x0001)
ee12b079	210:f4acf895b598	429	{
chaithanyarss	261:1e54415b34d3	430	ACK_L234(tm_ptr_short,0x02,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	431	return tm_ptr_short;
ee12b079	210:f4acf895b598	432	}
ee12b079	210:f4acf895b598	433
ee12b079	210:f4acf895b598	434	tm_pointer->TM_string[0] = 0x30;
ee12b079	210:f4acf895b598	435	tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
ee12b079	210:f4acf895b598	436	tm_pointer->TM_string[2] = 0xA0;
ee12b079	210:f4acf895b598	437	tm_pointer->TM_string[3] = 0x00; //spare bits
chaithanyarss	258:7d404e9dc9e2	438	FCTN_CDMS_RD_L_RAM(tm_pointer);
ee12b079	210:f4acf895b598	439	crc16 = crc16_gen(tm_ptr->TM_string,132);
chaithanyarss	258:7d404e9dc9e2	440	tm_pointer->TM_string[132] = (uint8_t)((crc16&0xFF00)>>8);
chaithanyarss	258:7d404e9dc9e2	441	tm_pointer->TM_string[133] = (uint8_t)(crc16&0x00FF);
ee12b079	210:f4acf895b598	442	tm_pointer->next_TM = NULL;
ee12b079	210:f4acf895b598	443	return tm_ptr;
ee12b079	210:f4acf895b598	444	}
ee12b079	210:f4acf895b598	445	case 0x5: // change the cases appropriately
ee12b079	210:f4acf895b598	446	{
ee12b079	210:f4acf895b598	447	//gPC.printf("WRITE ON SHORT_FLASH_MEMORY\r\n");
ee12b079	210:f4acf895b598	448	mid=(uint16_t)(tc_ptr->TC_string[3]<<4)+(uint16_t)(tc_ptr->TC_string[4]);
ee12b079	210:f4acf895b598	449	//32 bits at a time
ee12b079	210:f4acf895b598	450
chaithanyarss	261:1e54415b34d3	451	if(mid == 0x0101 \|\| mid==0x0102 \|\| mid == 0x0103 \|\| mid == 0x0100) //allowable MID values?
ee12b079	210:f4acf895b598	452	{
chaithanyarss	261:1e54415b34d3	453	ACK_L234(tm_ptr_short,0x02,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	454	return tm_ptr_short;
ee12b079	210:f4acf895b598	455	}
chaithanyarss	261:1e54415b34d3	456
chaithanyarss	261:1e54415b34d3	457	FCTN_CDMS_WR_S_FLASH(mid,(uint32_t)(tc_ptr->TC_string[5]<<24)+(uint32_t)(tc_ptr->TC_string[6]<<16)+(uint32_t)(tc_ptr->TC_string[7]<<8)+(uint32_t)(tc_ptr->TC_string[8]));
ee12b079	210:f4acf895b598	458
chaithanyarss	261:1e54415b34d3	459	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
ee12b079	210:f4acf895b598	460
chaithanyarss	261:1e54415b34d3	461	return tm_ptr_short;
ee12b079	210:f4acf895b598	462	}
chaithanyarss	261:1e54415b34d3	463	case 0x6: //service subtye = WR_L_FLASH
ee12b079	210:f4acf895b598	464	{
chaithanyarss	261:1e54415b34d3	465	mid=((uint16_t)(tc_ptr->TC_string[3]<<8))+((uint16_t)(tc_ptr->TC_string[4]));
chaithanyarss	261:1e54415b34d3	466	if(mid == 0x0002)
chaithanyarss	261:1e54415b34d3	467	{
chaithanyarss	261:1e54415b34d3	468	for(uint8_t z=0;z<24;z++)
chaithanyarss	261:1e54415b34d3	469	scp_threshold_m0[z] = tc_ptr->TC_string[z+5];
chaithanyarss	261:1e54415b34d3	470	for(uint8_t z=24;z<32;z++)
chaithanyarss	261:1e54415b34d3	471	scp_threshold_m0[z+8] = tc_ptr->TC_string[z+5];
chaithanyarss	261:1e54415b34d3	472	//int strt_add = flash_size() - (11*SECTOR_SIZE);
chaithanyarss	261:1e54415b34d3	473	//uint32_t flasharray[32] = {0};
chaithanyarss	261:1e54415b34d3	474	for(uint8_t z=0;z<24;z++)
chaithanyarss	261:1e54415b34d3	475	flasharray_thres[z] = scp_threshold_m0[z];
chaithanyarss	261:1e54415b34d3	476	for(uint8_t z=24;z<32;z++)
chaithanyarss	261:1e54415b34d3	477	flasharray_thres[z] = scp_threshold_m0[z+8];
chaithanyarss	261:1e54415b34d3	478	erase_sector(strt_add_thres);
chaithanyarss	261:1e54415b34d3	479	program_flash(strt_add_thres, (char*)flasharray_thres,32);
chaithanyarss	261:1e54415b34d3	480	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	481	return tm_ptr_short;
chaithanyarss	261:1e54415b34d3	482	}
chaithanyarss	261:1e54415b34d3	483	else if(mid == 0x0003)
chaithanyarss	261:1e54415b34d3	484	{
chaithanyarss	261:1e54415b34d3	485	for(uint8_t z=0;z<12;z++)
chaithanyarss	261:1e54415b34d3	486	scp_threshold_m0[z+40] = tc_ptr->TC_string[z+5];
chaithanyarss	261:1e54415b34d3	487	//int strt_add = flash_size() - (10*SECTOR_SIZE);
chaithanyarss	261:1e54415b34d3	488	//uint32_t flasharray[32] = {0};
chaithanyarss	261:1e54415b34d3	489	for(uint8_t z=0;z<12;z++)
chaithanyarss	261:1e54415b34d3	490	flasharray_thres[z] = scp_threshold_m0[z+40];
chaithanyarss	261:1e54415b34d3	491	erase_sector(strt_add_thres+SECTOR_SIZE);
chaithanyarss	261:1e54415b34d3	492	program_flash(strt_add_thres+SECTOR_SIZE, (char*)flasharray_thres,32);
chaithanyarss	261:1e54415b34d3	493	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	494	return tm_ptr_short;
chaithanyarss	261:1e54415b34d3	495	}
chaithanyarss	261:1e54415b34d3	496	else if(mid == 0x0004)
chaithanyarss	261:1e54415b34d3	497	{
chaithanyarss	261:1e54415b34d3	498	for(uint8_t z=0;z<32;z++)
chaithanyarss	261:1e54415b34d3	499	scp_threshold_m1[z] = tc_ptr->TC_string[z+5];
chaithanyarss	261:1e54415b34d3	500	//int strt_add = flash_size() - (9*SECTOR_SIZE);
chaithanyarss	261:1e54415b34d3	501	//uint32_t flasharray[32] = {0};
chaithanyarss	261:1e54415b34d3	502	for(uint8_t z=0;z<32;z++)
chaithanyarss	261:1e54415b34d3	503	flasharray_thres[z] = scp_threshold_m1[z];
chaithanyarss	261:1e54415b34d3	504	erase_sector(strt_add_thres+(2*SECTOR_SIZE));
chaithanyarss	261:1e54415b34d3	505	program_flash(strt_add_thres+(2SECTOR_SIZE), (char)flasharray_thres,32);
chaithanyarss	261:1e54415b34d3	506	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	507	return tm_ptr_short;
chaithanyarss	261:1e54415b34d3	508	}
chaithanyarss	261:1e54415b34d3	509	else if(mid == 0x0005)
chaithanyarss	261:1e54415b34d3	510	{
chaithanyarss	261:1e54415b34d3	511	for(uint8_t z=0;z<20;z++)
chaithanyarss	261:1e54415b34d3	512	scp_threshold_m1[z+32] = tc_ptr->TC_string[z+5];
chaithanyarss	261:1e54415b34d3	513	//int strt_add = flash_size() - (8*SECTOR_SIZE);
chaithanyarss	261:1e54415b34d3	514	//uint32_t flasharray[32] = {0};
chaithanyarss	261:1e54415b34d3	515	for(uint8_t z=0;z<20;z++)
chaithanyarss	261:1e54415b34d3	516	flasharray_thres[z] = scp_threshold_m1[z+32];
chaithanyarss	261:1e54415b34d3	517	erase_sector(strt_add_thres+(3*SECTOR_SIZE));
chaithanyarss	261:1e54415b34d3	518	program_flash(strt_add_thres+(3SECTOR_SIZE), (char)flasharray_thres,32);
chaithanyarss	261:1e54415b34d3	519	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	520	return tm_ptr_short;
chaithanyarss	261:1e54415b34d3	521	}
chaithanyarss	261:1e54415b34d3	522	else if(mid == 0x0006)
ee12b079	210:f4acf895b598	523	{
chaithanyarss	261:1e54415b34d3	524	scp_threshold_m0_1[7] = tc_ptr->TC_string[5];
chaithanyarss	261:1e54415b34d3	525	scp_threshold_m0_1[5] = tc_ptr->TC_string[6];
chaithanyarss	261:1e54415b34d3	526	scp_threshold_m0_1[8] = tc_ptr->TC_string[7];
chaithanyarss	261:1e54415b34d3	527	scp_threshold_m0_1[6] = tc_ptr->TC_string[8];
chaithanyarss	261:1e54415b34d3	528	for(uint8_t z=0;z<5;z++)
chaithanyarss	261:1e54415b34d3	529	scp_threshold_m0_1[z] = tc_ptr->TC_string[z+9];
chaithanyarss	261:1e54415b34d3	530	//scp_sfp_threshold_m0_2[0] = tc_ptr->TC_string[14];
chaithanyarss	261:1e54415b34d3	531	//scp_sfp_threshold_m0_2[1] = tc_ptr->TC_string[15];
chaithanyarss	261:1e54415b34d3	532	//scp_sfp_threshold_m0_2[2] = tc_ptr->TC_string[16];
chaithanyarss	261:1e54415b34d3	533	//int strt_add = flash_size() - (7*SECTOR_SIZE);
chaithanyarss	261:1e54415b34d3	534	//uint32_t flasharray[32] = {0};
chaithanyarss	261:1e54415b34d3	535	flasharray_thres[0] = scp_threshold_m0_1[7];
chaithanyarss	261:1e54415b34d3	536	flasharray_thres[1] = scp_threshold_m0_1[5];
chaithanyarss	261:1e54415b34d3	537	flasharray_thres[2] = scp_threshold_m0_1[8];
chaithanyarss	261:1e54415b34d3	538	flasharray_thres[3] = scp_threshold_m0_1[6];
chaithanyarss	261:1e54415b34d3	539	for(uint8_t z=0;z<5;z++)
chaithanyarss	261:1e54415b34d3	540	flasharray_thres[z+4] = scp_threshold_m0_1[z];
chaithanyarss	261:1e54415b34d3	541	//flasharray_thres[9] = scp_sfp_threshold_m0_2[0];
chaithanyarss	261:1e54415b34d3	542	//flasharray_thres[10] = scp_sfp_threshold_m0_2[1];
chaithanyarss	261:1e54415b34d3	543	//flasharray_thres[11] = scp_sfp_threshold_m0_2[2];
chaithanyarss	261:1e54415b34d3	544	erase_sector(strt_add_thres+(4*SECTOR_SIZE));
chaithanyarss	261:1e54415b34d3	545	program_flash(strt_add_thres+(4SECTOR_SIZE), (char)flasharray_thres,32);
chaithanyarss	261:1e54415b34d3	546	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	547	return tm_ptr_short;
chaithanyarss	261:1e54415b34d3	548	}
chaithanyarss	261:1e54415b34d3	549	else if(mid == 0x0007)
chaithanyarss	261:1e54415b34d3	550	{
chaithanyarss	261:1e54415b34d3	551	for(uint8_t z=0;z<24;z++)
chaithanyarss	261:1e54415b34d3	552	sfp_threshold_m0[z] = tc_ptr->TC_string[z+5];
chaithanyarss	261:1e54415b34d3	553	for(uint8_t z=24;z<32;z++)
chaithanyarss	261:1e54415b34d3	554	sfp_threshold_m0[z+8] = tc_ptr->TC_string[z+5];
chaithanyarss	261:1e54415b34d3	555	//int strt_add_thres = flash_size() - (6*SECTOR_SIZE);
chaithanyarss	261:1e54415b34d3	556	//uint32_t flasharray_thres[32] = {0};
chaithanyarss	261:1e54415b34d3	557	for(uint8_t z=0;z<24;z++)
chaithanyarss	261:1e54415b34d3	558	flasharray_thres[z] = sfp_threshold_m0[z];
chaithanyarss	261:1e54415b34d3	559	for(uint8_t z=24;z<32;z++)
chaithanyarss	261:1e54415b34d3	560	flasharray_thres[z] = sfp_threshold_m0[z+8];
chaithanyarss	261:1e54415b34d3	561	erase_sector(strt_add_thres+(5*SECTOR_SIZE));
chaithanyarss	261:1e54415b34d3	562	program_flash(strt_add_thres+(5SECTOR_SIZE), (char)flasharray_thres,32);
chaithanyarss	261:1e54415b34d3	563	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	564	return tm_ptr_short;
chaithanyarss	261:1e54415b34d3	565	}
chaithanyarss	261:1e54415b34d3	566	else if(mid == 0x0008)
chaithanyarss	261:1e54415b34d3	567	{
chaithanyarss	261:1e54415b34d3	568	for(uint8_t z=0;z<12;z++)
chaithanyarss	261:1e54415b34d3	569	sfp_threshold_m0[z+40] = tc_ptr->TC_string[z+5];
chaithanyarss	261:1e54415b34d3	570	//int strt_add_thres = flash_size() - (5*SECTOR_SIZE);
chaithanyarss	261:1e54415b34d3	571	//uint32_t flasharray_thres[32] = {0};
chaithanyarss	261:1e54415b34d3	572	for(uint8_t z=0;z<12;z++)
chaithanyarss	261:1e54415b34d3	573	flasharray_thres[z] = sfp_threshold_m0[z+40];
chaithanyarss	261:1e54415b34d3	574	erase_sector(strt_add_thres+(6*SECTOR_SIZE));
chaithanyarss	261:1e54415b34d3	575	program_flash(strt_add_thres+(6SECTOR_SIZE), (char)flasharray_thres,32);
chaithanyarss	261:1e54415b34d3	576	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	577	return tm_ptr_short;
chaithanyarss	261:1e54415b34d3	578	}
chaithanyarss	261:1e54415b34d3	579	else if(mid == 0x0009)
chaithanyarss	261:1e54415b34d3	580	{
chaithanyarss	261:1e54415b34d3	581	for(uint8_t z=0;z<32;z++)
chaithanyarss	261:1e54415b34d3	582	sfp_threshold_m1[z] = tc_ptr->TC_string[z+5];
chaithanyarss	261:1e54415b34d3	583	//int strt_add_thres = flash_size() - (4*SECTOR_SIZE);
chaithanyarss	261:1e54415b34d3	584	//uint32_t flasharray_thres[32] = {0};
chaithanyarss	261:1e54415b34d3	585	for(uint8_t z=0;z<32;z++)
chaithanyarss	261:1e54415b34d3	586	flasharray_thres[z] = sfp_threshold_m1[z];
chaithanyarss	261:1e54415b34d3	587	erase_sector(strt_add_thres+(7*SECTOR_SIZE));
chaithanyarss	261:1e54415b34d3	588	program_flash(strt_add_thres+(7SECTOR_SIZE), (char)flasharray_thres,32);
chaithanyarss	261:1e54415b34d3	589	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	590	return tm_ptr_short;
chaithanyarss	261:1e54415b34d3	591	}
chaithanyarss	261:1e54415b34d3	592	else if(mid == 0x000A)
chaithanyarss	261:1e54415b34d3	593	{
chaithanyarss	261:1e54415b34d3	594	for(uint8_t z=0;z<20;z++)
chaithanyarss	261:1e54415b34d3	595	sfp_threshold_m1[z+32] = tc_ptr->TC_string[z+5];
chaithanyarss	261:1e54415b34d3	596	//int strt_add_thres = flash_size() - (3*SECTOR_SIZE);
chaithanyarss	261:1e54415b34d3	597	//uint32_t flasharray_thres[32] = {0};
chaithanyarss	261:1e54415b34d3	598	for(uint8_t z=0;z<20;z++)
chaithanyarss	261:1e54415b34d3	599	flasharray_thres[z] = sfp_threshold_m1[z+32];
chaithanyarss	261:1e54415b34d3	600	erase_sector(strt_add_thres+(8*SECTOR_SIZE));
chaithanyarss	261:1e54415b34d3	601	program_flash(strt_add_thres+(8SECTOR_SIZE), (char)flasharray_thres,32);
chaithanyarss	261:1e54415b34d3	602	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	603	return tm_ptr_short;
chaithanyarss	261:1e54415b34d3	604	}
chaithanyarss	261:1e54415b34d3	605	}
ee12b079	210:f4acf895b598	606	default:
ee12b079	210:f4acf895b598	607	{
ee12b079	210:f4acf895b598	608	gPC.printf("INVALID SERVICE SUBTYPE\r\n");
chaithanyarss	261:1e54415b34d3	609	ACK_L234(tm_ptr_short,0x02,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	610	return tm_ptr_short;
ee12b079	210:f4acf895b598	611	}
ee12b079	210:f4acf895b598	612	}
chaithanyarss	261:1e54415b34d3	613	}
ee12b079	210:f4acf895b598	614	case 0x80:
ee12b079	210:f4acf895b598	615	{
ee12b079	210:f4acf895b598	616	gPC.printf("service:FUNCTION MANAGEMENT SERVICE\r\n");
ee12b079	210:f4acf895b598	617	if(GETservice_subtype(tc_ptr)==0x1)
ee12b079	210:f4acf895b598	618	{
ee12b079	210:f4acf895b598	619	if(GETpid(tc_ptr)==0x01)
ee12b079	210:f4acf895b598	620	{
ee12b079	210:f4acf895b598	621	if(CDMS_STANDBY==1)
ee12b079	210:f4acf895b598	622	{
ee12b079	210:f4acf895b598	623	//gPC.printf("TC_PL_INIT\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	624
ee12b079	210:f4acf895b598	625	P_PL_INIT();
ee12b079	210:f4acf895b598	626
chaithanyarss	261:1e54415b34d3	627	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	628	return tm_ptr_short;
ee12b079	210:f4acf895b598	629	}
ee12b079	210:f4acf895b598	630	else if(CDMS_STANDBY==0)
ee12b079	210:f4acf895b598	631	{
chaithanyarss	261:1e54415b34d3	632	ACK_L234(tm_ptr_short,0x87,GETpacket_seq_count(tc_ptr)); //TC cannot be processed now
chaithanyarss	261:1e54415b34d3	633	return tm_ptr_short;
ee12b079	210:f4acf895b598	634	}
ee12b079	210:f4acf895b598	635	}
ee12b079	210:f4acf895b598	636	else if(GETpid(tc_ptr)==0x02)
ee12b079	210:f4acf895b598	637	{
ee12b079	210:f4acf895b598	638	if(CDMS_STANDBY==1)
ee12b079	210:f4acf895b598	639	{
ee12b079	210:f4acf895b598	640	//gPC.printf("TC_PL_MAIN\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	641
ee12b079	210:f4acf895b598	642	P_PL_MAIN();
ee12b079	210:f4acf895b598	643
chaithanyarss	261:1e54415b34d3	644	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	645	return tm_ptr_short;
ee12b079	210:f4acf895b598	646	}
ee12b079	210:f4acf895b598	647	else if(CDMS_STANDBY==0)
ee12b079	210:f4acf895b598	648	{
chaithanyarss	261:1e54415b34d3	649	ACK_L234(tm_ptr_short,0x87,GETpacket_seq_count(tc_ptr)); //TC cannot be processed now
chaithanyarss	261:1e54415b34d3	650	return tm_ptr_short;
ee12b079	210:f4acf895b598	651	}
ee12b079	210:f4acf895b598	652	}
ee12b079	210:f4acf895b598	653	else if(GETpid(tc_ptr)==0x03)
ee12b079	210:f4acf895b598	654	{
ee12b079	210:f4acf895b598	655	if(CDMS_STANDBY==1)
ee12b079	210:f4acf895b598	656	{
ee12b079	210:f4acf895b598	657	//gPC.printf("PL_COM_INIT\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	658
ee12b079	210:f4acf895b598	659	P_COM_INIT();
ee12b079	210:f4acf895b598	660
chaithanyarss	261:1e54415b34d3	661	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	662	return tm_ptr_short;
ee12b079	210:f4acf895b598	663	}
ee12b079	210:f4acf895b598	664	else if(CDMS_STANDBY==0)
ee12b079	210:f4acf895b598	665	{
chaithanyarss	261:1e54415b34d3	666	ACK_L234(tm_ptr_short,0x87,GETpacket_seq_count(tc_ptr)); //TC cannot be processed now
chaithanyarss	261:1e54415b34d3	667	return tm_ptr_short;
ee12b079	210:f4acf895b598	668	}
ee12b079	210:f4acf895b598	669	}
ee12b079	210:f4acf895b598	670	else if(GETpid(tc_ptr)==0x04)
ee12b079	210:f4acf895b598	671	{
ee12b079	210:f4acf895b598	672	if(CDMS_STANDBY==1)
ee12b079	210:f4acf895b598	673	{
ee12b079	210:f4acf895b598	674	//gPC.printf("TC_P_CDMS_HK_MAIN\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	675
chaithanyarss	261:1e54415b34d3	676	//gHK_THREAD->signal_set(HK_SIGNAL);
ee12b079	210:f4acf895b598	677
chaithanyarss	261:1e54415b34d3	678	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	679	return tm_ptr_short;
ee12b079	210:f4acf895b598	680	}
ee12b079	210:f4acf895b598	681	else if(CDMS_STANDBY==0)
ee12b079	210:f4acf895b598	682	{
chaithanyarss	261:1e54415b34d3	683	ACK_L234(tm_ptr_short,0x87,GETpacket_seq_count(tc_ptr)); //TC cannot be processed now
chaithanyarss	261:1e54415b34d3	684	return tm_ptr_short;
ee12b079	210:f4acf895b598	685	}
ee12b079	210:f4acf895b598	686	}
ee12b079	210:f4acf895b598	687	else if(GETpid(tc_ptr)==0x05)
ee12b079	210:f4acf895b598	688	{
ee12b079	210:f4acf895b598	689	if(CDMS_STANDBY==1)
ee12b079	210:f4acf895b598	690	{
ee12b079	210:f4acf895b598	691	//gPC.printf("TC_SW_ON_SD\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	692
ee12b079	210:f4acf895b598	693	P_PL_RCV_SC_DATA();
ee12b079	210:f4acf895b598	694
chaithanyarss	261:1e54415b34d3	695	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	696	return tm_ptr_short;
ee12b079	210:f4acf895b598	697	}
ee12b079	210:f4acf895b598	698	else if(CDMS_STANDBY==0)
ee12b079	210:f4acf895b598	699	{
chaithanyarss	261:1e54415b34d3	700	ACK_L234(tm_ptr_short,0x87,GETpacket_seq_count(tc_ptr)); //TC cannot be processed now
chaithanyarss	261:1e54415b34d3	701	return tm_ptr_short;
ee12b079	210:f4acf895b598	702	}
ee12b079	210:f4acf895b598	703	}
ee12b079	210:f4acf895b598	704	else if(GETpid(tc_ptr)==0x06)
ee12b079	210:f4acf895b598	705	{
ee12b079	210:f4acf895b598	706	if(CDMS_STANDBY==1)
ee12b079	210:f4acf895b598	707	{
ee12b079	210:f4acf895b598	708	//gPC.printf("TC_SW_ON_RTC\r\n"); // call PWR_SWCH_ON function
chaithanyarss	261:1e54415b34d3	709	gPC.printf("SD _INIT\r\n");
ee12b079	210:f4acf895b598	710	P_CDMS_INIT_SD();
ee12b079	210:f4acf895b598	711
chaithanyarss	261:1e54415b34d3	712	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	713	return tm_ptr_short;
ee12b079	210:f4acf895b598	714	}
ee12b079	210:f4acf895b598	715	else if(CDMS_STANDBY==0)
ee12b079	210:f4acf895b598	716	{
chaithanyarss	261:1e54415b34d3	717	ACK_L234(tm_ptr_short,0x87,GETpacket_seq_count(tc_ptr)); //TC cannot be processed now
chaithanyarss	261:1e54415b34d3	718	return tm_ptr_short;
ee12b079	210:f4acf895b598	719	}
ee12b079	210:f4acf895b598	720	}
ee12b079	210:f4acf895b598	721	else if(GETpid(tc_ptr)==0x11)
ee12b079	210:f4acf895b598	722	{
ee12b079	210:f4acf895b598	723	//gPC.printf("TC_SW_ON_SD\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	724
ee12b079	210:f4acf895b598	725	CDMS_SD_SW_ON();
ee12b079	210:f4acf895b598	726
chaithanyarss	261:1e54415b34d3	727	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	728	return tm_ptr_short;
ee12b079	210:f4acf895b598	729	}
ee12b079	210:f4acf895b598	730	else if(GETpid(tc_ptr)==0x21)
ee12b079	210:f4acf895b598	731	{
ee12b079	210:f4acf895b598	732	//gPC.printf("TC_SW_ON_SD\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	733
ee12b079	210:f4acf895b598	734	CDMS_SD_SW_OFF();
ee12b079	210:f4acf895b598	735
chaithanyarss	261:1e54415b34d3	736	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	737	return tm_ptr_short;
chaithanyarss	258:7d404e9dc9e2	738	}
chaithanyarss	258:7d404e9dc9e2	739	else if(GETpid(tc_ptr)==0x12)
chaithanyarss	258:7d404e9dc9e2	740	{
chaithanyarss	258:7d404e9dc9e2	741	//gPC.printf("TC_SW_ON_SD\r\n"); // call PWR_SWCH_ON function
chaithanyarss	258:7d404e9dc9e2	742
chaithanyarss	258:7d404e9dc9e2	743	CDMS_RTC_ON();
chaithanyarss	258:7d404e9dc9e2	744
chaithanyarss	261:1e54415b34d3	745	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	746	return tm_ptr_short;
chaithanyarss	258:7d404e9dc9e2	747	}
chaithanyarss	258:7d404e9dc9e2	748	else if(GETpid(tc_ptr)==0x22)
chaithanyarss	258:7d404e9dc9e2	749	{
chaithanyarss	258:7d404e9dc9e2	750	//gPC.printf("TC_SW_ON_SD\r\n"); // call PWR_SWCH_ON function
chaithanyarss	258:7d404e9dc9e2	751
chaithanyarss	258:7d404e9dc9e2	752	CDMS_RTC_OFF();
chaithanyarss	258:7d404e9dc9e2	753
chaithanyarss	261:1e54415b34d3	754	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	755	return tm_ptr_short;
chaithanyarss	261:1e54415b34d3	756	}
ee12b079	210:f4acf895b598	757	else if(GETpid(tc_ptr)==0x13)
ee12b079	210:f4acf895b598	758	{
ee12b079	210:f4acf895b598	759	//gPC.printf("TC_SW_ON_BAE\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	760
ee12b079	210:f4acf895b598	761	SW_ON_BAE();
ee12b079	210:f4acf895b598	762
chaithanyarss	261:1e54415b34d3	763	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	764	return tm_ptr_short;
ee12b079	210:f4acf895b598	765	}
ee12b079	210:f4acf895b598	766	else if(GETpid(tc_ptr)==0x23)
ee12b079	210:f4acf895b598	767	{
ee12b079	210:f4acf895b598	768	//gPC.printf("TC_SW_OFF_BAE\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	769
ee12b079	210:f4acf895b598	770	SW_OFF_BAE();
ee12b079	210:f4acf895b598	771
chaithanyarss	261:1e54415b34d3	772	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	773	return tm_ptr_short;
ee12b079	210:f4acf895b598	774	}
ee12b079	210:f4acf895b598	775	else if(GETpid(tc_ptr)==0x14)
ee12b079	210:f4acf895b598	776	{
ee12b079	210:f4acf895b598	777	//gPC.printf("TC_SW_ON_PL_BEE\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	778
ee12b079	210:f4acf895b598	779	SW_ON_PL_BEE();
ee12b079	210:f4acf895b598	780
chaithanyarss	261:1e54415b34d3	781	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	782	return tm_ptr_short;
ee12b079	210:f4acf895b598	783	}
ee12b079	210:f4acf895b598	784	else if(GETpid(tc_ptr)==0x24)
ee12b079	210:f4acf895b598	785	{
ee12b079	210:f4acf895b598	786	//gPC.printf("TC_SW_OFF_PL_BEE\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	787
ee12b079	210:f4acf895b598	788	SW_OFF_PL_BEE();
ee12b079	210:f4acf895b598	789
chaithanyarss	261:1e54415b34d3	790	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	791	return tm_ptr_short;
ee12b079	210:f4acf895b598	792	}
ee12b079	210:f4acf895b598	793	else if(GETpid(tc_ptr)==0x15)
ee12b079	210:f4acf895b598	794	{
ee12b079	210:f4acf895b598	795	//gPC.printf("TC_SW_ON_PL_EPS\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	796
ee12b079	210:f4acf895b598	797	SW_ON_PL_EPS();
ee12b079	210:f4acf895b598	798
chaithanyarss	261:1e54415b34d3	799	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	800	return tm_ptr_short;
ee12b079	210:f4acf895b598	801	}
ee12b079	210:f4acf895b598	802	else if(GETpid(tc_ptr)==0x25)
ee12b079	210:f4acf895b598	803	{
ee12b079	210:f4acf895b598	804	//gPC.printf("TC_SW_OFF_PL_EPS\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	805
ee12b079	210:f4acf895b598	806	SW_OFF_PL_EPS();
ee12b079	210:f4acf895b598	807
chaithanyarss	261:1e54415b34d3	808	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	809	return tm_ptr_short;
ee12b079	210:f4acf895b598	810	}
ee12b079	210:f4acf895b598	811	else if(GETpid(tc_ptr)==0x16)
ee12b079	210:f4acf895b598	812	{
ee12b079	210:f4acf895b598	813
ee12b079	210:f4acf895b598	814	//gPC.printf("TC_SW_ON_V_A_EN\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	815
ee12b079	210:f4acf895b598	816	SW_ON_V_A_EN();
ee12b079	210:f4acf895b598	817
chaithanyarss	261:1e54415b34d3	818	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	819	return tm_ptr_short;
ee12b079	210:f4acf895b598	820	}
ee12b079	210:f4acf895b598	821	else if(GETpid(tc_ptr)==0x26)
ee12b079	210:f4acf895b598	822	{
ee12b079	210:f4acf895b598	823	//gPC.printf("TC_SW_OFF_V_A_EN\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	824
ee12b079	210:f4acf895b598	825	SW_OFF_V_A_EN();
ee12b079	210:f4acf895b598	826
chaithanyarss	261:1e54415b34d3	827	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	828	return tm_ptr_short;
ee12b079	210:f4acf895b598	829	}
ee12b079	210:f4acf895b598	830	else if(GETpid(tc_ptr)==0x31)
ee12b079	210:f4acf895b598	831	{
ee12b079	210:f4acf895b598	832	//gPC.printf("TC_RST_SD\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	833
ee12b079	210:f4acf895b598	834	RST_SD();
ee12b079	210:f4acf895b598	835
chaithanyarss	261:1e54415b34d3	836	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	837	return tm_ptr_short;
ee12b079	210:f4acf895b598	838	}
ee12b079	210:f4acf895b598	839	else if(GETpid(tc_ptr)==0x33)
ee12b079	210:f4acf895b598	840	{
ee12b079	210:f4acf895b598	841	//gPC.printf("TC_RST_BAE\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	842
ee12b079	210:f4acf895b598	843	RST_BAE();
ee12b079	210:f4acf895b598	844
chaithanyarss	261:1e54415b34d3	845	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	846	return tm_ptr_short;
ee12b079	210:f4acf895b598	847	}
ee12b079	210:f4acf895b598	848	else if(GETpid(tc_ptr)==0x34)
ee12b079	210:f4acf895b598	849	{
ee12b079	210:f4acf895b598	850	//gPC.printf("TC_RST_PL_BEE\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	851
ee12b079	210:f4acf895b598	852	RST_PL_BEE();
ee12b079	210:f4acf895b598	853
chaithanyarss	261:1e54415b34d3	854	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	855	return tm_ptr_short;
ee12b079	210:f4acf895b598	856	}
ee12b079	210:f4acf895b598	857	else if(GETpid(tc_ptr)==0x38)
ee12b079	210:f4acf895b598	858	{
ee12b079	210:f4acf895b598	859	//gPC.printf()
ee12b079	210:f4acf895b598	860
ee12b079	210:f4acf895b598	861	CDMS_INTERNAL_RESET();
chaithanyarss	261:1e54415b34d3	862	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
ee12b079	210:f4acf895b598	863	}
ee12b079	210:f4acf895b598	864	else if(GETpid(tc_ptr)==0x40)
ee12b079	210:f4acf895b598	865	{
ee12b079	210:f4acf895b598	866	//gPC.printf("RESET_HK_COUNTER\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	867
chaithanyarss	261:1e54415b34d3	868	STANDBY_PRCS();
ee12b079	210:f4acf895b598	869
chaithanyarss	261:1e54415b34d3	870	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	871	return tm_ptr_short;
ee12b079	210:f4acf895b598	872	}
ee12b079	210:f4acf895b598	873	else if(GETpid(tc_ptr)==0x41)
ee12b079	210:f4acf895b598	874	{
ee12b079	210:f4acf895b598	875	//gPC.printf("RESET_HK_COUNTER\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	876
ee12b079	210:f4acf895b598	877	RST_HK_COUNTER();
ee12b079	210:f4acf895b598	878
chaithanyarss	261:1e54415b34d3	879	ACK_L234(tm_ptr_short,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	880	return tm_ptr_short;
ee12b079	210:f4acf895b598	881	}
ee12b079	210:f4acf895b598	882	else if(GETpid(tc_ptr)==0xF1)
ee12b079	210:f4acf895b598	883	{
ee12b079	210:f4acf895b598	884	//gPC.printf("TC_CDMS_RD_RTC\r\n"); // call PWR_SWCH_ON function
ee12b079	210:f4acf895b598	885
chaithanyarss	258:7d404e9dc9e2	886	uint32_t time_temp = FCTN_CDMS_RD_RTC(); //RTC_RD_EROR has to incorporated
ee12b079	210:f4acf895b598	887	tm_pointer->TM_string[0] = 0x78;
ee12b079	210:f4acf895b598	888	tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
chaithanyarss	261:1e54415b34d3	889	tm_pointer->TM_string[2] = 0xA0;
ee12b079	210:f4acf895b598	890	tm_pointer->TM_string[3] = 0x00;
chaithanyarss	258:7d404e9dc9e2	891	tm_pointer->TM_string[4] = (uint8_t)((time_temp & 0xFF000000)>>24);
chaithanyarss	258:7d404e9dc9e2	892	tm_pointer->TM_string[5] = (uint8_t)((time_temp & 0x00FF0000)>>16);
chaithanyarss	258:7d404e9dc9e2	893	tm_pointer->TM_string[6] = (uint8_t)((time_temp & 0x0000FF00)>>8);
chaithanyarss	258:7d404e9dc9e2	894	tm_pointer->TM_string[7] = (uint8_t)((time_temp & 0x000000FF));
ee12b079	210:f4acf895b598	895	for(uint8_t i=0;i<124;i++)
ee12b079	210:f4acf895b598	896	{
ee12b079	210:f4acf895b598	897	tm_pointer->TM_string[i+8] = 0x00;
ee12b079	210:f4acf895b598	898	}
ee12b079	210:f4acf895b598	899	crc16 = crc16_gen(tm_ptr->TM_string,132);
ee12b079	210:f4acf895b598	900	tm_pointer->TM_string[132] = (uint8_t)((crc16&0xFF00)>>8);
ee12b079	210:f4acf895b598	901	tm_pointer->TM_string[133] = (uint8_t)(crc16&0x00FF);
chaithanyarss	261:1e54415b34d3	902	tm_pointer->next_TM = NULL;
chaithanyarss	261:1e54415b34d3	903	return tm_ptr; //incomplete
ee12b079	210:f4acf895b598	904	}
ee12b079	210:f4acf895b598	905	else if(GETpid(tc_ptr)==0xF0)
ee12b079	210:f4acf895b598	906	{
ee12b079	210:f4acf895b598	907	uint8_t statusbits[64];
chaithanyarss	258:7d404e9dc9e2	908	if( CDMS_RD_SD_HK(statusbits) != 0){
chaithanyarss	261:1e54415b34d3	909	ACK_L234(tm_pointer,0xA0,GETpacket_seq_count(tc_ptr));
chaithanyarss	258:7d404e9dc9e2	910	return tm_ptr;
chaithanyarss	258:7d404e9dc9e2	911	}
chaithanyarss	258:7d404e9dc9e2	912	else
chaithanyarss	258:7d404e9dc9e2	913	{
chaithanyarss	258:7d404e9dc9e2	914	uint32_t time_temp = FCTN_CDMS_RD_RTC(); //RTC_RD_EROR has to incorporated
chaithanyarss	258:7d404e9dc9e2	915	tm_pointer->TM_string[0] = 0x78;
chaithanyarss	258:7d404e9dc9e2	916	tm_pointer->TM_string[1] = GETpacket_seq_count(tc_ptr);
chaithanyarss	258:7d404e9dc9e2	917	tm_pointer->TM_string[2] = 0xA0; // ACK CODE
chaithanyarss	258:7d404e9dc9e2	918	tm_pointer->TM_string[3] = 0x00;
chaithanyarss	258:7d404e9dc9e2	919	for(int i=4;i<64;i++)
chaithanyarss	258:7d404e9dc9e2	920	{
chaithanyarss	258:7d404e9dc9e2	921	tm_pointer->TM_string[i+4] = (i<68)?statusbits[i]:0x00;
chaithanyarss	258:7d404e9dc9e2	922	}
chaithanyarss	258:7d404e9dc9e2	923	for(uint8_t i=68;i<132;i++)
chaithanyarss	258:7d404e9dc9e2	924	{
chaithanyarss	258:7d404e9dc9e2	925	tm_pointer->TM_string[i] = 0x00;
chaithanyarss	258:7d404e9dc9e2	926	}
chaithanyarss	258:7d404e9dc9e2	927	crc16 = crc16_gen(tm_ptr->TM_string,132);
chaithanyarss	258:7d404e9dc9e2	928	tm_pointer->TM_string[132] = (uint8_t)((crc16&0xFF00)>>8);
chaithanyarss	258:7d404e9dc9e2	929	tm_pointer->TM_string[133] = (uint8_t)(crc16&0x00FF);
chaithanyarss	258:7d404e9dc9e2	930	tm_pointer->next_TM = NULL; //incomplete
chaithanyarss	258:7d404e9dc9e2	931	return tm_ptr;
chaithanyarss	258:7d404e9dc9e2	932	}
chaithanyarss	261:1e54415b34d3	933	}
chaithanyarss	261:1e54415b34d3	934	else if(GETpid(tc_ptr)==0xF1)
chaithanyarss	261:1e54415b34d3	935	{
chaithanyarss	261:1e54415b34d3	936	CDMS_CALIB_RTC((uint64_t)(tc_ptr->TC_string[4])<<32 + (uint64_t)(tc_ptr->TC_string[5])<<24 + (uint64_t)(tc_ptr->TC_string[5])<<16 + (uint64_t)(tc_ptr->TC_string[6])<<8 +(uint64_t)(tc_ptr->TC_string[7]));
chaithanyarss	261:1e54415b34d3	937	ACK_L234(tm_pointer,0xC0,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	938	return tm_ptr;
ee12b079	210:f4acf895b598	939	}
ee12b079	210:f4acf895b598	940	else
ee12b079	210:f4acf895b598	941	{
ee12b079	210:f4acf895b598	942	gPC.printf("INVALID FID\r\n");
chaithanyarss	261:1e54415b34d3	943	ACK_L234(tm_ptr_short,0x02,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	944	return tm_ptr_short;
ee12b079	210:f4acf895b598	945	}
ee12b079	210:f4acf895b598	946	}
ee12b079	210:f4acf895b598	947	else
ee12b079	210:f4acf895b598	948	{
ee12b079	210:f4acf895b598	949	gPC.printf("INVALID SERVICE SUBTYPE\r\n");
chaithanyarss	261:1e54415b34d3	950	ACK_L234(tm_ptr_short,0x02,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	951	return tm_ptr_short;
ee12b079	210:f4acf895b598	952	}
ee12b079	210:f4acf895b598	953	}
ee12b079	210:f4acf895b598	954	case 0x70:
ee12b079	210:f4acf895b598	955	{
ee12b079	210:f4acf895b598	956	gPC.printf("\n\n\rService:PAYLOAD MANAGEMENT SERVICE");
ee12b079	210:f4acf895b598	957	if(GETservice_subtype(tc_ptr)==0x1) //make sure it is LONG TC before executing else INVALID TC
ee12b079	210:f4acf895b598	958	{
ee12b079	210:f4acf895b598	959	gPC.printf("\n\rTC with subtype = 0x1");
ee12b079	210:f4acf895b598	960	TM_PMS_PL_SCHEDULE(tm_ptr,GETpacket_seq_count(tc_ptr));
ee12b079	210:f4acf895b598	961	for(uint8_t i=0,j=0;i<32;i++)
ee12b079	210:f4acf895b598	962	{
ee12b079	210:f4acf895b598	963	pl_block[i] &= 0x00000000;
ee12b079	210:f4acf895b598	964	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[3+j]))<<24);
ee12b079	210:f4acf895b598	965	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[4+j]))<<16);
ee12b079	210:f4acf895b598	966	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[5+j]))<<8);
ee12b079	210:f4acf895b598	967	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[6+j])));
ee12b079	210:f4acf895b598	968	j+=4;
ee12b079	210:f4acf895b598	969	}
ee12b079	210:f4acf895b598	970	return tm_ptr;
ee12b079	210:f4acf895b598	971	}
ee12b079	210:f4acf895b598	972	else if(GETservice_subtype(tc_ptr)==0x2)
ee12b079	210:f4acf895b598	973	{
ee12b079	210:f4acf895b598	974	gPC.printf("\n\rTC with subtype = 0x2");
ee12b079	210:f4acf895b598	975	TM_PMS_PL_SCHEDULE(tm_ptr,GETpacket_seq_count(tc_ptr));
ee12b079	210:f4acf895b598	976	for(uint8_t i=32,j=0;i<64;i++,j+=4)
ee12b079	210:f4acf895b598	977	{
ee12b079	210:f4acf895b598	978	pl_block[i] &= 0x00000000;
ee12b079	210:f4acf895b598	979	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[3+j]))<<24);
ee12b079	210:f4acf895b598	980	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[4+j]))<<16);
ee12b079	210:f4acf895b598	981	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[5+j]))<<8);
ee12b079	210:f4acf895b598	982	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[6+j])));
ee12b079	210:f4acf895b598	983	}
ee12b079	210:f4acf895b598	984	return tm_ptr;
ee12b079	210:f4acf895b598	985	}
ee12b079	210:f4acf895b598	986	else if(GETservice_subtype(tc_ptr)==0x3)
ee12b079	210:f4acf895b598	987	{
ee12b079	210:f4acf895b598	988	gPC.printf("\n\rTC with subtype = 0x3");
ee12b079	210:f4acf895b598	989	TM_PMS_PL_SCHEDULE(tm_ptr,GETpacket_seq_count(tc_ptr));
ee12b079	210:f4acf895b598	990	for(uint8_t i=64,j=0;i<96;i++,j+=4)
ee12b079	210:f4acf895b598	991	{
ee12b079	210:f4acf895b598	992	pl_block[i] &= 0x00000000;
ee12b079	210:f4acf895b598	993	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[3+j]))<<24);
ee12b079	210:f4acf895b598	994	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[4+j]))<<16);
ee12b079	210:f4acf895b598	995	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[5+j]))<<8);
ee12b079	210:f4acf895b598	996	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[6+j])));
ee12b079	210:f4acf895b598	997	}
ee12b079	210:f4acf895b598	998	return tm_ptr;
ee12b079	210:f4acf895b598	999	}
ee12b079	210:f4acf895b598	1000	else if(GETservice_subtype(tc_ptr)==0x4)
ee12b079	210:f4acf895b598	1001	{
ee12b079	210:f4acf895b598	1002	gPC.printf("\n\rTC with subtype = 0x4");
ee12b079	210:f4acf895b598	1003	TM_PMS_PL_SCHEDULE(tm_ptr,GETpacket_seq_count(tc_ptr));
ee12b079	210:f4acf895b598	1004	for(uint8_t i=96,j=0;i<128;i++,j+=4)
ee12b079	210:f4acf895b598	1005	{
ee12b079	210:f4acf895b598	1006	pl_block[i] &= 0x00000000;
ee12b079	210:f4acf895b598	1007	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[3+j]))<<24);
ee12b079	210:f4acf895b598	1008	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[4+j]))<<16);
ee12b079	210:f4acf895b598	1009	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[5+j]))<<8);
ee12b079	210:f4acf895b598	1010	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[6+j])));
ee12b079	210:f4acf895b598	1011	}
ee12b079	210:f4acf895b598	1012	return tm_ptr;
ee12b079	210:f4acf895b598	1013	}
ee12b079	210:f4acf895b598	1014	else if(GETservice_subtype(tc_ptr)==0x5)
ee12b079	210:f4acf895b598	1015	{
ee12b079	210:f4acf895b598	1016	gPC.printf("\n\rTC with subtype = 0x5");
ee12b079	210:f4acf895b598	1017	TM_PMS_PL_SCHEDULE(tm_ptr,GETpacket_seq_count(tc_ptr));
ee12b079	210:f4acf895b598	1018	for(uint8_t i=128,j=0;i<160;i++,j+=4)
ee12b079	210:f4acf895b598	1019	{
ee12b079	210:f4acf895b598	1020	pl_block[i] &= 0x00000000;
ee12b079	210:f4acf895b598	1021	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[3+j]))<<24);
ee12b079	210:f4acf895b598	1022	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[4+j]))<<16);
ee12b079	210:f4acf895b598	1023	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[5+j]))<<8);
ee12b079	210:f4acf895b598	1024	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[6+j])));
ee12b079	210:f4acf895b598	1025	}
ee12b079	210:f4acf895b598	1026	return tm_ptr;
ee12b079	210:f4acf895b598	1027	}
ee12b079	210:f4acf895b598	1028	else if(GETservice_subtype(tc_ptr)==0x6)
ee12b079	210:f4acf895b598	1029	{
ee12b079	210:f4acf895b598	1030	gPC.printf("\n\rTC with subtype = 0x6");
ee12b079	210:f4acf895b598	1031	TM_PMS_PL_SCHEDULE(tm_ptr,GETpacket_seq_count(tc_ptr));
ee12b079	210:f4acf895b598	1032	for(uint8_t i=160,j=0;i<192;i++,j+=4)
ee12b079	210:f4acf895b598	1033	{
ee12b079	210:f4acf895b598	1034	pl_block[i] &= 0x00000000;
ee12b079	210:f4acf895b598	1035	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[3+j]))<<24);
ee12b079	210:f4acf895b598	1036	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[4+j]))<<16);
ee12b079	210:f4acf895b598	1037	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[5+j]))<<8);
ee12b079	210:f4acf895b598	1038	pl_block[i] \|= (((uint32_t)(tc_ptr->TC_string[6+j])));
ee12b079	210:f4acf895b598	1039	}
ee12b079	210:f4acf895b598	1040	return tm_ptr;
ee12b079	210:f4acf895b598	1041	}
ee12b079	210:f4acf895b598	1042	else if(GETservice_subtype(tc_ptr)==0xF)
ee12b079	210:f4acf895b598	1043	{
ee12b079	210:f4acf895b598	1044	gPC.printf("\n\rTC with subtype = 0xF");
ee12b079	210:f4acf895b598	1045	TM_PMS_PL_SCHEDULE(tm_ptr,GETpacket_seq_count(tc_ptr));
ee12b079	210:f4acf895b598	1046	return tm_ptr;
ee12b079	210:f4acf895b598	1047	}
ee12b079	210:f4acf895b598	1048	else
ee12b079	210:f4acf895b598	1049	{
ee12b079	210:f4acf895b598	1050	gPC.printf("INVALID SERVICE SUBTYPE\r\n");
chaithanyarss	261:1e54415b34d3	1051	ACK_L234(tm_ptr_short,0x02,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	1052	return tm_ptr_short;
ee12b079	210:f4acf895b598	1053	}
aniruddhv	52:0bd68655c651	1054	}
aniruddhv	52:0bd68655c651	1055	default:
aniruddhv	52:0bd68655c651	1056	{
ee12b079	210:f4acf895b598	1057	gPC.printf("ILLEGAL TC");
chaithanyarss	261:1e54415b34d3	1058	ACK_L234(tm_ptr_short,0x02,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	1059	return tm_ptr_short;
aniruddhv	52:0bd68655c651	1060	}
aniruddhv	52:0bd68655c651	1061	}
aniruddhv	52:0bd68655c651	1062	}
aniruddhv	52:0bd68655c651	1063	case 3:
aniruddhv	52:0bd68655c651	1064	{
ee12b079	210:f4acf895b598	1065	//#if DEBUG
ee12b079	210:f4acf895b598	1066	gPC.printf("\n\rTelecommand is for PL\r\n");
ee12b079	210:f4acf895b598	1067	//#endif
ee12b079	161:a63672bf4423	1068	if(GETshort_or_long_tc(tc_ptr) == LONG_TC_CODE)
ee12b079	210:f4acf895b598	1069	y=FCTN_I2C_WRITE_PL((char*)tc_ptr->TC_string,TC_LONG_SIZE);
ee12b079	210:f4acf895b598	1070	else if(GETshort_or_long_tc(tc_ptr) == SHORT_TC_CODE)
ee12b079	210:f4acf895b598	1071	y=FCTN_I2C_WRITE_PL((char*)tc_ptr->TC_string,TC_SHORT_SIZE);
ee12b079	210:f4acf895b598	1072
ee12b079	210:f4acf895b598	1073	if(y==1)
ee12b079	210:f4acf895b598	1074	{
chaithanyarss	261:1e54415b34d3	1075	ACK_L234(tm_ptr_short,0x03,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	1076	return tm_ptr_short;
ee12b079	210:f4acf895b598	1077	break;
ee12b079	210:f4acf895b598	1078	}
ee12b079	210:f4acf895b598	1079	else if(y==0)
ee12b079	171:31bdf83591a1	1080	{
ee12b079	210:f4acf895b598	1081	//wait(0.2);
aniruddhv	264:f7d8f9f361e3	1082	int poll=0;
aniruddhv	264:f7d8f9f361e3	1083	while(poll<900 && PL_I2C_Intr==0)
ee12b079	210:f4acf895b598	1084	{
aniruddhv	264:f7d8f9f361e3	1085	wait_us(10);
ee12b079	210:f4acf895b598	1086	poll+=1;
ee12b079	210:f4acf895b598	1087	}
ee12b079	210:f4acf895b598	1088	if(PL_I2C_Intr == 1) //name to be changed later
ee12b079	171:31bdf83591a1	1089	{
ee12b079	210:f4acf895b598	1090	gPC.printf("PL_I2C_Intr is high\r\n");
ee12b079	210:f4acf895b598	1091
ee12b079	210:f4acf895b598	1092	y=FCTN_I2C_READ_PL((char*)tm_pointer->TM_string,TM_LONG_SIZE); //rify later about the size
ee12b079	210:f4acf895b598	1093	if(y==0)
ee12b079	210:f4acf895b598	1094	{
ee12b079	210:f4acf895b598	1095	tm_pointer->next_TM=NULL;
ee12b079	210:f4acf895b598	1096	return tm_ptr;
ee12b079	210:f4acf895b598	1097	break;
ee12b079	210:f4acf895b598	1098	}
ee12b079	210:f4acf895b598	1099	else if(y==1)
ee12b079	210:f4acf895b598	1100	{
chaithanyarss	261:1e54415b34d3	1101	ACK_L234(tm_ptr_short,0x85,GETpacket_seq_count(tc_ptr));
ee12b079	210:f4acf895b598	1102	//gPC.printf("\n\rPTE->PDIR = 0x%08X",PTE->PDIR);
chaithanyarss	261:1e54415b34d3	1103	return tm_ptr_short;
ee12b079	210:f4acf895b598	1104	break;
ee12b079	210:f4acf895b598	1105	}
ee12b079	171:31bdf83591a1	1106	}
ee12b079	210:f4acf895b598	1107	else if(PL_I2C_Intr == 0) //name to be changed later
ee12b079	210:f4acf895b598	1108	{
ee12b079	210:f4acf895b598	1109	gPC.printf("PL_I2C_Intr is not high\r\n");
chaithanyarss	261:1e54415b34d3	1110	ACK_L234(tm_ptr_short,0x84,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	1111	return tm_ptr_short;
ee12b079	210:f4acf895b598	1112	}
ee12b079	210:f4acf895b598	1113	}
aniruddhv	52:0bd68655c651	1114	}
ee12b079	210:f4acf895b598	1115	default: //invalid TC
aniruddhv	52:0bd68655c651	1116	{
ee12b079	210:f4acf895b598	1117	gPC.printf("INVALID TC\r\n");
chaithanyarss	261:1e54415b34d3	1118	ACK_L234(tm_ptr_short,0x02,GETpacket_seq_count(tc_ptr));
chaithanyarss	261:1e54415b34d3	1119	return tm_ptr_short;
aniruddhv	52:0bd68655c651	1120	}
ee12b079	210:f4acf895b598	1121	}
ee12b079	210:f4acf895b598	1122	return;
aniruddhv	52:0bd68655c651	1123	}
shreeshas95	0:f016e9e8d48b	1124	// CDMS TEAM CODE END
shreeshas95	0:f016e9e8d48b	1125	// EXECUTE OBOSC
aniruddhv	51:da85d84768e2	1126	#define execute_obosc_core(tc_ptr, tm_ptr, reset_flag) {\
ee12b079	210:f4acf895b598	1127	if (DEBUG)\
ee12b079	210:f4acf895b598	1128	gPC.puts("Inside execute_obosc_core\r\n");\
shreeshas95	0:f016e9e8d48b	1129	uint8_t service_subtype = (tc_ptr->TC_string[2]) & 0x0F;\
shreeshas95	4:104dd82c99b8	1130	uint8_t temp8 = 0x00;\
shreeshas95	4:104dd82c99b8	1131	Base_tc *modify_this = gHEAD_NODE_TCL;\
shreeshas95	4:104dd82c99b8	1132	int modify_overflow = 0x00;\
shreeshas95	4:104dd82c99b8	1133	switch( service_subtype ){\
shreeshas95	4:104dd82c99b8	1134	case OBOSC_SUB_DISABLE:\
aniruddhv	12:ffdb29353058	1135	/gPC.puts("target psc are ");/\
shreeshas95	5:ab276a17ca07	1136	for(int i = 3 ; i < 9 ; ++i){\
aniruddhv	12:ffdb29353058	1137	/gPC.printf("%u ", tc_ptr->TC_string[i]);/\
shreeshas95	5:ab276a17ca07	1138	}\
aniruddhv	12:ffdb29353058	1139	/gPC.puts("\r\n");/\
shreeshas95	5:ab276a17ca07	1140	/gPC.puts("disable type obosc\r\n");/\
shreeshas95	4:104dd82c99b8	1141	while( modify_this != NULL ){\
shreeshas95	4:104dd82c99b8	1142	if( modify_overflow < TCL_OVERFLOW_CONSTANT ){\
shreeshas95	5:ab276a17ca07	1143	uint8_t modify_psc = GETpacket_seq_count(modify_this);\
shreeshas95	5:ab276a17ca07	1144	/gPC.printf("mosify_psc = %u\r\n", modify_psc);/\
shreeshas95	4:104dd82c99b8	1145	for( int i = 3 ; i < 9 ; ++i ){\
shreeshas95	5:ab276a17ca07	1146	uint8_t target_psc = tc_ptr->TC_string[i];\
shreeshas95	5:ab276a17ca07	1147	if( (target_psc == modify_psc) && (target_psc != 0) ){\
shreeshas95	4:104dd82c99b8	1148	uint16_t tempExec = TC_STATE_DISABLED;\
shreeshas95	4:104dd82c99b8	1149	PUTexec_status( modify_this, tempExec );\
shreeshas95	4:104dd82c99b8	1150	break;\
shreeshas95	4:104dd82c99b8	1151	}\
shreeshas95	4:104dd82c99b8	1152	}\
shreeshas95	4:104dd82c99b8	1153	modify_this = modify_this->next_TC;\
shreeshas95	4:104dd82c99b8	1154	++modify_overflow;\
shreeshas95	4:104dd82c99b8	1155	}\
shreeshas95	4:104dd82c99b8	1156	else{\
ee12b079	210:f4acf895b598	1157	RESET_CDMS;\
shreeshas95	4:104dd82c99b8	1158	break;\
shreeshas95	4:104dd82c99b8	1159	}\
shreeshas95	4:104dd82c99b8	1160	}\
shreeshas95	4:104dd82c99b8	1161	break;\
shreeshas95	4:104dd82c99b8	1162	case OBOSC_SUB_RETRY:\
aniruddhv	12:ffdb29353058	1163	/gPC.puts("retry type obosc\r\n");/\
shreeshas95	4:104dd82c99b8	1164	while( modify_this != NULL ){\
shreeshas95	4:104dd82c99b8	1165	if( modify_overflow < TCL_OVERFLOW_CONSTANT ){\
shreeshas95	5:ab276a17ca07	1166	uint8_t modify_psc = GETpacket_seq_count(modify_this);\
shreeshas95	4:104dd82c99b8	1167	for( int i = 3 ; i < 9 ; ++i ){\
shreeshas95	5:ab276a17ca07	1168	uint8_t target_psc = tc_ptr->TC_string[i];\
shreeshas95	5:ab276a17ca07	1169	if( (target_psc == modify_psc) && (target_psc != 0) ){\
shreeshas95	4:104dd82c99b8	1170	uint16_t tempExec = TC_STATE_MARKED_RETRY;\
shreeshas95	4:104dd82c99b8	1171	PUTexec_status( modify_this, tempExec );\
aniruddhv	12:ffdb29353058	1172	/gPC.puts("reqquired tc found: disable\r\n");/\
shreeshas95	4:104dd82c99b8	1173	break;\
shreeshas95	4:104dd82c99b8	1174	}\
shreeshas95	4:104dd82c99b8	1175	}\
shreeshas95	4:104dd82c99b8	1176	modify_this = modify_this->next_TC;\
shreeshas95	4:104dd82c99b8	1177	++modify_overflow;\
shreeshas95	4:104dd82c99b8	1178	}\
shreeshas95	4:104dd82c99b8	1179	else{\
ee12b079	210:f4acf895b598	1180	RESET_CDMS;\
shreeshas95	4:104dd82c99b8	1181	break;\
shreeshas95	4:104dd82c99b8	1182	}\
shreeshas95	4:104dd82c99b8	1183	}\
shreeshas95	4:104dd82c99b8	1184	break;\
shreeshas95	4:104dd82c99b8	1185	}\
shreeshas95	4:104dd82c99b8	1186	Base_tm *ackl234new = new Short_tm;\
shreeshas95	4:104dd82c99b8	1187	ackl234new->next_TM = NULL;\
shreeshas95	4:104dd82c99b8	1188	/return telemetry pointer here/\
shreeshas95	4:104dd82c99b8	1189	tm_ptr = ackl234new;\
shreeshas95	4:104dd82c99b8	1190	ackl234new->TM_string[0] = TMID_ACK_L234 << 4;\
shreeshas95	4:104dd82c99b8	1191	ackl234new->TM_string[1] = GETpacket_seq_count(tc_ptr);\
shreeshas95	4:104dd82c99b8	1192	ackl234new->TM_string[2] = 0xA0;\
shreeshas95	4:104dd82c99b8	1193	for(int i = 3; i < 11; ++i){\
shreeshas95	4:104dd82c99b8	1194	ackl234new->TM_string[i] = 0x00;\
shreeshas95	4:104dd82c99b8	1195	}\
shreeshas95	4:104dd82c99b8	1196	uint16_t crc = crc16_gen(ackl234new->TM_string, TM_SHORT_SIZE-2);\
shreeshas95	4:104dd82c99b8	1197	ackl234new->TM_string[11] = (crc & 0xFF00) >> 8;\
shreeshas95	4:104dd82c99b8	1198	ackl234new->TM_string[12] = crc & 0x00FF;\
shreeshas95	4:104dd82c99b8	1199	/ack l234 old/\
shreeshas95	4:104dd82c99b8	1200	if( service_subtype == OBOSC_SUB_REP_LE ){\
shreeshas95	4:104dd82c99b8	1201	if( gLAST_TM_SHORT_OR_LONG == SHORT_TM_CODE ){\
shreeshas95	4:104dd82c99b8	1202	Base_tm *ackl234old = new Short_tm;\
shreeshas95	4:104dd82c99b8	1203	ackl234old->next_TM = NULL;\
shreeshas95	4:104dd82c99b8	1204	/APPEND TO ACK L234 NEW HERE/\
shreeshas95	4:104dd82c99b8	1205	ackl234new->next_TM = ackl234old;\
shreeshas95	4:104dd82c99b8	1206	for( int i = 0 ; i < TM_SHORT_SIZE ; ++i ){\
shreeshas95	4:104dd82c99b8	1207	ackl234old->TM_string[i] = gLAST_TM[i];\
shreeshas95	4:104dd82c99b8	1208	}\
shreeshas95	0:f016e9e8d48b	1209	}\
shreeshas95	4:104dd82c99b8	1210	else{\
shreeshas95	4:104dd82c99b8	1211	Base_tm *tempLongTM = new Long_tm;\
shreeshas95	4:104dd82c99b8	1212	tempLongTM->next_TM = NULL;\
shreeshas95	4:104dd82c99b8	1213	/APPEND TO ACK L234 NEW HERE/\
shreeshas95	4:104dd82c99b8	1214	ackl234new->next_TM = tempLongTM;\
shreeshas95	4:104dd82c99b8	1215	for( int i = 0 ; i < TM_LONG_SIZE ; ++i ){\
shreeshas95	4:104dd82c99b8	1216	tempLongTM->TM_string[i] = gLAST_TM[i];\
shreeshas95	4:104dd82c99b8	1217	}\
shreeshas95	4:104dd82c99b8	1218	}\
shreeshas95	4:104dd82c99b8	1219	}\
shreeshas95	4:104dd82c99b8	1220	else if( service_subtype == OBOSC_SUB_REP_TCLD ){\
shreeshas95	4:104dd82c99b8	1221	get_tc_list(ackl234new->next_TM, GETpacket_seq_count(tc_ptr));\
shreeshas95	4:104dd82c99b8	1222	}\
shreeshas95	4:104dd82c99b8	1223	else if( service_subtype == OBOSC_SUB_RESET ){\
aniruddhv	51:da85d84768e2	1224	/reset_all;/\
aniruddhv	51:da85d84768e2	1225	reset_flag = 1;\
shreeshas95	4:104dd82c99b8	1226	/PENDING: VERIFY reset_all, RESET CDMS/\
shreeshas95	0:f016e9e8d48b	1227	}\
shreeshas95	5:ab276a17ca07	1228	else if( (service_subtype != OBOSC_SUB_DISABLE) && (service_subtype != OBOSC_SUB_RETRY) ){\
shreeshas95	4:104dd82c99b8	1229	/CHANGE THE ACK CODE TO INVALID TC/\
aniruddhv	262:752c8689944a	1230	ackl234new->TM_string[2] = 0xAF;\
shreeshas95	0:f016e9e8d48b	1231	}\
ee12b079	210:f4acf895b598	1232	if (DEBUG)\
ee12b079	210:f4acf895b598	1233	gPC.puts("completed obosc\r\n");\
shreeshas95	4:104dd82c99b8	1234	}
shreeshas95	4:104dd82c99b8	1235
shreeshas95	4:104dd82c99b8	1236	/tm_ptr is the next_TM of a linked list, and should have the value NULL, i.e. tm_ptr should be the next_TM pointer of thte last node /
krishanprajapat	117:bfdc807f3d3c	1237
shreeshas95	0:f016e9e8d48b	1238
shreeshas95	0:f016e9e8d48b	1239	#define EXECUTE_OBOSC_ONLY {\
aniruddhv	262:752c8689944a	1240	gMASTER_STATE = TCL_STATE_EXECUTING;\
aniruddhv	51:da85d84768e2	1241	int reset_flag = 0;\
ee12b079	210:f4acf895b598	1242	if (DEBUG)\
ee12b079	210:f4acf895b598	1243	gPC.puts("iNSIDE EXECUTE_OBOSC_ONLY\r\n");\
ee12b079	210:f4acf895b598	1244	Base_tm *obosc_tm_core = NULL;\
ee12b079	210:f4acf895b598	1245	Base_tm *obosc_tm = obosc_tm_core;\
shreeshas95	15:1c1ca992b43b	1246	for(uint8_t execute_psc = PSC_START_VALUE ; execute_psc < gTOTAL_VALID_TC ; ++execute_psc){\
shreeshas95	4:104dd82c99b8	1247	Base_tc* current_TC = gHEAD_NODE_TCL;\
shreeshas95	4:104dd82c99b8	1248	int overCount = 0;\
shreeshas95	0:f016e9e8d48b	1249	while( current_TC != NULL ){\
shreeshas95	4:104dd82c99b8	1250	if( overCount < TCL_OVERFLOW_CONSTANT ){\
shreeshas95	4:104dd82c99b8	1251	if( (GETcrc_pass(current_TC) == 1) && (GETpacket_seq_count(current_TC) == execute_psc) ){\
shreeshas95	4:104dd82c99b8	1252	/CHECK FOR OBOSC/\
shreeshas95	0:f016e9e8d48b	1253	uint8_t temp82 = 0x00;\
shreeshas95	0:f016e9e8d48b	1254	isit_obosc(current_TC, temp82);\
shreeshas95	0:f016e9e8d48b	1255	if(temp82 == 0x01){\
shreeshas95	4:104dd82c99b8	1256	uint16_t current_exec_status = GETexec_status(current_TC);\
shreeshas95	4:104dd82c99b8	1257	if( (current_exec_status == TC_STATE_SUCCESSFULLY_EXECUTED) \|\| (current_exec_status == TC_STATE_DISABLED) )\
shreeshas95	4:104dd82c99b8	1258	break;\
shreeshas95	4:104dd82c99b8	1259	else if( (current_exec_status == TC_STATE_UNEXECUTED) \|\| (current_exec_status == TC_STATE_MARKED_RETRY) ){\
ee12b079	210:f4acf895b598	1260	if (DEBUG)\
ee12b079	210:f4acf895b598	1261	gPC.printf("It is obosc: %u\r\n", execute_psc);\
shreeshas95	4:104dd82c99b8	1262	/EXECUTION OF OBOSC TC/\
shreeshas95	4:104dd82c99b8	1263	/WARNING: LARGE MEMORY UTILIZATION FOR TC-LIST-REPORT /\
ee12b079	73:6c99294b7802	1264	execute_obosc_core(current_TC, obosc_tm_core, reset_flag);\
ee12b079	210:f4acf895b598	1265	Base_tm *obosc_tm_current = obosc_tm_core;\
ee12b079	210:f4acf895b598	1266	while(obosc_tm_core != NULL){\
ee12b079	210:f4acf895b598	1267	obosc_tm_core = obosc_tm_core->next_TM;\
ee12b079	210:f4acf895b598	1268	}\
aniruddhv	262:752c8689944a	1269	if(obosc_tm_current->TM_string[2] == 0xA0){\
aniruddhv	262:752c8689944a	1270	uint16_t temp16 = TC_STATE_SUCCESSFULLY_EXECUTED;\
aniruddhv	262:752c8689944a	1271	PUTexec_status(current_TC, temp16);\
aniruddhv	262:752c8689944a	1272	}\
aniruddhv	262:752c8689944a	1273	else{\
aniruddhv	262:752c8689944a	1274	uint16_t temp16 = TC_STATE_EXECUTION_FAILED;\
aniruddhv	262:752c8689944a	1275	PUTexec_status(current_TC, temp16);\
aniruddhv	262:752c8689944a	1276	}\
ee12b079	73:6c99294b7802	1277	while( obosc_tm_current != NULL ){\
ee12b079	73:6c99294b7802	1278	int length = TM_SHORT_SIZE;\
shreeshas95	102:80c911a6e736	1279	if( GETshort_or_long_tm(obosc_tm_current) == SHORT_TM_CODE ){\
ee12b079	73:6c99294b7802	1280	length = TM_SHORT_SIZE;\
ee12b079	73:6c99294b7802	1281	}\
ee12b079	73:6c99294b7802	1282	else{\
ee12b079	73:6c99294b7802	1283	length = TM_LONG_SIZE;\
ee12b079	73:6c99294b7802	1284	}\
ee12b079	73:6c99294b7802	1285	for(int i = 0 ; i < length ; ++i){\
ee12b079	73:6c99294b7802	1286	/gPC.putc(obosc_tm_current->TM_string[i]);/\
ee12b079	73:6c99294b7802	1287	}\
ee12b079	73:6c99294b7802	1288	obosc_tm_current = obosc_tm_current->next_TM;\
ee12b079	73:6c99294b7802	1289	}\
shreeshas95	0:f016e9e8d48b	1290	}\
shreeshas95	0:f016e9e8d48b	1291	}\
shreeshas95	0:f016e9e8d48b	1292	}\
shreeshas95	4:104dd82c99b8	1293	current_TC = current_TC->next_TC;\
shreeshas95	4:104dd82c99b8	1294	++overCount;\
shreeshas95	0:f016e9e8d48b	1295	}\
shreeshas95	4:104dd82c99b8	1296	else{\
aniruddhv	262:752c8689944a	1297	RESET_CDMS;\
shreeshas95	4:104dd82c99b8	1298	break;\
shreeshas95	4:104dd82c99b8	1299	}\
shreeshas95	4:104dd82c99b8	1300	}\
aniruddhv	58:5c59f28620bc	1301	}\
ee12b079	210:f4acf895b598	1302	if(obosc_tm_core != NULL){\
ee12b079	210:f4acf895b598	1303	Base_tm *obosc_tm_head = NULL;\
ee12b079	210:f4acf895b598	1304	get_call_sign(obosc_tm_head);\
ee12b079	210:f4acf895b598	1305	Base_tm *obosc_tm_current = obosc_tm_head;\
ee12b079	210:f4acf895b598	1306	get_ack_l1(obosc_tm_current->next_TM);\
ee12b079	210:f4acf895b598	1307	int overflowCountOBONLY = 0;\
ee12b079	210:f4acf895b598	1308	while( obosc_tm_current->next_TM != NULL ){\
ee12b079	210:f4acf895b598	1309	if( overflowCountOBONLY < TM_OVERFLOW_CONSTANT ){\
ee12b079	210:f4acf895b598	1310	obosc_tm_current = obosc_tm_current->next_TM;\
ee12b079	210:f4acf895b598	1311	++overflowCountOBONLY;\
ee12b079	210:f4acf895b598	1312	}\
ee12b079	210:f4acf895b598	1313	else{\
ee12b079	210:f4acf895b598	1314	RESET_CDMS;\
ee12b079	210:f4acf895b598	1315	break;\
ee12b079	210:f4acf895b598	1316	}\
ee12b079	210:f4acf895b598	1317	}\
ee12b079	210:f4acf895b598	1318	obosc_tm_current->next_TM = obosc_tm;\
ee12b079	210:f4acf895b598	1319	/Sending OBOSC TM to GS/\
ee12b079	210:f4acf895b598	1320	/snd_tm.head_pointer(obosc_tm_head);/\
ee12b079	210:f4acf895b598	1321	/transmit_adf;/\
ee12b079	210:f4acf895b598	1322	/DELETE THE TM AFTER USE/\
ee12b079	210:f4acf895b598	1323	obosc_tm_current = obosc_tm_head;\
ee12b079	210:f4acf895b598	1324	int overCount = 0;\
ee12b079	210:f4acf895b598	1325	while( obosc_tm_current != NULL ){\
ee12b079	210:f4acf895b598	1326	if( (overCount < TM_OVERFLOW_CONSTANT) ){\
ee12b079	210:f4acf895b598	1327	Base_tm *temp = obosc_tm_current->next_TM;\
ee12b079	210:f4acf895b598	1328	delete obosc_tm_current;\
ee12b079	210:f4acf895b598	1329	obosc_tm_current = temp;\
ee12b079	210:f4acf895b598	1330	++overCount;\
ee12b079	210:f4acf895b598	1331	}\
ee12b079	210:f4acf895b598	1332	else{\
ee12b079	210:f4acf895b598	1333	RESET_CDMS;\
ee12b079	210:f4acf895b598	1334	break;\
ee12b079	210:f4acf895b598	1335	}\
ee12b079	210:f4acf895b598	1336	}\
aniruddhv	262:752c8689944a	1337	}\
aniruddhv	262:752c8689944a	1338	if ( reset_flag == 1 ){\
aniruddhv	262:752c8689944a	1339	reset_all;\
aniruddhv	263:3b872778b8c7	1340	/Enable threads/\
aniruddhv	263:3b872778b8c7	1341	gPAY_SPI->bulkRead_resume(&payload_isr_fun);\
aniruddhv	263:3b872778b8c7	1342	HK_counter->start(10000);\
aniruddhv	262:752c8689944a	1343	gSESSION_TIMEOUT.detach();\
ee12b079	210:f4acf895b598	1344	}\
shreeshas95	0:f016e9e8d48b	1345	}
shreeshas95	0:f016e9e8d48b	1346
shreeshas95	0:f016e9e8d48b	1347	#define EXECUTE_TC {\
shreeshas95	5:ab276a17ca07	1348	gMASTER_STATE = TCL_STATE_EXECUTING;\
ee12b079	210:f4acf895b598	1349	if (DEBUG)\
ee12b079	210:f4acf895b598	1350	gPC.puts("iNSIDE EXECUTE_TC\r\n");\
rohit3342	23:c89376564196	1351	/gPC.printf("%u\r\n", gTOTAL_VALID_TC);/\
rohit3342	16:538de1b20b3a	1352	for(uint8_t execute_psc = PSC_START_VALUE ; execute_psc < gTOTAL_VALID_TC ; ++execute_psc ){\
ee12b079	210:f4acf895b598	1353	if (DEBUG)\
ee12b079	210:f4acf895b598	1354	gPC.printf("executing normal %u\r\n", execute_psc);\
shreeshas95	2:2caf2a9a13aa	1355	/gLEDG = !gLEDG;/\
shreeshas95	2:2caf2a9a13aa	1356	/gLEDR = !gLEDR;/\
shreeshas95	0:f016e9e8d48b	1357	Base_tc* current_TC = gHEAD_NODE_TCL;\
shreeshas95	4:104dd82c99b8	1358	int overflowCount = 0;\
shreeshas95	0:f016e9e8d48b	1359	while(current_TC != NULL){\
shreeshas95	4:104dd82c99b8	1360	if( overflowCount < TCL_OVERFLOW_CONSTANT ){\
shreeshas95	4:104dd82c99b8	1361	if( (GETcrc_pass(current_TC) == 1) && (GETpacket_seq_count(current_TC) == execute_psc) ){\
shreeshas95	4:104dd82c99b8	1362	uint8_t current_exec_status = GETexec_status(current_TC);\
shreeshas95	5:ab276a17ca07	1363	if( (current_exec_status == TC_STATE_SUCCESSFULLY_EXECUTED) \|\| (current_exec_status == TC_STATE_DISABLED) ){\
aniruddhv	12:ffdb29353058	1364	/gPC.printf("disabled or completed at %u\n", execute_psc);/\
ee12b079	210:f4acf895b598	1365	if( execute_psc == (gTOTAL_VALID_TC-1) ){\
ee12b079	210:f4acf895b598	1366	/LAST TC IS EXECUTED/\
ee12b079	210:f4acf895b598	1367	gMASTER_STATE = TCL_STATE_COMPLETED;\
ee12b079	210:f4acf895b598	1368	}\
shreeshas95	4:104dd82c99b8	1369	break;\
shreeshas95	5:ab276a17ca07	1370	}\
shreeshas95	4:104dd82c99b8	1371	else if( (current_exec_status == TC_STATE_EXECUTION_FAILED) && (GETabort_on_nack(current_TC) == 1) ){\
aniruddhv	12:ffdb29353058	1372	/gPC.printf("abort on nack at %u psc\r\n", execute_psc);/\
shreeshas95	4:104dd82c99b8	1373	gMASTER_STATE = TCL_STATE_ABORTED;\
rohit3342	44:b9b067d0559f	1374	Base_tm *tm_ptr_head = NULL;\
rohit3342	44:b9b067d0559f	1375	get_call_sign(tm_ptr_head);\
rohit3342	44:b9b067d0559f	1376	Base_tm *tm_ptr = tm_ptr_head;\
rohit3342	44:b9b067d0559f	1377	get_ack_l1(tm_ptr->next_TM);\
ee12b079	73:6c99294b7802	1378	tm_ptr = tm_ptr_head;\
ee12b079	73:6c99294b7802	1379	while( tm_ptr != NULL ){\
ee12b079	73:6c99294b7802	1380	int length = TM_SHORT_SIZE;\
shreeshas95	102:80c911a6e736	1381	if( GETshort_or_long_tm(tm_ptr) == SHORT_TM_CODE ){\
ee12b079	73:6c99294b7802	1382	length = TM_SHORT_SIZE;\
ee12b079	73:6c99294b7802	1383	}\
ee12b079	73:6c99294b7802	1384	else{\
ee12b079	73:6c99294b7802	1385	length = TM_LONG_SIZE;\
ee12b079	73:6c99294b7802	1386	}\
ee12b079	73:6c99294b7802	1387	/gPC.puts("Printing Call Sign, ACK_L1, TM list");/\
ee12b079	73:6c99294b7802	1388	for(int i = 0 ; i < length ; ++i){\
ee12b079	73:6c99294b7802	1389	/gPC.putc(tm_ptr->TM_string[i]);/\
ee12b079	73:6c99294b7802	1390	}\
ee12b079	73:6c99294b7802	1391	tm_ptr = tm_ptr->next_TM;\
ee12b079	80:b2155ba726c3	1392	}\
ee12b079	80:b2155ba726c3	1393	/Send only call sign, ACK_L1 to GS/\
ee12b079	73:6c99294b7802	1394	/snd_tm.head_pointer(tm_ptr_head);/\
ee12b079	95:42d6747900cb	1395	/transmit_adf;/\
ee12b079	73:6c99294b7802	1396	/DELETE THE TM AFTER USE/\
ee12b079	73:6c99294b7802	1397	tm_ptr = tm_ptr_head;\
ee12b079	73:6c99294b7802	1398	int overflowCountExecute = 0;\
ee12b079	73:6c99294b7802	1399	while(tm_ptr != NULL){\
ee12b079	73:6c99294b7802	1400	if( overflowCountExecute < TM_OVERFLOW_CONSTANT ){\
ee12b079	73:6c99294b7802	1401	Base_tm *temp = tm_ptr->next_TM;\
ee12b079	73:6c99294b7802	1402	delete tm_ptr;\
ee12b079	73:6c99294b7802	1403	tm_ptr = temp;\
ee12b079	73:6c99294b7802	1404	++overflowCountExecute;\
ee12b079	73:6c99294b7802	1405	}\
ee12b079	73:6c99294b7802	1406	else{\
ee12b079	210:f4acf895b598	1407	RESET_CDMS;\
ee12b079	73:6c99294b7802	1408	break;\
ee12b079	73:6c99294b7802	1409	}\
ee12b079	73:6c99294b7802	1410	}\
shreeshas95	4:104dd82c99b8	1411	break;\
shreeshas95	4:104dd82c99b8	1412	}\
shreeshas95	4:104dd82c99b8	1413	else if( (current_exec_status == TC_STATE_UNEXECUTED) \|\| (current_exec_status == TC_STATE_MARKED_RETRY) ){\
shreeshas95	4:104dd82c99b8	1414	/EXECUTION OF TC START/\
shreeshas95	4:104dd82c99b8	1415	uint8_t temp81 = 0x00;\
shreeshas95	4:104dd82c99b8	1416	isit_sdcard(current_TC, temp81);\
shreeshas95	4:104dd82c99b8	1417	if( temp81 == 0x00 ){\
ee12b079	210:f4acf895b598	1418	if (DEBUG)\
ee12b079	210:f4acf895b598	1419	gPC.printf("non sd card at %u\r\n", execute_psc);\
shreeshas95	4:104dd82c99b8	1420	/EXECUTION OF NON SD-CARD (BOTH OBOSC and CDMS functions)/\
shreeshas95	4:104dd82c99b8	1421	Base_tm *tm_ptr_head = NULL;\
shreeshas95	4:104dd82c99b8	1422	get_call_sign(tm_ptr_head);\
shreeshas95	4:104dd82c99b8	1423	Base_tm *put_tm_here = NULL;\
shreeshas95	4:104dd82c99b8	1424	uint8_t temp82 = 0x00;\
shreeshas95	4:104dd82c99b8	1425	uint8_t tempPAhot = 0x00;\
shreeshas95	4:104dd82c99b8	1426	isit_obosc(current_TC, temp82);\
shreeshas95	4:104dd82c99b8	1427	if(temp82 == 0x01){\
aniruddhv	12:ffdb29353058	1428	/gPC.printf("obosc tc inside normal tc at %u\r\n", execute_psc);/\
shreeshas95	4:104dd82c99b8	1429	/EXECUTION OF OBOSC TC/\
shreeshas95	4:104dd82c99b8	1430	/SKIP EXECUTION OF OBOSC HERE/\
aniruddhv	37:c9a739750806	1431	break;\
shreeshas95	4:104dd82c99b8	1432	}\
shreeshas95	4:104dd82c99b8	1433	else{\
rohit3342	23:c89376564196	1434	/gPC.printf("cdms relay tmtc at %u\r\n", execute_psc);/\
shreeshas95	4:104dd82c99b8	1435	/call CDMS_RLY_TMTC/\
shreeshas95	4:104dd82c99b8	1436	/CDMS_RLY_TMTC(current_TC, put_tm_here);/\
aniruddhv	52:0bd68655c651	1437	put_tm_here = FCTN_CDMS_RLY_TMTC(current_TC);\
shreeshas95	4:104dd82c99b8	1438	}\
shreeshas95	4:104dd82c99b8	1439	/DETECT ACK OR NACK/\
shreeshas95	4:104dd82c99b8	1440	uint8_t temp83 = 0x00;\
aniruddhv	262:752c8689944a	1441	detect_ack(put_tm_here, temp83);\
shreeshas95	4:104dd82c99b8	1442	if( temp83 == 0x01){\
shreeshas95	4:104dd82c99b8	1443	uint16_t temp16 = TC_STATE_SUCCESSFULLY_EXECUTED;\
shreeshas95	4:104dd82c99b8	1444	PUTexec_status(current_TC, temp16);\
shreeshas95	4:104dd82c99b8	1445	}\
aniruddhv	262:752c8689944a	1446	else if( temp83 == 0x03){\
aniruddhv	262:752c8689944a	1447	/gPC.puts("TC_STATE_EXECUTION_UNKNOWN");/\
aniruddhv	262:752c8689944a	1448	uint16_t temp16 = TC_STATE_EXECUTION_UNKNOWN;\
aniruddhv	262:752c8689944a	1449	PUTexec_status(current_TC, temp16);\
aniruddhv	262:752c8689944a	1450	}\
aniruddhv	262:752c8689944a	1451	else if( temp83 == 0x04){\
aniruddhv	262:752c8689944a	1452	/gPC.puts("TC_STATE_EXECUTION_UNKNOWN");/\
aniruddhv	262:752c8689944a	1453	uint16_t temp16 = TC_STATE_EXECUTION_FAILED;\
aniruddhv	262:752c8689944a	1454	PUTexec_status(current_TC, temp16);\
aniruddhv	262:752c8689944a	1455	uint8_t temp84 = GETpacket_seq_count(current_TC);\
aniruddhv	262:752c8689944a	1456	put_tm_here->TM_string[2] = temp84;\
aniruddhv	262:752c8689944a	1457	uint16_t crc16 = crc16_gen(put_tm_here->TM_string, 11);\
aniruddhv	262:752c8689944a	1458	put_tm_here->TM_string[11] = (crc16 & 0xFF00)>>8;\
aniruddhv	262:752c8689944a	1459	put_tm_here->TM_string[12] = (crc16 & 0x00FF);\
aniruddhv	262:752c8689944a	1460	}\
shreeshas95	4:104dd82c99b8	1461	else{\
rohit3342	23:c89376564196	1462	/gPC.puts("TC_STATE_EXECUTION_FAILED");/\
shreeshas95	4:104dd82c99b8	1463	uint16_t temp16 = TC_STATE_EXECUTION_FAILED;\
shreeshas95	4:104dd82c99b8	1464	PUTexec_status(current_TC, temp16);\
shreeshas95	4:104dd82c99b8	1465	}\
shreeshas95	4:104dd82c99b8	1466	/ABORT ON NACK AND TC LIST COMPLETED: UPDATE IN gMASTERSTATE/\
aniruddhv	262:752c8689944a	1467	if( ((GETexec_status(current_TC) == TC_STATE_EXECUTION_FAILED) \|\| (GETexec_status(current_TC) == TC_STATE_EXECUTION_UNKNOWN)) && (GETabort_on_nack(current_TC) == 1) ){\
shreeshas95	4:104dd82c99b8	1468	gMASTER_STATE = TCL_STATE_ABORTED;\
shreeshas95	4:104dd82c99b8	1469	}\
shreeshas95	15:1c1ca992b43b	1470	else if( execute_psc == (gTOTAL_VALID_TC-1) ){\
shreeshas95	4:104dd82c99b8	1471	/LAST TC IS EXECUTED/\
shreeshas95	4:104dd82c99b8	1472	gMASTER_STATE = TCL_STATE_COMPLETED;\
shreeshas95	4:104dd82c99b8	1473	}\
shreeshas95	4:104dd82c99b8	1474	/update last executed L1_ack/\
shreeshas95	4:104dd82c99b8	1475	if( put_tm_here != NULL ){\
aniruddhv	262:752c8689944a	1476	Base_tm *ptr_tm = put_tm_here;\
aniruddhv	262:752c8689944a	1477	while(ptr_tm->next_TM != NULL)\
aniruddhv	262:752c8689944a	1478	ptr_tm = ptr_tm->next_TM;\
aniruddhv	262:752c8689944a	1479	if( GETshort_or_long_tm(ptr_tm) == SHORT_TM_CODE ){\
shreeshas95	4:104dd82c99b8	1480	for(int i = 0 ; i < TM_SHORT_SIZE ; ++i){\
aniruddhv	262:752c8689944a	1481	gLAST_TM[i] = ptr_tm->TM_string[i];\
shreeshas95	4:104dd82c99b8	1482	gLAST_TM_SHORT_OR_LONG = SHORT_TM_CODE;\
shreeshas95	4:104dd82c99b8	1483	}\
shreeshas95	4:104dd82c99b8	1484	}\
shreeshas95	4:104dd82c99b8	1485	else{\
shreeshas95	4:104dd82c99b8	1486	for( int i = 0 ; i < TM_LONG_SIZE ; ++i ){\
aniruddhv	262:752c8689944a	1487	gLAST_TM[i] = ptr_tm->TM_string[i];\
shreeshas95	4:104dd82c99b8	1488	gLAST_TM_SHORT_OR_LONG = LONG_TM_CODE;\
shreeshas95	4:104dd82c99b8	1489	}\
shreeshas95	4:104dd82c99b8	1490	}\
shreeshas95	4:104dd82c99b8	1491	}\
aniruddhv	262:752c8689944a	1492	P_COM_HK;\
shreeshas95	4:104dd82c99b8	1493	Base_tm *tm_ptr = tm_ptr_head;\
shreeshas95	4:104dd82c99b8	1494	get_ack_l1(tm_ptr->next_TM);\
shreeshas95	4:104dd82c99b8	1495	int overflowCountExecute = 0;\
shreeshas95	4:104dd82c99b8	1496	while( tm_ptr->next_TM != NULL ){\
shreeshas95	4:104dd82c99b8	1497	if( overflowCountExecute < TM_OVERFLOW_CONSTANT ){\
shreeshas95	4:104dd82c99b8	1498	tm_ptr = tm_ptr->next_TM;\
shreeshas95	4:104dd82c99b8	1499	++overflowCountExecute;\
shreeshas95	4:104dd82c99b8	1500	}\
shreeshas95	4:104dd82c99b8	1501	else{\
ee12b079	210:f4acf895b598	1502	RESET_CDMS;\
shreeshas95	4:104dd82c99b8	1503	break;\
shreeshas95	4:104dd82c99b8	1504	}\
shreeshas95	4:104dd82c99b8	1505	}\
shreeshas95	4:104dd82c99b8	1506	tm_ptr->next_TM = put_tm_here;\
ee12b079	73:6c99294b7802	1507	tm_ptr = tm_ptr_head;\
ee12b079	73:6c99294b7802	1508	while( tm_ptr != NULL ){\
ee12b079	73:6c99294b7802	1509	int length = TM_SHORT_SIZE;\
shreeshas95	102:80c911a6e736	1510	if( GETshort_or_long_tm(tm_ptr) == SHORT_TM_CODE ){\
ee12b079	73:6c99294b7802	1511	length = TM_SHORT_SIZE;\
ee12b079	73:6c99294b7802	1512	}\
ee12b079	73:6c99294b7802	1513	else{\
ee12b079	73:6c99294b7802	1514	length = TM_LONG_SIZE;\
ee12b079	73:6c99294b7802	1515	}\
ee12b079	73:6c99294b7802	1516	/gPC.puts("Printing Call Sign, ACK_L1, TM list");/\
ee12b079	73:6c99294b7802	1517	for(int i = 0 ; i < length ; ++i){\
ee12b079	73:6c99294b7802	1518	/gPC.putc(tm_ptr->TM_string[i]);/\
ee12b079	73:6c99294b7802	1519	}\
ee12b079	73:6c99294b7802	1520	tm_ptr = tm_ptr->next_TM;\
ee12b079	73:6c99294b7802	1521	}\
ee12b079	80:b2155ba726c3	1522	/SEND call sign, ACK_L1, NON OBSRS TM TO GS/\
ee12b079	95:42d6747900cb	1523	snd_tm.head_pointer(tm_ptr_head);\
ee12b079	98:fd99ddc0e0a1	1524	gPC.puts("enter_adf\r\n");\
ee12b079	254:22d97475ca79	1525	transmit_adf;\
ee12b079	98:fd99ddc0e0a1	1526	gPC.puts("exit_adf\r\n");\
ee12b079	73:6c99294b7802	1527	/DELETE THE TM AFTER USE/\
ee12b079	73:6c99294b7802	1528	tm_ptr = tm_ptr_head;\
ee12b079	73:6c99294b7802	1529	overflowCountExecute = 0;\
ee12b079	73:6c99294b7802	1530	while(tm_ptr != NULL){\
ee12b079	73:6c99294b7802	1531	if( overflowCountExecute < TM_OVERFLOW_CONSTANT ){\
ee12b079	73:6c99294b7802	1532	Base_tm *temp = tm_ptr->next_TM;\
ee12b079	73:6c99294b7802	1533	delete tm_ptr;\
ee12b079	73:6c99294b7802	1534	tm_ptr = temp;\
ee12b079	73:6c99294b7802	1535	++overflowCountExecute;\
ee12b079	73:6c99294b7802	1536	}\
ee12b079	73:6c99294b7802	1537	else{\
ee12b079	210:f4acf895b598	1538	RESET_CDMS;\
ee12b079	73:6c99294b7802	1539	break;\
ee12b079	73:6c99294b7802	1540	}\
ee12b079	73:6c99294b7802	1541	}\
shreeshas95	0:f016e9e8d48b	1542	}\
shreeshas95	0:f016e9e8d48b	1543	else{\
ee12b079	210:f4acf895b598	1544	if (DEBUG)\
ee12b079	210:f4acf895b598	1545	gPC.printf("sd card at %u\r\n", execute_psc);\
shreeshas95	4:104dd82c99b8	1546	/EXECUTION OF SD-CARD DATA SENDING (OBSRS)/\
ee12b079	87:6e154fd43531	1547	execute_OBSRS_TC(current_TC);\
ee12b079	210:f4acf895b598	1548	gPC.puts("en_adf");\
ee12b079	254:22d97475ca79	1549	transmit_adf;\
ee12b079	210:f4acf895b598	1550	gPC.puts("ex_adf");\
shreeshas95	0:f016e9e8d48b	1551	}\
shreeshas95	0:f016e9e8d48b	1552	}\
shreeshas95	4:104dd82c99b8	1553	break;\
shreeshas95	0:f016e9e8d48b	1554	}\
shreeshas95	4:104dd82c99b8	1555	current_TC = current_TC->next_TC;\
shreeshas95	4:104dd82c99b8	1556	++overflowCount;\
shreeshas95	0:f016e9e8d48b	1557	}\
shreeshas95	4:104dd82c99b8	1558	else{\
ee12b079	210:f4acf895b598	1559	RESET_CDMS;\
shreeshas95	2:2caf2a9a13aa	1560	break;\
shreeshas95	2:2caf2a9a13aa	1561	}\
shreeshas95	2:2caf2a9a13aa	1562	}\
shreeshas95	6:79d422d1ed42	1563	if( gFLAGS & COM_SESSION_TIMEOUT_FLAG ){\
shreeshas95	6:79d422d1ed42	1564	break;\
shreeshas95	6:79d422d1ed42	1565	}\
shreeshas95	6:79d422d1ed42	1566	else if( gMASTER_STATE == TCL_STATE_ABORTED ){\
ee12b079	210:f4acf895b598	1567	if (DEBUG)\
ee12b079	210:f4acf895b598	1568	gPC.puts("ABORTING DUE TO ABORT ON NACK\r\n");\
shreeshas95	4:104dd82c99b8	1569	/EXITED DUE TO ABORT ON NACK:/\
aniruddhv	262:752c8689944a	1570	COM_TX_CNTRL = 0;\
shreeshas95	2:2caf2a9a13aa	1571	RX1M.attach(&rx_read, Serial::RxIrq);\
shreeshas95	2:2caf2a9a13aa	1572	gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);\
shreeshas95	0:f016e9e8d48b	1573	break;\
shreeshas95	2:2caf2a9a13aa	1574	}\
aniruddhv	262:752c8689944a	1575	else if( (gFLAGS & COM_PA_HOT_FLAG) \|\| (gFLAGS & COM_PA_OC_FLAG) ){\
shreeshas95	4:104dd82c99b8	1576	/PA HOT: WAIT FOR TIMEOUT/\
shreeshas95	4:104dd82c99b8	1577	gCOM_PA_COOLING_TIMEOUT.attach(&after_cooling_pa, COM_PA_COOLING_TIME_LIMIT);\
aniruddhv	262:752c8689944a	1578	COM_TX_CNTRL = 0;\
shreeshas95	4:104dd82c99b8	1579	RX1M.attach(&rx_read, Serial::RxIrq);\
shreeshas95	4:104dd82c99b8	1580	gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);\
shreeshas95	2:2caf2a9a13aa	1581	break;\
shreeshas95	2:2caf2a9a13aa	1582	}\
ee12b079	210:f4acf895b598	1583	if (DEBUG)\
ee12b079	210:f4acf895b598	1584	gPC.printf("successflly executed %u tc\r\n", execute_psc);\
shreeshas95	0:f016e9e8d48b	1585	}\
shreeshas95	6:79d422d1ed42	1586	if( (gMASTER_STATE == TCL_STATE_COMPLETED) \|\| (gFLAGS & COM_SESSION_TIMEOUT_FLAG) ){\
ee12b079	210:f4acf895b598	1587	if (DEBUG)\
ee12b079	210:f4acf895b598	1588	gPC.printf("completed or session timed out: %x\r\n", gMASTER_STATE);\
shreeshas95	5:ab276a17ca07	1589	/COMPLETED EXECUTION OF TC/\
shreeshas95	5:ab276a17ca07	1590	gMASTER_STATE = TCL_STATE_COMPLETED;\
chaithanyarss	260:65e1ace927fd	1591	COM_POWER_OFF_TX;\
shreeshas95	5:ab276a17ca07	1592	reset_all;\
aniruddhv	263:3b872778b8c7	1593	/ENABLE THREADS/\
ee12b079	245:da9d1bd999da	1594	gPAY_SPI->bulkRead_resume(&payload_isr_fun);\
ee12b079	246:565458eefd94	1595	HK_counter->start(10000);\
shreeshas95	5:ab276a17ca07	1596	gSESSION_TIMEOUT.detach();\
shreeshas95	5:ab276a17ca07	1597	gFLAGS = gFLAGS & (~COM_MNG_TMTC_RUNNING_FLAG);\
shreeshas95	5:ab276a17ca07	1598	gFLAGS = gFLAGS & (~COM_SESSION_FLAG);\
shreeshas95	5:ab276a17ca07	1599	}\
shreeshas95	0:f016e9e8d48b	1600	}

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Mbed OS support:	Mbed 2 deprecated
Created:	24 Jul 2016
Imports:	3
Forks:	0
Commits:	276
Dependents:	0
Dependencies:	4
Followers:	1

COM_MNG_TMTC.h@264:f7d8f9f361e3, 2016-07-14 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning