FreeRTOS/Demo/MB91460_Softune/SRC/utility/taskutility.c

/* THIS SAMPLE CODE IS PROVIDED AS IS AND IS SUBJECT TO ALTERATIONS. FUJITSU */
/* MICROELECTRONICS ACCEPTS NO RESPONSIBILITY OR LIABILITY FOR ANY ERRORS OR */
/* ELIGIBILITY FOR ANY PURPOSES.											 */
/*				 (C) Fujitsu Microelectronics Europe GmbH				  */
/*------------------------------------------------------------------------
  taskutility.C
  - 
-------------------------------------------------------------------------*/

 
/*************************@INCLUDE_START************************/
#include "mb91467d.h"
#include "vectors.h"
#include "FreeRTOS.h"
#include "task.h"


static void vUART5Task( void *pvParameters );

/**************************@INCLUDE_END*************************/
/*********************@GLOBAL_VARIABLES_START*******************/
const char ASCII[] = "0123456789ABCDEF";

xTaskHandle UART_TaskHandle;

void InitUart5(void)
{
	//Initialize UART asynchronous mode
	BGR05 = 1666; //  9600 Baud @ 16MHz
	
	SCR05 = 0x17;	// 7N2
	SMR05 = 0x0d;	// enable SOT3, Reset, normal mode
	SSR05 = 0x00;	// LSB first
	
	PFR19_D4 = 1;	// enable UART
	PFR19_D5 = 1;	// enable UART

	//EPFR19 = 0x00;   // enable UART
	
	SSR05_RIE = 1;
}

void Putch5(char ch)		 /* sends a char */
{
  while (SSR05_TDRE == 0);	/* wait for transmit buffer empty 	*/
  TDR05 = ch;				 /* put ch into buffer			*/
}

char Getch5(void)			/* waits for and returns incomming char 	*/
{
  volatile unsigned ch;
  
  while(SSR05_RDRF == 0);	 /* wait for data received  	*/
  if (SSR05_ORE)			  /* overrun error 		*/
  {
	ch = RDR05;			  /* reset error flags 		*/
	return (char)(-1);
  }
  else
  return (RDR05);			/* return char 			*/
}

void Puts5(const char *Name5)  /* Puts a String to UART */
{
  volatile portSHORT i,len;
  len = strlen(Name5);
	
  for (i=0; i<strlen(Name5); i++)   /* go through string					 */
  {
	if (Name5[i] == 10)
	  Putch5(13);
	Putch5(Name5[i]);			  /* send it out						   */
  }
}

void Puthex5(unsigned long n, unsigned char digits)
{
   unsigned portCHAR digit=0,div=0,i;

   div=(4*(digits-1));	/* init shift divisor */
   for (i=0;i<digits;i++)
   {
	 digit = ((n >> div)&0xF); /* get hex-digit value */
	 Putch5(digit + ((digit < 0xA) ? '0' : 'A' - 0xA));
	 div-=4;	 		/* next digit shift */
   }
}

void Putdec5(unsigned long x, int digits)
{
	portSHORT i;
	portCHAR buf[10],sign=1;
	
	if (digits < 0) {	 /* should be print of zero? */
	  digits *= (-1);
	  sign =1;
	}  
	buf[digits]='\0';			/* end sign of string */
	
	for (i=digits; i>0; i--) {
		buf[i-1] = ASCII[x % 10];
		x = x/10;
	}

	if ( sign )
	{
	  for (i=0; buf[i]=='0'; i++) { /* no print of zero */
		if ( i<digits-1)
			buf[i] = ' ';
	  }		
	}
	
	Puts5(buf);					/* send string */
}

void vUtilityStartTraceTask( unsigned portBASE_TYPE uxPriority )
{
	portENTER_CRITICAL();
	InitUart5();
	portENTER_CRITICAL();
	xTaskCreate( vUART5Task , ( signed portCHAR * ) "UART4",  ( unsigned portSHORT ) 2048, ( void * ) NULL, uxPriority, &UART_TaskHandle );
}

static void vUART5Task( void *pvParameters )
{
	portCHAR tasklist_buff[512], trace_buff[512];
	unsigned portLONG trace_len, j;
	
	unsigned portCHAR ch;	
	
	Puts5("\n -------------MB91467D FreeRTOS DEMO Task List and Trace Utility----------- \n");

	for(;;)
	{
		Puts5("\n\rPress any of the following keys for the corresponding functionality: ");

		Puts5("\n\r1: To call vTaskList() and display current task status ");

		Puts5("\n\r2: To call vTaskStartTrace() and to display trace results once the trace ends");

		SSR05_RIE=1;

		vTaskSuspend(NULL);

	 	ch=Getch5();

		switch ( ch ) 
		{
			case '1':
				vTaskList( ( signed char * ) tasklist_buff );
				Puts5("\n\rThe current task list is as follows....");
				Puts5("\n\r----------------------------------------------");
				Puts5("\n\rName		  State  Priority  Stack   Number");
				Puts5("\n\r----------------------------------------------");
				Puts5(tasklist_buff);
				Puts5("\r----------------------------------------------");
				break;

			case '2':
				vTaskStartTrace(( signed char * ) trace_buff, 512);
				Puts5("\n\rThe trace started!!");
				vTaskDelay( ( portTickType ) 450);
				trace_len = ulTaskEndTrace();
				Puts5("\n\rThe trace ended!!");
				Puts5("\n\rThe trace is as follows....");
				Puts5("\n\r--------------------------------------------------------");
				Puts5("\n\r  Tick	 | Task Number  |	 Tick	 | Task Number  |");
				Puts5("\n\r--------------------------------------------------------\n\r");
				for( j = 0 ; j < trace_len ; j++ )
				{
					Puthex5(trace_buff[j],2);
					if(j%4==3) Puts5("   |   ");
					if(j%16==15) Puts5("\n");
				}
				Puts5("\r--------------------------------------------------------");
				break;
				
			default:
				break;
		}
		Puts5("\n");
	}
}

__interrupt void UART5_RxISR ( void )
{
	SSR05_RIE=0;
	vTaskResume( UART_TaskHandle );
}