#include "task.h"
#include "cjson.h"
#include "myFile.h"
#include "gateway_message.h"
#include "log.h"
#include "malloc.h"
#include "sx1276.h"

#include "protocol.h"
#include "usart.h"
#include "node_data_acquisition.h"
#include "sys_mqtt.h"
#include "sys_http.h"
#include "node_message.h"
#include "usart.h"
#include "mmodbus.h"
#include "sys_mqtt.h"
#include "gateway_message.h"
#include "MQTTClient.h"

void master_task(uint8_t *string,uint16_t stringlength);
void slave_task();
int READ_MODBUS_DATA(DEVICE_PARAMS *current_device);


uint16_t BufferSize;
uint8_t Buffer[256];

uint32_t rx_num = 0;

uint8_t PingMsg[] = "PING\0";
uint8_t PongMsg[] = "PONG\0";
tRadioDriver *Radio=NULL;
/*
*********************************************************************************************************
*	函 数 名: void data_task(void *pdata)
*	功能说明: 主要是data_task处理线程，优先级高。其运行逻辑是将nandflash中的数据解析出来轮询发送数据
*	形    参：无
*	返 回 值: 无
*********************************************************************************************************
*/

void data_task(void *pdata)
{
	OS_CPU_SR cpu_sr;
	pdata = pdata;
//	Radio = RadioDriverInit();
//	Radio->Init();
//	mmodbus_init(1);

	char *device_config_json = mymalloc(SRAMEX, 9 * 1024);
	read_file("device.txt", device_config_json);
	addGatewayParams(device_config_json);
	myfree(SRAMEX, device_config_json);
//	GATEWAY_PARAMS *get;
//	get= get_gateway_config_params();
//	int deviceIndex=0;
//	DEVICE_PARAMS *current_device=get->device_params;
//	
//	uint32_t baudrate = get->baudrate;
//	uint8_t databits = get->dataBits;
//	uint8_t stopbits = get->stopBit;
//	uint8_t parity = get->parity;
//	uint8_t flowcontrol = get->flowControl;
//	Config_485_Port(baudrate, databits, stopbits, parity, flowcontrol);
//	 
//	uint8_t string[256];
//	uint16_t bufferLength;
//	OS_Q_DATA Qnum;
//	StringInfo message;
//	char *mqttRecv;
//	uint8_t err;
// 	while (current_device!=NULL)
//	{
//		READ_MODBUS_DATA(current_device);
//		if(current_device->nextDevice!=NULL) 
//		{
//			current_device=current_device->nextDevice;	
//		}
//		else
//		{		
//			int msg = MBOX_USER_PUBLISHQOS2;	
//			if(mqtt_connectFlag==1) OSMboxPost(mqtt_sendMseeageMbox, &msg);
//			memset(pubJsonString,0,strlen(pubJsonString));
//			current_device=get->device_params;			
//		}			
//	}
}

	#if 0   //测试代码不经过转发直接进行相应的解析
			SlaveProtocolAnalysis(string,bufferLength);
			data_acquisition();
			uint8_t node_string[256];
			uint16_t node_string_Length;
			nodeSendReaddValue(node_string,&node_string_Length);
			GatewayProtocolAnalysis(node_string,node_string_Length);
#endif			
 	
