#include "IAP.h"

/* 定義CCLK值大小，單位為KHz */
#define		IAP_FCCLK	48000

#define 	IAP_ENTER_ADR   0x7FFFFFF1              			//  IAP入口地址定義

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

/*********************************************************************************************************
**函數名稱:  SelSector
**函數功能:  IAP操作緩沖區選擇，代碼為50
**入口參數:  sec1	起始扇區
**			 sec2	終止扇區
**出口參數:  IAP 操作狀態碼
**			 IAP返回值（paramout緩沖區）
********************************************************************************************************/
uint32	SelSector(uint8	sec1,uint8	sec2)
{
	paramin[0] = IAP_SELECTOR;	                    			// 設置命令字
	paramin[1] = sec1;			                    			// 設置參數
	paramin[2] = sec2;
	(*(void(*)())IAP_ENTER_ADR)(paramin,paramout);				// 調用IAP服務程序
	return(paramout[0]);	                        			// 返回狀態碼
}
/*********************************************************************************************************
**函數名稱:  RamToFlash
**函數功能:  復制RAM的數據到FLASH，命令代碼51
**入口參數:  dst		目標地址，即FLASH起始地址，以256字節為分界
**			 src		源地址，即RAM地址，地址必須字對其
**			 no		    復制字節個數，為256/512/1024/4096
**出口參數:  IAP 操作狀態碼
**			 IAP返回值（paramout緩沖區）
********************************************************************************************************/
uint32	RamToFlash(uint32 dst, uint32 src, uint32  no)
{
	paramin[0] = IAP_RAMTOFLASH;	                			// 設置命令字
	paramin[1] = dst;				                			// 設置參數
	paramin[2] = src;
	paramin[3] = no;
	paramin[4] = IAP_FCCLK;
	(*(void(*)())IAP_ENTER_ADR)(paramin,paramout);				// 調用IAP服務程序
	return(paramout[0]);			                			// 返回狀態碼
}
/*********************************************************************************************************
**函數名稱：EraseSector
**函數功能：擦除扇區，命令代碼52
**入口參數：sec1	起始扇區
**			sec2	終止扇區
**出口參數：IAP 操作狀態碼
**			IAP返回值（paramout緩沖區）
********************************************************************************************************/
uint32	EraseSector(uint32 sec1, uint32 sec2)
{
	paramin[0] = IAP_ERASESECTOR;	                			// 設置命令字
	paramin[1] = sec1;				                			// 設置參數
	paramin[2] = sec2;
	paramin[3] = IAP_FCCLK;
	(*(void(*)())IAP_ENTER_ADR)(paramin,paramout);				// 調用IAP服務程序
	return(paramout[0]);			                			// 返回狀態碼
}
/*********************************************************************************************************
**函數名稱:  BlankCHK
**函數功能:  查空扇區，命令代碼53
**入口參數:  sec1	起始扇區
**			 sec2	終止扇區
**出口參數:  IAP 操作狀態碼
**			 IAP返回值（paramout緩沖區）
********************************************************************************************************/
uint32	BlankCHK(uint32	sec1, uint32  sec2)
{
	paramin[0] = IAP_BLANKCHK;	                    			// 設置命令字
	paramin[1] = sec1;				                			// 設置參數
	paramin[2] = sec2;
	paramin[3] = IAP_FCCLK;
	(*(void(*)())IAP_ENTER_ADR)(paramin,paramout);				// 調用IAP服務程序
	return(paramout[0]);			                			// 返回狀態碼
}
/*********************************************************************************************************
**函數名稱:  ReadParID
**函數功能:  讀器件ID，命令代碼54
**入口參數:  器件ID地址指針
**出口參數:  IAP 操作狀態碼
**			 IAP返回值（paramout緩沖區）
********************************************************************************************************/
uint32	ReadParID(uint32 *Device_ID)
{
	paramin[0] = IAP_READPARTID;	                			// 設置命令字
	(*(void(*)())IAP_ENTER_ADR)(paramin,paramout);				// 調用IAP服務程序
	*Device_ID = paramout[1];
	return(paramout[0]);			                 			// 返回狀態碼
}
/*********************************************************************************************************
**函數名稱:  BootCodeID
**函數功能:  讀boot代碼ID，命令代碼55
**入口參數:  boot代碼ID地址指針
**出口參數:  IAP 操作狀態碼
**			 IAP返回值（paramout緩沖區）
********************************************************************************************************/
uint32	BootCodeID(uint32 *Boot_ID)	
{
	paramin[0] = IAP_BOOTCODEID;	                			// 設置命令字
	(*(void(*)())IAP_ENTER_ADR)(paramin,paramout);				// 調用IAP服務程序
	*Boot_ID = paramout[1];
	
	return(paramout[0]);			                			// 返回狀態碼
}
/*********************************************************************************************************
**函數名稱:  Compare
**函數功能:  校驗數據，命令代碼56
**入口參數:  dst		目標地址，即RAM/FLASH起始地址，地址必須字對齊
**			 src	 	源地址，即RAM/RAM地址，地址必須字對齊
**			 no		    比較字節個數，必須能被4整除
**出口參數:  IAP 操作狀態碼
**			 IAP返回值（paramout緩沖區）
********************************************************************************************************/
uint32	Compare(uint32	dst, uint32	src, uint32	no)
{
	paramin[0] = IAP_COMPARE;	                    			// 設置命令字
	paramin[1] = dst;				                			// 設置參數
	paramin[2] = src;
	paramin[3] = no;
	(*(void(*)())IAP_ENTER_ADR)(paramin,paramout);				// 調用IAP服務程序
	return(paramout[0]);			                			// 返回狀態碼
}
/*********************************************************************************************************
**函數名稱:  Reinvoke_ISP
**函數功能:  重新調用ISP，命令代碼57。
**入口參數:  無
**出口參數:  無
********************************************************************************************************/
void  Reinvoke_ISP(void)
{
	paramin[0] = IAP_REINVOKE_ISP;								//  設置命令字
	(*(void(*)())IAP_ENTER_ADR)(paramin,paramout);				//  重新調用ISP
} 
/*********************************************************************************************************
**函數名稱:  WriteFlash
**函數功能:  向FLASH中寫入數據
**入口參數:  dst		目標地址，即FLASH起始地址，地址必須以256字節對齊，即地址的低8位必須為0
**			 src		源地址，即RAM地址，地址必須字對齊，即地址的低兩位必須為0
**			 no		    寫入字節數，必須為256/512/1024/4096
**出口參數:  Compare的返回值，操作成功正確返回0
********************************************************************************************************Y*/
uint8	WriteFlash(uint32  dst, uint32	src, uint32	no)
{
	SelSector((uint8)(dst/0x1000),(uint8)((dst+no)/0x1000));	// 選擇扇區
	EraseSector((dst/0x1000),(dst+no)/0x1000);					// 擦除扇區
	BlankCHK((dst/0x1000),(dst+no)/0x1000);						// 查空扇區
	
	SelSector((uint8)(dst/0x1000),(uint8)((dst+no)/0x1000));	// 選擇扇區
	
	RamToFlash(dst,src,no);			           				 	// 寫數據到FLASH
	return((uint8)(Compare(dst,src,no)));	            		// 比較數據
}