LPCManager: LPCtarget/plc_LPC_main.c@86fb7dc2b54e (annotated)

0 51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	1	/**
29 86fb7dc2b54e Untested support for logging Drauoude Tnaressit parents: 0 diff changeset	2	* LPC specific code
0 51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	3	**/
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	4
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	5	#include <string.h>
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	6	#include <app_glue.h>
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	7
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	8	extern unsigned long idLen;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	9	extern unsigned char *idBuf;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	10
29 86fb7dc2b54e Untested support for logging Drauoude Tnaressit parents: 0 diff changeset	11	static unsigned char RetainedIdBuf[128] NONVOLATILE;
86fb7dc2b54e Untested support for logging Drauoude Tnaressit parents: 0 diff changeset	12	static unsigned char retain_buffer[RETAIN_BUFFER_SIZE] NONVOLATILE;
86fb7dc2b54e Untested support for logging Drauoude Tnaressit parents: 0 diff changeset	13
86fb7dc2b54e Untested support for logging Drauoude Tnaressit parents: 0 diff changeset	14	#define LOG_BUFFER_SIZE (1<<10) /1Ko/
86fb7dc2b54e Untested support for logging Drauoude Tnaressit parents: 0 diff changeset	15	#define LOG_BUFFER_ATTRS NONVOLATILE
0 51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	16
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	17	static int debug_locked = 0;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	18	static int _DebugDataAvailable = 0;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	19	static unsigned long __debug_tick;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	20
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	21	void LPC_GetTime(IEC_TIME*);
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	22	void LPC_SetTimer(unsigned long long next, unsigned long long period);
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	23
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	24	long AtomicCompareExchange(long* atomicvar,long compared, long exchange)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	25	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	26	/* No need for real atomic op on LPC,
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	27	* no possible preemption between debug and PLC */
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	28	long res = *atomicvar;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	29	if(res == compared){
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	30	*atomicvar = exchange;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	31	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	32	return res;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	33	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	34
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	35	void PLC_GetTime(IEC_TIME *CURRENT_TIME)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	36	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	37	/* Call target GetTime function */
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	38	LPC_GetTime(CURRENT_TIME);
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	39	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	40
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	41	void PLC_SetTimer(unsigned long long next, unsigned long long period)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	42	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	43	LPC_SetTimer(next, period);
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	44	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	45
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	46	int startPLC(int argc,char **argv)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	47	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	48	if(__init(argc,argv) == 0){
29 86fb7dc2b54e Untested support for logging Drauoude Tnaressit parents: 0 diff changeset	49	PLC_SetTimer(0, Ttick);
0 51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	50	return 0;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	51	}else{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	52	return 1;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	53	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	54	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	55
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	56	int TryEnterDebugSection(void)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	57	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	58	if(!debug_locked && __DEBUG){
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	59	debug_locked = 1;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	60	return 1;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	61	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	62	return 0;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	63	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	64
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	65	void LeaveDebugSection(void)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	66	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	67	debug_locked = 0;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	68	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	69
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	70	int stopPLC(void)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	71	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	72	__cleanup();
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	73	return 0;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	74	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	75
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	76	/* from plc_debugger.c */
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	77	int WaitDebugData(unsigned long *tick)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	78	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	79	/* no blocking call on LPC */
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	80	if(_DebugDataAvailable && !debug_locked){
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	81	/* returns 0 on success */
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	82	*tick = __debug_tick;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	83	_DebugDataAvailable = 0;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	84	return 0;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	85	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	86	return 1;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	87	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	88
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	89	/* Called by PLC thread when debug_publish finished
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	90	* This is supposed to unlock debugger thread in WaitDebugData*/
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	91	void InitiateDebugTransfer(void)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	92	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	93	/* remember tick */
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	94	__debug_tick = __tick;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	95	_DebugDataAvailable = 1;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	96	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	97
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	98	void suspendDebug(int disable)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	99	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	100	/* Prevent PLC to enter debug code */
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	101	__DEBUG = !disable;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	102	debug_locked = !disable;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	103	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	104
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	105	void resumeDebug(void)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	106	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	107	/* Let PLC enter debug code */
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	108	__DEBUG = 1;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	109	debug_locked = 0;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	110	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	111
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	112	void ValidateRetainBuffer(void)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	113	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	114	memcpy(RetainedIdBuf, idBuf, idLen);
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	115	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	116
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	117	void InValidateRetainBuffer(void)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	118	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	119	/* invalidate that buffer */
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	120	RetainedIdBuf[0] = 0;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	121	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	122
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	123	int CheckRetainBuffer(void)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	124	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	125	/* compare RETAIN ID buffer with MD5 */
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	126	/* return true if identical */
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	127	int res = memcmp(RetainedIdBuf, idBuf, idLen) == 0;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	128	return res;
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	129	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	130
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	131	void Retain(unsigned int offset, unsigned int count, void *p)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	132	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	133	if(offset + count < RETAIN_BUFFER_SIZE)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	134	/* write in RETAIN buffer at offset*/
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	135	memcpy(&retain_buffer[offset], p, count);
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	136	}
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	137
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	138	void Remind(unsigned int offset, unsigned int count, void *p)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	139	{
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	140	if(offset + count < RETAIN_BUFFER_SIZE)
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	141	/* read at offset in RETAIN buffer */
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	142	memcpy(p, &retain_buffer[offset], count);
51f5a3138405 Initial commit, LPC files taken out of beremiz revision 915be999f3f0 Edouard Tisserant parents: diff changeset	143	}

author	Drauoude Tnaressit
	Tue, 19 Mar 2013 17:22:27 +0900
changeset 29	86fb7dc2b54e
parent 0	51f5a3138405
child 30	9cd6bc93ed89
permissions	-rwxr-xr-x