/****************************************************************************
* 文件名：IAPTEST.C
* 功能：LPC2200的IAP功能測試。
* 說明：調用IAP服務程序，完成FLASH編程操作。
*      將paramout添加到Watch窗口，觀察返回值。
****************************************************************************/
#include  "config.h"

/* 定義IAP命令字 */
#define  IAP_SELSECTOR        50
#define  IAP_RAMTOFLASH       51
#define  IAP_ERASESECTOR      52
#define  IAP_BLANKCHK         53
#define  IAP_READPARTID       54
#define  IAP_BOOTCODEID       55
#define  IAP_COMPARE          56

/* 定義IAP返回狀態字 */
#define  CMD_SUCCESS          0
#define  INVALID_COMMAND      1
#define  SRC_ADDR_ERROR       2 
#define  DST_ADDR_ERROR       3
#define  SRC_ADDR_NOT_MAPPED  4
#define  DST_ADDR_NOT_MAPPED  5
#define  COUNT_ERROR          6
#define  INVALID_SECTOR       7
#define  SECTOR_NOT_BLANK     8
#define  SECTOR_NOT_PREPARED_FOR_WRITE_OPERATION 9
#define  COMPARE_ERROR        10
#define  BUSY                 11
#define  PARAM_ERROR          12 /* Insufficient number of parameters */
#define  ADDR_ERROR           13 /* Address not on word boundary */
#define  ADDR_NOT_MAPPED      14
#define  CMD_LOCKED           15 /* Command is locked */
#define  INVALID_CODE         16 /* Unlock code is invalid */
#define  INVALID_BAUD_RATE    17
#define  INVALID_STOP_BIT     18 

uint32  paramin[8];                         // IAP入口參數緩沖區
uint32  paramout[8];                        // IAP出口參數緩沖區


/****************************************************************************
* 名稱：SelSector()
* 功能：IAP操作扇區選擇，命令代碼50。
* 入口參數：sec1        起始扇區
*          sec2        終止扇區
* 出口參數：IAP返回值(paramout緩沖區)
****************************************************************************/
void  SelSector(uint8 sec1, uint8 sec2)
{  paramin[0] = IAP_SELSECTOR;              // 設置命令字
   paramin[1] = sec1;                       // 設置參數
   paramin[2] = sec2;
   iap_entry(paramin, paramout);         	// 調用IAP服務程序
}


/****************************************************************************
* 名稱：RamToFlash()
* 功能：復制RAM的數據到FLASH，命令代碼51。
* 入口參數：dst        目標地址，即FLASH起始地址。以512字節為分界
*          src        源地址，即RAM地址。地址必須字對齊
*          no         復制字節個數，為512/1024/4096/8192
* 出口參數：IAP返回值(paramout緩沖區)
****************************************************************************/
void  RamToFlash(uint32 dst, uint32 src, uint32 no)
{  paramin[0] = IAP_RAMTOFLASH;             // 設置命令字
   paramin[1] = dst;                        // 設置參數
   paramin[2] = src;
   paramin[3] = no;
   paramin[4] = Fosc/1000;					// 當不使用PLL功能時，Fcclk=Fosc
   iap_entry(paramin, paramout);         	// 調用IAP服務程序
}


/****************************************************************************
* 名稱：EraseSector()
* 功能：扇區擦除，命令代碼52。
* 入口參數：sec1       起始扇區
*          sec2       終止扇區
* 出口參數：IAP返回值(paramout緩沖區)
****************************************************************************/
void  EraseSector(uint8 sec1, uint8 sec2)
{  paramin[0] = IAP_ERASESECTOR;            // 設置命令字
   paramin[1] = sec1;                       // 設置參數
   paramin[2] = sec2;
   paramin[3] = Fosc/1000;					// 當不使用PLL功能時，Fcclk=Fosc
   iap_entry(paramin, paramout);         	// 調用IAP服務程序
}

/****************************************************************************
* 名稱：BlankCHK()
* 功能：扇區查空，命令代碼53。
* 入口參數：sec1       起始扇區
*          sec2       終止扇區
* 出口參數：IAP返回值(paramout緩沖區)
****************************************************************************/
void  BlankCHK(uint8 sec1, uint8 sec2)
{  paramin[0] = IAP_BLANKCHK;               // 設置命令字
   paramin[1] = sec1;                       // 設置參數
   paramin[2] = sec2;
   iap_entry(paramin, paramout);         	// 調用IAP服務程序
}


/****************************************************************************
* 名稱：ReadParID()
* 功能：扇區查空，命令代碼53。
* 入口參數：無
* 出口參數：IAP返回值(paramout緩沖區)
****************************************************************************/
void  ReadParID(void)
{  paramin[0] = IAP_READPARTID;             // 設置命令字
   iap_entry(paramin, paramout);         	// 調用IAP服務程序
}


/****************************************************************************
* 名稱：BootCodeID()
* 功能：讀取boot代碼版本號，命令代碼55。
* 入口參數：無
* 出口參數：IAP返回值(paramout緩沖區)
****************************************************************************/
void  BootCodeID(void)
{  paramin[0] = IAP_BOOTCODEID;             // 設置命令字
   iap_entry(paramin, paramout);         	// 調用IAP服務程序
}


/****************************************************************************
* 名稱：Compare()
* 功能：校驗數據，命令代碼56。
* 入口參數：dst        目標地址，即RAM/FLASH起始地址。地址必須字對齊
*          src        源地址，即FLASH/RAM地址。地址必須字對齊
*          no         復制字節個數，必須能被4整除
* 出口參數：IAP返回值(paramout緩沖區)
****************************************************************************/
void  Compare(uint32 dst, uint32 src, uint32 no)
{  paramin[0] = IAP_COMPARE;                // 設置命令字
   paramin[1] = dst;                        // 設置參數
   paramin[2] = src;
   paramin[3] = no;
   iap_entry(paramin, paramout);        	// 調用IAP服務程序
}


/****************************************************************************
* 名稱：main()
* 功能：IAP函數調用，測試。通過觀察IAP出口參數來判斷操作是否成功。
* 說明：程序沒有進行出錯處理。
*      要設置編譯參數-apcs /interwork，因為IAP為Thumb指令。
*      使用IAP功能時，片內RAM的頂端的32字節保留給IAP操作使用，所以在STARTUP.S文件中
*      初始化用戶模式堆棧為StackUsr-20*4，以保證IAP正常操作。
****************************************************************************/
int  main(void)
{  MAMCR = 0;								// 關閉MAM
   PLLCON = 0;								// 關閉PLL
   PLLFEED = 0xaa;
   PLLFEED = 0x55;

   ReadParID();
   BootCodeID();
   
   SelSector(1,1);                          // 選擇扇區1
   EraseSector(1,1);                        // 擦除扇區1
   BlankCHK(1,1) ;                          // 查空扇區1
   
   SelSector(1,1); 
   RamToFlash(0x00002000, 0x40000000, 512); // 寫數據到扇區1 
   BlankCHK(1,1) ;
   Compare(0x00002000, 0x40000000, 512);    // 比較數據
   
   while(1);
   return(0);
}