#include <stdio.h>
#include "INCLUDES.H"

#define OS_TASK_STK_SIZE 128

OS_STK g_TestTaskStack[2][OS_TASK_STK_SIZE];

void TestTask0(void *pdata)
{
// Install IRQ Handler
	*(volatile unsigned *)0x18 = (unsigned)&OSTickISR - 0x20 >> 2 | 0xEA000000;
// Set up Timer
	*(volatile unsigned *)0x0a800000 = 0x4000;
	*(volatile unsigned *)0x0a800008 = 0xc0;
// Enable Interrupt Controller
	*(volatile unsigned *)0x0a000008 = 0x10;

	while(1)
	{
		OSTimeDly(800);
		*(volatile char *)0x0d800020 = '\n';
	}
}

void TestTask1(void *pdata)
{
	while(1)
	{
		*(volatile char *)0x0d800020 = 'X';
		OSTimeDly(100);
	}
}

int main()
{
	OSInit();
	OSTaskCreate(TestTask0, NULL, g_TestTaskStack[0] + (OS_TASK_STK_SIZE - 1), 0);
	OSTaskCreate(TestTask1, NULL, g_TestTaskStack[1] + (OS_TASK_STK_SIZE - 1), 1);
	OSStart();

	return(0);
}