#include "Board.h"

// 下面函數直接通過異常向量調用，編寫時必須采用ARM模式
extern void AT91F_Spurious_handler(void);
extern void AT91F_Default_IRQ_handler(void);
extern void AT91F_Default_FIQ_handler(void);

/******************************************************************************************************
 * 說明：AT91F_LowLevelInit函數，執行底層硬件初始化。
 * 參數：無
 * 返回值：無
*******************************************************************************************************/
void AT91F_LowLevelInit( void) {
     int            i;
     AT91PS_PMC     pPMC = AT91C_BASE_PMC;
     AT91C_BASE_MC->MC_FMR = AT91C_MC_FWS_1FWS ;     // 設置Flash寫狀態，在30MHz或40MHz時以單周期訪問
     AT91C_BASE_WDTC->WDTC_WDMR= AT91C_WDTC_WDDIS;   // 禁止看門狗

     /******* 設置 MCK 為 47 923 200 *******/
     // 1. 允許主振蕩器：
                // SCK = 1/32768 = 30.51 us
    	        // Start up time = 8 * 6 / SCK = 56 * 30.51 = 1,46484375 ms
       pPMC->PMC_MOR = (( AT91C_CKGR_OSCOUNT & (0x06 <<8) | AT91C_CKGR_MOSCEN ));
        while(!(pPMC->PMC_SR & AT91C_PMC_MOSCS));     // 等待啟動
     // 2. 檢查振蕩器頻率(可選)
     // 3. 設置 PLL 及除數
		// 除以5：    Fin = 3,6864 =(18,432 / 5)
		// 乘以25+1： Fout = 95,8464 =(3,6864 *26)
		// 對于96MHz，誤差為 0.16%
		// NOT USED = 0
		// PLLCOUNT 鎖相環啟動時間約為：0.844 ms
		// PLLCOUNT 28 = 0.000844 /(1/32768)
       pPMC->PMC_PLLR = ((AT91C_CKGR_DIV & 0x05) |
                         (AT91C_CKGR_PLLCOUNT & (28<<8)) |
                         (AT91C_CKGR_MUL & (25<<16)));

        while(!(pPMC->PMC_SR & AT91C_PMC_LOCK));     // 等待啟動
        while(!(pPMC->PMC_SR & AT91C_PMC_MCKRDY));
 	// 4. 選擇主時鐘和處理器時鐘
             	// 選擇PLL時鐘除以2
 	    pPMC->PMC_MCKR =  AT91C_PMC_PRES_CLK_2 ;
 	    while(!(pPMC->PMC_SR & AT91C_PMC_MCKRDY));
 	    pPMC->PMC_MCKR |= AT91C_PMC_CSS_PLL_CLK  ;
 	    while(!(pPMC->PMC_SR & AT91C_PMC_MCKRDY));
        	// 設置默認中斷句炳向量
	AT91C_BASE_AIC->AIC_SVR[0] = (int) AT91F_Default_FIQ_handler ;
	for (i=1;i < 31; i++) {
	    AT91C_BASE_AIC->AIC_SVR[i] = (int) AT91F_Default_IRQ_handler ;
	}
	AT91C_BASE_AIC->AIC_SPU  = (int) AT91F_Spurious_handler ;
}