BvAutoController/User/protocol.c

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


#ifdef IS_BOOTLOADER
uint32_t Firmware_Version[4] = {1, 0, 3, 20240328};
#else
uint32_t Firmware_Version[4] = {2, 1, 1, 20240328};
#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_BvStatus(uint8_t *pBuf, uint16_t buf_len)
{
	
	if( buf_len < 2){
		return 0;
	}
	
	pBuf[0] = 0x00;
	pBuf[1] = g_bvopen;
	
	return 2;

}

uint16_t Read_NoiseThreshold(uint8_t *pBuf, uint16_t buf_len)
{
	if( buf_len < 12){
		return 0;
	}
	
	pBuf[0] = ((uint8_t*)(&config->xaxis_threshold))[0];
	pBuf[1] = ((uint8_t*)(&config->xaxis_threshold))[1];
	pBuf[2] = ((uint8_t*)(&config->xaxis_threshold))[2];
	pBuf[3] = ((uint8_t*)(&config->xaxis_threshold))[3];
	
	pBuf[4] = ((uint8_t*)(&config->yaxis_threshold))[0];
	pBuf[5] = ((uint8_t*)(&config->yaxis_threshold))[1];
	pBuf[6] = ((uint8_t*)(&config->yaxis_threshold))[2];
	pBuf[7] = ((uint8_t*)(&config->yaxis_threshold))[3];
	
	pBuf[8] = ((uint8_t*)(&config->zaxis_threshold))[0];
	pBuf[9] = ((uint8_t*)(&config->zaxis_threshold))[1];
	pBuf[10] = ((uint8_t*)(&config->zaxis_threshold))[2];
	pBuf[11] = ((uint8_t*)(&config->zaxis_threshold))[3];
	
	return 12;
}




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

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 Control_SValve(uint8_t *pdata, uint8_t len)
{
	if(len == 2){
		
		if(pdata[1] == 0x00){
			sv_close();
		}else{
			sv_open();
		}
		
		return RET_OK;
		
	}else{
		return RET_DATAINVALID;
	}
}

//语音输出
uint8_t Trigger_VoicOutput(uint8_t *pdata, uint8_t len)
{
	if(len == 2){
		
		g_vo_delay = VO_COUNT_DFTT;
		g_voiceid = pdata[1];
		return RET_OK;
		
	}else{
		return RET_DATAINVALID;
	}
}

//发送原始数据
uint8_t Trigger_SendRaw(uint8_t *pdata, uint8_t len)
{
	if(len == 2){
		
		if(pdata[1] == 0x00){
			g_send_raw = 0;
		}else{
			g_send_raw = 1;
			g_send_sequence = 0;
		}
		
		return RET_OK;
		
	}else{
		return RET_DATAINVALID;
	}
}

//发送滤波后数据
uint8_t Trigger_SendFiltered(uint8_t *pdata, uint8_t len)
{
	if(len == 2){
		
		if(pdata[1] == 0x00){
			g_send_filtered = 0;
		}else{
			g_send_filtered = 1;
			g_send_sequence = 0;
		}
		
		return RET_OK;
		
	}else{
		return RET_DATAINVALID;
	}
}

//触发标定加速度计的机械热噪声
uint8_t Trigger_CalibrateNoise(uint8_t *pdata, uint8_t len)
{
	if(len == 2){
		
		g_autocalibration = 1;
		g_samplecount = 0;
		
		return RET_OK;
		
	}else{
		return RET_DATAINVALID;
	}
}