main_entry.c.bak

ARM7下的UC0S原代码

#include <stdio.h>
#include"s3c4510b_add.h"

#define IRQVector	((unsigned *)0x18)

extern int  Angel_IRQ_Address;
extern void handler_irq(void);
void InitUART(int Port,int Baudrate);
void PrintUART(int Port,char *s);
#define SYSCFG	0x03ff0000


#define INTMSK							((volatile unsigned *)(SYSCFG+0x4008))
#define INT_GLOBAL						(21)

#define TMOD				((volatile unsigned *)(SYSCFG+0x6000))  // timer mode register
#define TDATA0				((volatile unsigned *)(SYSCFG+0x6004))
#define TCNT0				((volatile unsigned *)(SYSCFG+0x600c))

#define COUNTDOWN	0x01effff0;

static int counter = 0;


void  timer_irq (void) 
{ 

	// *TMOD	= 0; 
	*INTPND	= 1 << 10;
	*TDATA0	= COUNTDOWN; // reset interrupt

   // -- toggle the LED D4 to show timer interrupt...
   
    PrintUART( "\n^ time-ticks = %d !\n", counter );
    counter = counter + 1;


	// -- re-enable interrupts ...

	// *TMOD	= 1;
	 *(volatile int*)INTMSK &= ~((1 << INT_GLOBAL) | (1 <<10) | (1<<0));
	 
} 


static void irq_installhandler (unsigned routine, unsigned *vector) 
{
unsigned old_vector_value = 0;
unsigned *absolute;   
  
   old_vector_value = 0;
   
   old_vector_value  = *vector;  	 // Get old vector contents ....................
   old_vector_value ^= 0xe59ff000;	 // Mask off the instruction to get the offset
 
	// ** calculate absolute address

   absolute	     	= (unsigned *) (0x18 + old_vector_value+0x8); 
					// IRQ Address
   Angel_IRQ_Address 	= *absolute; 	// chain Angel Interrupt Handler	  
   *absolute		= routine; 	// IRQ handler

}

void timer_init (void)
{
  *TMOD		= 0;
  *INTPND 	= 0x00000000; 	// Clear pending interrupts .............
}

void timer_start (void)
{	
  *TDATA0		 = COUNTDOWN;	// reload CT .......................
  *TMOD 		|= 0x1;			// enable interval interrupt ...................
  
  *(volatile int*)INTMSK &= ~((1 << INT_GLOBAL) | (1 <<10) | (1<<0));
}

#include "includes.h"

void OSTickISR(void);


void Sleep(INT16U uSec)
{
	OSTimeDly((INT16U) (uSec));
}

void Task1(void * pParam)
{
	
	
	timer_init();
	timer_start();	
	
	while(1)	
	{
		IOTMOD=0xff;
		IOTDATA=0xff;
		PrintUART(1,"@\n" );
		PrintUART(1,"@\n" );
		PrintUART(1,"@ task 1 running ... \n" );
		PrintUART(1,"@    Q__Q    \n" );
		PrintUART(1,"@   /____\\   \n" );
		PrintUART(1,"@   \\____/   \n" );
		PrintUART(1,"@    /\\/\\    \n" );
		PrintUART(1,"@ __(\\\\//)__ \n" );
		PrintUART(1,"@ >__/ww\\__< \n" );
		PrintUART(1,"@\n" );
		PrintUART(1,"@ go to sleep 10 time-ticks\n" );
		PrintUART(1,"@\n" );
		PrintUART(1,"@\n" );
		Sleep(2);
	}

}

/* Task2 print_user_input */
void Task2(void * pParam)
{
	while(1)	
	{
		PrintUART(1,"+++ \n" );
		PrintUART(1,"+++ \n" );
		PrintUART(1,"+++  task 2 running ... \n" );
		PrintUART(1,"+++  ╭︿︿︿╮ \n" );
		PrintUART(1,"+++ {/　o　o　\\} \n" );
		PrintUART(1,"+++  (　(oo)　) \n" );
		PrintUART(1,"+++      ︶ \n" );
		PrintUART(1,"+++ \n" );
		PrintUART(1,"+++  go to sleep 5 time-ticks\n" );
		PrintUART(1,"+++ \n" );
		PrintUART(1,"+++ \n" );
		Sleep(2);
	}
}


#define	N_TASKS			3	// Number of tasks
#define	TASK_STK_SIZE	1024		// Stack size, in sizeof OS_STK, or int 32bit
OS_STK	TaskStk[N_TASKS][TASK_STK_SIZE];	// Tasks stacks

void C_Entry(void)
{
	int	task_1 = 0;
	int	task_2 = 1;
	InitUART(1,0x500);  //19200bps  50MHz 0=COM1;1=COM2
	counter = 0;
	PrintUART(1,"start kernel ok!\n" );
	irq_installhandler ((unsigned)OSTickISR, IRQVector);
	
	OSInit();
	
	OSTaskCreate(Task1, &task_1, &TaskStk[0][TASK_STK_SIZE-1], 0);
	OSTaskCreate(Task2, &task_2, &TaskStk[1][TASK_STK_SIZE-1], 1);
	
	OSStart();
}
	
void PrintUART(int Port,char *s)
{
	if(Port==0)
		for(;*s!='\0';s++)
			{for(;(!(USTAT0&0x40)););
			UTXBUF0=*s;}
	if(Port==1)
		for(;*s!='\0';s++)
			{for(;(!(USTAT1&0x40)););
			UTXBUF1=*s;}			
}


void InitUART(int Port,int Baudrate)
{
	if(Port==0)
		{ULCON0=0x03;
		UCON0=0x09;
		UBRDIV0=Baudrate;   
		}
	if(Port==1)
		{ULCON1=0x03;
		UCON1=0x09;
		UBRDIV1=Baudrate;   
		}

}