#include "includes.h"
#include "hc08jb8.h"


#define LED1	0x04
#define LED2	0x08
#define TASK_STK_SIZE  40


#pragma DATA_SEG SHORT MY_ZEROPAGE

static INT8U	Task1Stk[TASK_STK_SIZE];
static INT8U	Task2Stk[TASK_STK_SIZE];

INT8U	Task1a;
INT8U	Task2a;
INT8U	Led1N;
INT8U	Led2N;


void Delay(INT16U ddd)
{
	INT16U i;
	for(i=0;i<ddd;i++)
	{
		asm nop;
	}
}	

void Task1(void* pdata);
void Task2(void* pdata);
void HardwareInit(void);


void Task1(void* pdata)
{
	pdata = pdata;
	for(;;)
	{
		Task1a++;
		Task1a++;
		Task1a++;
		PTA = PTA^LED1;
//		OSTimeDly(101);
		Delay(60000);
		Task1a++;
		Task1a++;
		Task1a++;
	}
}

void Task2(void* pdata)
{
	pdata = pdata;
	for(;;)
	{
		Task2a++;
		Task2a++;
		Task2a++;
		Task2a++;
		Task2a++;
//		PTA = PTA^LED2;
		asm{
			inc	Led2N
			brset	0,Led2N,_Led2Off
		 _Led2On:
			bset	3,0
			bra	_Led2Com
		 _Led2Off:
			bclr    3,0
		 _Led2Com:
			nop
		    };
		OSTimeDly(200);
		Task2a++;
		Task2a++;
		Task2a++;
		Task2a++;
	}
}

void HardwareInit(void)
{
	POCR = 0xFF;
	PTA  = 0xFF;
	DDRA = 0xFF;
	DDRB = 0x00;
	DDRC = 0x00;
	DDRD = 0x00;
	UIR0 = 0x00;
	UIR1 = 0x00;
	UIR2 = 0x00;
	KBIER = 0x00;

}
void main(void)
{
	HardwareInit();
	OSInit();
	OSTaskCreate(Task1, (void*)0, (void*)&Task1Stk[TASK_STK_SIZE-1], 0);
	OSTaskCreate(Task2, (void*)0, (void*)&Task2Stk[TASK_STK_SIZE-1], 1);
//	TimerInit();
//	OSStart();
	Task1(0);
}

#pragma TRAP_PROC
void USBISR(void)
{
}
#pragma TRAP_PROC
void IRQISR(void)
{
}
#pragma TRAP_PROC
void CH0ISR(void)
{
}
#pragma TRAP_PROC
void CH1ISR(void)
{
}
#pragma TRAP_PROC
void KBDISR(void)
{
}