#include "mylib.h"

INT8U xdata protect_buffer[USED_BYTE_QTY_IN_ONE_SECTOR];


/* 打開 ISP,IAP 功能 */
void ISP_IAP_enable(void)
{
	EA	=	0;	/* 關中斷 */
	ISP_CONTR	=	ISP_CONTR & 0x18;       /* 0001,1000 */
	ISP_CONTR	=	ISP_CONTR | WAIT_TIME;
	ISP_CONTR	=	ISP_CONTR | 0x80;       /* 1000,0000 */
}

/* 關閉 ISP,IAP 功能 */
void ISP_IAP_disable(void)
{
	ISP_CONTR	=	ISP_CONTR & 0x7f;	/* 0111,1111 */
	ISP_TRIG	=	0x00;
	EA			=   1;                	/* 開中斷 */
}

/* 字節讀 */
INT8U byte_read(INT16U byte_addr)
{
	ISP_ADDRH	=	(INT8U)(byte_addr >> 8);
	ISP_ADDRL	=	(INT8U)(byte_addr & 0x00ff);

	ISP_CMD		=	ISP_CMD	&	0xf8;        /* 1111,1000 */
	ISP_CMD		=	ISP_CMD	|	READ_AP_and_Data_Memory_Command;        /* 0000,0001 */

	ISP_IAP_enable();

	ISP_TRIG	=	0x46;
	ISP_TRIG	=	0xb9;
	_nop_();

	ISP_IAP_disable();
	return (ISP_DATA);
}

/* 扇區擦除 */
INT8U sector_erase(INT16U sector_addr)
{
	INT16U get_sector_addr	=	0;
	get_sector_addr			=	(sector_addr & 0xfe00); /* 1111,1110,0000,0000; 取扇區地址 */
	ISP_ADDRH        		=	(INT8U)(get_sector_addr >> 8);
	ISP_ADDRL		        =	0x00;

	ISP_CMD	=	ISP_CMD	&	0xf8;	/* 1111,1000 */
	ISP_CMD	=	ISP_CMD	|	SECTOR_ERASE_AP_and_Data_Memory_Command;	/* 0000,0011 */

	ISP_IAP_enable();
	ISP_TRIG	=	0x46;        /* 觸發ISP_IAP命令 */
	ISP_TRIG	=	0xb9;        /* 觸發ISP_IAP命令 */
	 _nop_();

	ISP_IAP_disable();
	return OK;
}
#ifdef byte_pro
#define byte_pro
/* 字節編程 */
INT8U byte_program(INT16U byte_addr, INT8U original_data)
{
	ISP_ADDRH	=	(INT8U)(byte_addr >> 8);
	ISP_ADDRL	=	(INT8U)(byte_addr & 0x00ff);

	ISP_CMD		=	ISP_CMD	&	0xf8;        /* 1111,1000 */
	ISP_CMD		=	ISP_CMD	|	PROGRAM_AP_and_Data_Memory_Command;		/* 0000,0010 */
	ISP_DATA	=	original_data;

	ISP_IAP_enable();
	ISP_TRIG	=	0x46;        /* 觸發ISP_IAP命令 */
	ISP_TRIG	=	0xb9;        /* 觸發ISP_IAP命令 */
	_nop_();

	ISP_IAP_disable();
	return	OK;
}

/* 字節編程并校驗 */
INT8U byte_program_and_verify(INT16U byte_addr, INT8U original_data)
{
	ISP_ADDRH	=	(INT8U)(byte_addr >> 8);
	ISP_ADDRL	=	(INT8U)(byte_addr & 0x00ff);

	ISP_CMD		=	ISP_CMD	&	0xf8;        /* 1111,1000 */
	ISP_CMD		=	ISP_CMD	|	PROGRAM_AP_and_Data_Memory_Command;	/* 0000,0010 */
	ISP_DATA	=	original_data;

	ISP_IAP_enable();

	ISP_TRIG	=	0x46;
	ISP_TRIG	=	0xb9;
	_nop_();

	ISP_DATA	=	0x00;

	ISP_CMD		=	ISP_CMD	&	0xf8;        /* 1111,1000 */
	ISP_CMD		=	ISP_CMD	|	READ_AP_and_Data_Memory_Command;        /* 0000,0001 */

	ISP_TRIG	=	0x46;        /* 觸發ISP_IAP命令 */
	ISP_TRIG	=	0xb9;        /* 觸發ISP_IAP命令 */
	_nop_();

	ISP_IAP_disable();

	if(ISP_DATA	==	original_data)
		return	OK;
	else
		return	ERROR;
}
#endif