int READ_MODBUS_DATA(DEVICE_PARAMS *device)
	{
		DEVICE_PARAMS *current_device=device;
		GATEWAY_READ_MODBUS_COMMAND *currentModbusParams = current_device->params->gateway_read_modbus_command;
		GATEWAY_READ_DLT645_COMMAND *currentDLT645Params = current_device->params->gateway_read_dlt645_command;
		while(current_device->params != NULL)
		{
			if (current_device->protocol == MODBUS_READ)
			{
				protocol_485=1;
				uint16_t data[currentModbusParams->registerByteNum /2]; // modbus寄存器长度
				mmodbus_set16bitOrder(current_device->MDBbigLittleFormat);
				if (currentModbusParams->functionCode == 0x03 | currentModbusParams->functionCode == 0x01)
				{
					bool success = mmodbus_readHoldingRegisters16i(currentModbusParams->slaveAddress,
															 currentModbusParams->registerAddress,
															 currentModbusParams->registerByteNum /2,
															 data);
					if (success)
					{
						uint32_t value;
						if (currentModbusParams->registerByteNum == 4)
						{
							value = (uint32_t)data[0] | data[1];
						}
						else if (currentModbusParams->registerByteNum == 2)
						{
							value = data[0];
						}		
						if (currentModbusParams->decimalPoint == 0)
						{
							currentModbusParams->value[0] = value;
							currentModbusParams->value[1] = value << 8;
							currentModbusParams->value[2] = value << 16;
							currentModbusParams->value[3] = value << 24;
						}
						else
						{
							float convertedValue = (float)value / pow(10, currentModbusParams->decimalPoint);
							memcpy(currentModbusParams->value, &convertedValue, 4);
						}
					 sprintf(pubJsonString + strlen(pubJsonString), "{\"data\":[{\"deviceId\":\"%s\",\"%s\":%d}]},", 
																									current_device->deviceID, currentModbusParams->keyword, value);
					currentModbusParams = currentModbusParams->nextParams;
					if (currentModbusParams == NULL)	
						{
							sprintf(pubJsonString + strlen(pubJsonString) - 1, ""); 
							return 0;
						}
					}
				}
			}	

			else if (current_device->protocol == MODBUS_WRITE)
		{
			protocol_485=1;
		}
		else if (current_device->protocol == DLT645_07 || current_device->protocol == DLT645_97)
		{
			protocol_485=2;
			uint8_t read_buf[10];
			
			currentDLT645Params->rxLen = 0;
			memset(read_buf, 0, 10);
			memset(currentDLT645Params->data, 0, 10);

			dlt645_set_addr(&dlt645, current_device->params->gateway_read_dlt645_command->deviceID645);
			int8_t rs;
			if (current_device->protocol == DLT645_07)
			{
				rs = dlt645_read_data(&dlt645, currentDLT645Params->Identification, read_buf, DLT645_2007);
			}
			else if (current_device->protocol == DLT645_97)
			{
				rs = dlt645_read_data(&dlt645, currentDLT645Params->Identification, read_buf, DLT645_1997);
			}
			if (rs != -1)
			{
				if (rs <= 4)
				{
					memcpy(currentDLT645Params->data, read_buf, 4);
					currentDLT645Params->rxLen = 4;
				}
				else if (rs == 5)
				{
					memcpy(currentDLT645Params->data, read_buf, 5);
					currentDLT645Params->rxLen = 5;
				}
				else if (rs > 5)
				{
					memcpy(currentDLT645Params->data, read_buf, 9);
					currentDLT645Params->rxLen = 9;
				}
			}
			else
			{
				currentDLT645Params->rxLen =0;
			}
			sprintf(pubJsonString + strlen(pubJsonString), "{\"data\":[{\"deviceId\":\"%s\",\"%s\":%s},]}", 
																				current_device->deviceID, currentDLT645Params->keyword, currentDLT645Params->data);
			currentDLT645Params = currentDLT645Params->nextParams;
			if (currentDLT645Params == NULL)	
			{
				return 0;
			}
		}			
	}
		return 1;
}

void WRITE_MODBUS_DATA(char* buf){
	GATEWAY_PARAMS* get;
	get = get_gateway_config_params();
	GATEWAY_WRITE_MODBUS_COMMAND *currentModbusParams = get->device_params->params->gateway_write_modbus_command;

	value data;
	data.PowerValue = parseIntField(buf, "\"power\":");
	data.TempValue = parseIntField(buf, "\"temp\":");
	data.ModeValue = parseIntField(buf, "\"mode\":");
	data.FanValue = parseIntField(buf, "\"fan\":");
	data.RoomTempValue = parseIntField(buf, "\"roomTemp\":");
	uint16_t slaveAddress;
	uint16_t number;

	if(data.PowerValue){
			slaveAddress = currentModbusParams->slaveAddress;
			number =currentModbusParams->registerAddress;
			mmodbus_writeHoldingRegister16i(slaveAddress, number, data.PowerValue);
	}
	if(data.TempValue){
			currentModbusParams = currentModbusParams->nextParams;
			slaveAddress = currentModbusParams->slaveAddress;
			number =currentModbusParams->registerAddress;
			mmodbus_writeHoldingRegister16i(slaveAddress, number, data.TempValue);
	}
	if(data.ModeValue){
			currentModbusParams = currentModbusParams->nextParams;
			slaveAddress = currentModbusParams->slaveAddress;
			number =currentModbusParams->registerAddress;
			mmodbus_writeHoldingRegister16i(slaveAddress, number, data.ModeValue);
	}
	if(data.FanValue){
			currentModbusParams = currentModbusParams->nextParams;
			slaveAddress = currentModbusParams->slaveAddress;
			number =currentModbusParams->registerAddress;
			mmodbus_writeHoldingRegister16i(slaveAddress, number, data.FanValue);
	}
	if(data.RoomTempValue){
			currentModbusParams = currentModbusParams->nextParams;
			slaveAddress = currentModbusParams->slaveAddress;
			number =currentModbusParams->registerAddress;
			mmodbus_writeHoldingRegister16i(slaveAddress, number, data.RoomTempValue);
	}
}