/* LED2 , LED3 initialize*/
#include "vxworks.h"
#include "D:/tornado/target/h/drv/multi/ppc860siu.h"
/*#include "taskLib.h"*/
#include "tickLib.h"

void myTimer(int); 
void LedMain(int ticks, int counts,int ledNum)
{
	int i,j;
	int immrVal = vxImmrGet();
/*
   *PCPAR(immrVal) &= ~(0x00c0);
   *PCDIR(immrVal) |= 0x00c0;
   *PCSO(immrVal)  &= ~(0x00c0);
	*PDPAR(immrVal) &= ~(0x1000);
	*PDDIR(immrVal) |= 0x1000;
 	*PCDAT(immrVal) |= 0x00c0;
	*PDDAT(immrVal) |= 0x1000;  */
	for( i =0; i<counts; i++)
   {
   	switch(ledNum)
		{
		case 1:
			*PCDAT(immrVal) |= 0x0040;
			myTimer(ticks);
			*PCDAT(immrVal) &= ~(0x0040);
			myTimer(ticks);
			break;
		case 2:   			
			*PCDAT(immrVal) |= 0x0080;
			myTimer(ticks);
			*PCDAT(immrVal) &= ~(0x0080);
			myTimer(ticks);
			break;
		case 3:
			*PDDAT(immrVal) |= 0x1000;
			myTimer(ticks);
			*PDDAT(immrVal) &= ~(0x1000);
			myTimer(ticks);
			break;
		default:break;
		}
   }
}	

void myTimer(int ticks)
{
	UINT32 timeout;
	timeout = tickGet () + ticks;
	while (tickGet () < timeout){;}
}