#include "protocol.h"
#include "process.h"
#include "cfg.h"
#include "uart.h"
#include "gpio.h"


#ifdef IS_BOOTLOADER
uint32_t Firmware_Version[4] = {1, 0, 0, 20230410};
#else
uint32_t Firmware_Version[4] = {1, 1, 0, 20240410};
#endif


uint16_t Read_FirmwareVersion(uint8_t *pBuf, uint16_t buf_len)
{
	int i;
	
	if( buf_len < 16){
		return 0;
	}
	
	
	for (i = 0; i < 4; ++i)
	{
		pBuf[i * 4] = (Firmware_Version[i] >> 24) & 0xff;
		pBuf[i * 4 + 1] = (Firmware_Version[i] >> 16) & 0xff;
		pBuf[i * 4 + 2] = (Firmware_Version[i] >> 8) & 0xff;
		pBuf[i * 4 + 3] = (Firmware_Version[i] >> 0) & 0xff;
	}
	
	return 16;
	
}

uint16_t Read_HardwareVersion(uint8_t *pBuf, uint16_t buf_len)
{

	if( buf_len < 2){
		return 0;
	}
	
	pBuf[0] = (config->hw_version >> 8)&0xff;
	pBuf[1] = (config->hw_version >> 0)&0xff;
	
	return 2;
}


uint16_t Read_Deviceid(uint8_t *pBuf, uint16_t buf_len)
{

	if( buf_len < 4){
		return 0;
	}
	
	pBuf[0] = (config->deviceid >> 24)&0xff;
	pBuf[1] = (config->deviceid >> 16)&0xff;
	pBuf[2] = (config->deviceid >> 8)&0xff;
	pBuf[3] = (config->deviceid >> 0)&0xff;
	
	return 4;
	
}

uint16_t Read_Devicetype(uint8_t *pBuf, uint16_t buf_len)
{

	if( buf_len < 2){
		return 0;
	}
	
	pBuf[0] = (config->devicetype >> 8)&0xff;
	pBuf[1] = (config->devicetype >> 0)&0xff;
	
	return 2;

}

uint16_t Read_Addr(uint8_t *pBuf, uint16_t buf_len)
{
	if( buf_len < 2){
		return 0;
	}
	
	pBuf[0] = 0x00;
	pBuf[1] = config->addr;
	
	return 2;
}

uint16_t Read_Baudrate(uint8_t *pBuf, uint16_t buf_len)
{
	if( buf_len < 2){
		return 0;
	}
	
	pBuf[0] = 0x00;
	pBuf[1] = config->br_index;
	
	return 2;

}


uint16_t Read_SvStatus(uint8_t *pBuf, uint16_t buf_len)
{

	if( buf_len < 2){
		return 0;
	}
	
	
	if(g_svstatus&0x01){
		pBuf[0] = (0x01<<4);
	}else{
		pBuf[0] = (0x00<<4);
	}
	
	if(g_svstatus&0x02){
		pBuf[0] |= (0x01);
	}else{
		pBuf[0] |= (0x00);
	}
	
	if(g_svstatus&0x04){
		pBuf[1] = (0x01<<4);
	}else{
		pBuf[1] = (0x00<<4);
	}
	
	if(g_svstatus&0x08){
		pBuf[1] |= (0x01);
	}else{
		pBuf[1] |= (0x00);
	}
	
	return 2;
}


/*=======================================================================================*/

uint8_t Write_Addr(uint8_t *pdata, uint8_t len)
{
	if(len == 2){
		config->addr = pdata[1]; 
		return RET_OK|RET_NEED_SAVE;
		
	}else{
		return RET_DATAINVALID;
	}
}

uint8_t Write_Baudrate(uint8_t *pdata, uint8_t len)
{
	if(len == 2){
		if(pdata[1] >= BaudRate_4800 && pdata[1] <= BaudRate_230400){
			config->br_index = pdata[1]; 
			return RET_OK|RET_NEED_SAVE;
		
		}else{
			return RET_DATAINVALID;
		}
		
		
	}else{
		return RET_DATAINVALID;
	}

}

uint8_t Write_HardwareVersion(uint8_t *pdata, uint8_t len)
{
	if(len == 2){
		
		config->hw_version = ((uint16_t)pdata[0]<<8) | pdata[1]; 
		return RET_OK|RET_NEED_SAVE;
		
	}else{
		return RET_DATAINVALID;
	}
	

}
uint8_t Write_Deviceid(uint8_t *pdata, uint8_t len)
{
	if(len == 4){
		config->deviceid = ((uint32_t)pdata[0]<<24) | ((uint32_t)pdata[1]<<16)| ((uint32_t)pdata[2]<<8)| pdata[3]; 
		return RET_OK|RET_NEED_SAVE;
		
	}else{
		return RET_DATAINVALID;
	}

}
uint8_t Write_Devicetype(uint8_t *pdata, uint8_t len)
{

	if(len == 2){
		
		config->devicetype = ((uint16_t)pdata[0]<<8) | pdata[1]; 
		return RET_OK|RET_NEED_SAVE;
		
	}else{
		return RET_DATAINVALID;
	}
}

uint8_t Write_SvControl(uint8_t *pdata, uint8_t len)
{
	uint8_t action[4];
	uint8_t i=0;
	
	if(len == 2){
		action[0] = ((pdata[0]&0xF0)>>4);
		action[1] = pdata[0]&0x0F;
		action[2] = ((pdata[1]&0xF0)>>4);
		action[3] = pdata[1]&0x0F;
		
		if(action[0]>0x02 || action[1]>0x02 || action[2]>0x02 || action[3]>0x03){
			return RET_DATAINVALID;
		}else{
				
			for( i=0; i<4; i++){
				if(0x01 == action[i]){
					Sv_Control(i, SV_CLOSE);
				}else if(0x02 == action[i]){
					Sv_Control(i, SV_OPEN);
				}
			
			}
			
			return RET_OK;
		
		}
		
		
	}else{
		return RET_DATAINVALID;
	}
}