/* 寫數據進Flash存儲器, 只在同一個扇區內寫，不保留原有數據	*/
/* begin_addr,被寫數據Flash開始地址；counter,連續寫多少個字節； array[]，數據來源	*/
INT8U sequential_write_flash_in_one_sector(INT16U begin_addr, INT16U counter, INT8U array[])
{
	INT16U	i	=	0;
	INT16U	in_sector_begin_addr	=	0;
	INT16U	sector_addr	=	0;

	/* 判是否是有效范圍,此函數不允許跨扇區操作 */
	if(counter > USED_BYTE_QTY_IN_ONE_SECTOR)
		return	ERROR;
	in_sector_begin_addr =        begin_addr & 0x01ff;         /* 0000,0001,1111,1111 */
	if( (in_sector_begin_addr + counter) > USED_BYTE_QTY_IN_ONE_SECTOR )
		return ERROR;

    /* 擦除 要修改/寫入 的扇區 */
	sector_addr	=	(begin_addr & 0xfe00);	/* 1111,1110,0000,0000; 取扇區地址 */
	ISP_ADDRH	=	(INT8U)(sector_addr >> 8);
	ISP_ADDRL	=	0x00;
	ISP_CMD		=	ISP_CMD	&	0xf8;		/* 1111,1000 */
	ISP_CMD		=	ISP_CMD	|	SECTOR_ERASE_AP_and_Data_Memory_Command;	/* 0000,0011 */

	ISP_IAP_enable();
	ISP_TRIG	=	0x46;        /* 觸發ISP_IAP命令 */
	ISP_TRIG	=	0xb9;        /* 觸發ISP_IAP命令 */
	_nop_();

	for(i = 0; i< counter; i++)
	{
		/* 寫一個字節 */
		ISP_ADDRH	=	(INT8U)(begin_addr >> 8);
		ISP_ADDRL	=	(INT8U)(begin_addr & 0x00ff);
		ISP_DATA	=	array[i];
		ISP_CMD		=	ISP_CMD	&	0xf8;	/* 1111,1000 */
		ISP_CMD		=	ISP_CMD	|	PROGRAM_AP_and_Data_Memory_Command;		/* 0000,0010 */

		ISP_TRIG	=	0x46;	/* 觸發ISP_IAP命令 */
		ISP_TRIG	=	0xb9;	/* 觸發ISP_IAP命令 */
		_nop_();

		/* 讀回來 */
		ISP_DATA	=	0x00;

		ISP_CMD		=	ISP_CMD	&	0xf8;	/* 1111,1000 */
		ISP_CMD     =	ISP_CMD	|	READ_AP_and_Data_Memory_Command;	/* 0000,0001 */

		ISP_TRIG	=	0x46;	/* 觸發ISP_IAP命令 */
		ISP_TRIG	=	0xb9;	/* 觸發ISP_IAP命令 */
		_nop_();

		/*  比較對錯 */
		if(ISP_DATA != array[i])
		{
			ISP_IAP_disable();
			return ERROR;
		}
        begin_addr++;
	}
	ISP_IAP_disable();
	return	OK;
}
#ifdef write_flash
#define write_flash
/* 寫數據進數據Flash存儲器(EEPROM), 只在同一個扇區內寫，保留同一扇區中不需修改的數據	*/
/* begin_addr,被寫數據Flash開始地址；counter,連續寫多少個字節； array[]，數據來源		*/
INT8U write_flash_with_protect_in_one_sector(INT16U begin_addr, INT16U counter, INT8U array[])
{
	INT16U	i	=	0;
	INT16U	in_sector_begin_addr	=	0;
	INT16U	sector_addr	=	0;
	INT16U	byte_addr	=	0;

	/* 判是否是有效范圍,此函數不允許跨扇區操作 */
	if(counter > USED_BYTE_QTY_IN_ONE_SECTOR)