//*------------------------------------------------------------------------------------------------
//* 文件名			   : os_cpu_c.c
//* 功能描述		   : 用戶自定義的鉤子函數及任務堆棧初始化函數
//* 作者    		   : 焦海波
//* 版本			   : 0.1
//* 建立日期、時間	   : 2007/05/05 11:50
//* 最近修改日期、時間 : 
//* 修改原因		   : 
//*------------------------------------------------------------------------------------------------
//*------------------------------------------ 頭文件 ----------------------------------------------
#include	"/at91sam7x256/include/AT91SAM7X256.h"

#define		OS_CPU_GLOBALS
#include	"/uCOS-II/ucos_ii.h"
//*================================================================================================
//*　　　　　　　　　　　　　　　　　　　　　函　數　區
//*================================================================================================
//*------------------------------------------------------------------------------------------------
//* 函數名稱 : OSTaskStkInit
//* 功能描述 : 初始化各任務堆棧，該函數由OSTaskCreate()或OSTaskCreateExt()調用
//* 入口參數 : <pTaskEntry>[in] 指向任務的入口點
//*          :      <pvArg>[in] 傳遞給任務的參數
//*          :    <pstkTos>[in] 指向任務堆棧棧頂的指針
//*          :     <u16Opt>[in] 保留
//* 出口參數 : 返回當前的任務堆棧指針
//*------------------------------------------------------------------------------------------------
#define     ARM_MODE_SVC_ARM        0x13
#define     ARM_MODE_SVC_THUMB      0x33
OS_STK *OSTaskStkInit(void(*pTaskEntry)(void *pvArg), void *pvArg, OS_STK *pstkTos, INT16U u16Opt)
{
	OS_STK *SP;
	
	u16Opt = u16Opt;							//* 避免編譯器警告信息
	
	SP = pstkTos;
	*SP = (INT32U)((INT32U)pTaskEntry & ~1); 	//* PC, 程序的入口
	*(--SP) = (INT32U)0x14141414;            	//* LR, 即R14
	*(--SP) = (INT32U)0x12121212;            	//* R12
	*(--SP) = (INT32U)0x11111111;            	//* R11
	*(--SP) = (INT32U)0x10101010;            	//* R10
	*(--SP) = (INT32U)0x09090909;            	//* R9
	*(--SP) = (INT32U)0x08080808;            	//* R8
	*(--SP) = (INT32U)0x07070707;            	//* R7
	*(--SP) = (INT32U)0x06060606;            	//* R6
	*(--SP) = (INT32U)0x05050505;            	//* R5
	*(--SP) = (INT32U)0x04040404;            	//* R4
	*(--SP) = (INT32U)0x03030303;            	//* R3
	*(--SP) = (INT32U)0x02020202;            	//* R2
	*(--SP) = (INT32U)0x01010101;            	//* R1
	*(--SP) = (INT32U)pvArg;	             	//* R0, ARM使用R0-R3寄存器傳遞參數，由于只有一個參數，所以這里只使用了R0寄存器
	
	if((INT32U)pTaskEntry & 0x00000001)      	//* 如果運行在Thumb模式
	{
		*(--SP) = (INT32U)ARM_MODE_SVC_THUMB;	//* CPSR為Thumb模式
	}
	else
	{
		*(--SP) = (INT32U)ARM_MODE_SVC_ARM;		//* CPSR為Thumb模式
	}
	
	return SP;
}
//*------------------------------------------------------------------------------------------------
//* 函數名稱 : OSStartPIT
//* 功能描述 : 開啟內核調度中斷
//* 入口參數 : 無
//* 出口參數 : 無
//*------------------------------------------------------------------------------------------------
//* 獲取定時器間隔計數值
#define	__macGetCount(cDivVal)		(((48000000/cDivVal)/1000)*(1000/OS_TICKS_PER_SEC) - 1)
void OSStartPIT(void)
{
	INT32U	u32PIVR;
	
	u32PIVR = AT91C_BASE_PITC->PITC_PIVR;		//* 再讀一次，以確保PIT啟動后不立即觸發中斷

	AT91C_BASE_PITC->PITC_PIMR = AT91C_PITC_PITEN | AT91C_PITC_PITIEN | __macGetCount(16);
}
//*------------------------------------------------------------------------------------------------
//* 函數名稱 : OSIntCtxSw
//* 功能描述 : 改變任務切換標志以通知進行任務切換
//* 入口參數 : 無
//* 出口參數 : 無
//*------------------------------------------------------------------------------------------------
void OSIntCtxSw(void)
{
	blIsNeedCtxSw = OS_TRUE;
}
//*------------------------------------------------------------------------------------------------
//* 函數名稱 : OSTickISR
//* 功能描述 : 內核調度中斷ISR
//* 入口參數 : 無
//* 出口參數 : 無
//*------------------------------------------------------------------------------------------------
void OSTickISR(void)
{
	INT32U	u32PIVR;

	OSTimeTick();
	
	u32PIVR = AT91C_BASE_PITC->PITC_PIVR;
}
//*------------------------------------------------------------------------------------------------
//* 函數名稱 : OSInitHookBegin
//* 功能描述 : 系統初始化開始鉤子函數
//* 入口參數 : 無
//* 出口參數 : 無
//*------------------------------------------------------------------------------------------------
void OSInitHookBegin(void)
{
	blIsNeedCtxSw = OS_FALSE;
}
//*------------------------------------------------------------------------------------------------
//* 函數名稱 : OSInitHookEnd
//* 功能描述 : 系統初始化結束鉤子函數
//* 入口參數 : 無
//* 出口參數 : 無
//*------------------------------------------------------------------------------------------------
void OSInitHookEnd(void)
{
}
//*------------------------------------------------------------------------------------------------
//* 函數名稱 : OSTaskCreateHook
//* 功能描述 : 任務建立鉤子函數
//* 入口參數 : <pTcb>[in/out] 指向任務正在建立時的任務控制塊的指針
//* 出口參數 : 無
//*------------------------------------------------------------------------------------------------
void OSTaskCreateHook(OS_TCB *pTcb)
{
	pTcb = pTcb;
}
//*------------------------------------------------------------------------------------------------
//* 函數名稱 : OSTaskDelHook
//* 功能描述 : 任務刪除鉤子函數
//* 入口參數 : <pTcb>[in/out] 指向任務正在刪除時的任務控制塊的指針
//* 出口參數 : 無
//*------------------------------------------------------------------------------------------------
void OSTaskDelHook(OS_TCB *pTcb)
{
	pTcb = pTcb;
}
//*------------------------------------------------------------------------------------------------
//* 函數名稱 : OSTaskIdleHook
//* 功能描述 : 空閑任務鉤子函數
//* 入口參數 : 無
//* 出口參數 : 無
//*------------------------------------------------------------------------------------------------
void OSTaskIdleHook(void)
{
}
//*------------------------------------------------------------------------------------------------
//* 函數名稱 : OSTaskStatHook
//* 功能描述 : 統計任務鉤子函數
//* 入口參數 : 無
//* 出口參數 : 無
//*------------------------------------------------------------------------------------------------
void OSTaskStatHook(void)
{
}
//*------------------------------------------------------------------------------------------------
//* 函數名稱 : OSTaskSwHook
//* 功能描述 : 任務切換鉤子函數
//* 入口參數 : 無
//* 出口參數 : 無
//*------------------------------------------------------------------------------------------------
void OSTaskSwHook(void)
{
}
//*------------------------------------------------------------------------------------------------
//* 函數名稱 : OSTCBInitHook
//* 功能描述 : 任務控制塊初始化鉤子函數
//* 入口參數 : <pTcb>[in/out] 指向任務正在建立時的任務控制塊（TCB）的指針
//* 出口參數 : 無
//*------------------------------------------------------------------------------------------------
void OSTCBInitHook(OS_TCB *pTcb)
{
	pTcb = pTcb;
}
//*------------------------------------------------------------------------------------------------
//* 函數名稱 : OSTimeTickHook
//* 功能描述 : 時鐘節拍鉤子函數
//* 入口參數 : 無
//* 出口參數 : 無
//*------------------------------------------------------------------------------------------------
void OSTimeTickHook(void)
{
}