#include <includes.h>

#define  BSP_RAM_REMAP_TEST_BYTE             (*(INT8U  *)0x00000030L)

/*******************************************************************************************************
*                                              CPU_Init
*說明：初始化FLASH等待狀態號并設置片上PLL
********************************************************************************************************/
void CPU_Init(void) {
   AT91PS_PMC     pPMC = AT91C_BASE_PMC;
   AT91C_BASE_MC->MC_FMR = ((AT91C_MC_FMCN)&(50 <<16)) | AT91C_MC_FWS_1FWS ;    // 設置Flash等待狀態
                                                                                // 單周期訪問，30 MHz或 40 MHz
                                                                                // 若 MCK = 47923200，則50個周期為 1 uS
   AT91C_BASE_WDTC->WDTC_WDMR= AT91C_WDTC_WDDIS;                                // 禁止看門狗

   pPMC->PMC_MOR = (( AT91C_CKGR_OSCOUNT & (0x06 <<8) | AT91C_CKGR_MOSCEN ));   // 設置 MCK at 47 923 200
                                                                                // 允許主振蕩器
                                                                                // SCK = 1/32768 = 30.51 uS
   while(!(pPMC->PMC_SR & AT91C_PMC_MOSCS)) {                                   // 等待啟動時間
         ;
   }
                                                                                // 檢查主振蕩器頻率(可選)
                                                                                // 設置PLL及除法器
                                                                                // - 除以 5： Fin = 3,6864 =(18,432 / 5)
                                                                                // - 乘 25+1: Fout = 95,8464 =(3,6864 *26)
                                                                                // 對于 96 MHz晶振，誤差為 0.16%
                                                                                // 為使用的域 = 0
                                                                                // PLLCOUNT： PLL建立時間約為 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))  {                                   // 等待啟動時間
       ;
   }
   pPMC->PMC_MCKR = AT91C_PMC_CSS_PLL_CLK | AT91C_PMC_PRES_CLK_2 ;     	        // 選擇主時鐘和處理器時鐘
                                                                                // 選擇PLL時鐘除以2
   AT91C_BASE_MC->MC_RCR             =  1;                                      // Toggle REMAP 寄存器
   BSP_RAM_REMAP_TEST_BYTE           =  0x01;                                   // 向RAM寫入一個字節
   if(BSP_RAM_REMAP_TEST_BYTE       !=  0x01)                                   // 檢測RAM寫入是否成功
      AT91C_BASE_MC->MC_RCR          =  1;                                      // 若不成功，則toggle REMAP 寄存器
}