#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
********************************************************************************************************/
uint8	WriteFlash(uint32 dst, uint32 src, uint32 no)
{
	SelSector((dst/0x1000),(dst+no)/0x1000);	        //選擇扇區
	EraseSector((dst/0x1000),(dst+no)/0x1000);	        //擦除扇區
	BlankCHK((dst/0x1000),(dst+no)/0x1000);		        //查空扇區
	
	SelSector((dst/0x1000),(dst+no)/0x1000);	        //選擇扇區
	
	RamToFlash(dst,src,no);			                    //寫數據到FLASH
	return(Compare(dst,src,no));	                    //比較數據
}