/*
 * megatec.c
 *
 *  Created on: 22.05.2017
 *      Author: balbekova
 */
#include "FreeRTOS.h"
#include "task.h"
#include "usart.h"
#include "megatec.h"
#ifdef PRINTF_STDLIB
#include <stdio.h>
#endif
#ifdef PRINTF_CUSTOM
#include "tinystdio.h"
#endif

#include <string.h>
#include <math.h>

#define UPS_PDU_MAX_LEN 50

enum {
	NORMAL = 0x00,
	VER_ERROR = 0x01,
	CHKSUM_ERROR = 0x02,
	LCHKSUM_ERROR = 0x03,
	CID2_INVALID = 0x04,
	CMD_FMT_ERROR = 0x05,
	INVALID_DATA = 0x06,
};

static struct {
	uint8_t data[UPS_PDU_MAX_LEN];
	uint16_t len;
} ups_pdu;


const char* MegaTecCMD[] =
{
		"Q1\r",
		"TL\r",
		"T",
		"Q\r",
		"S",
		"R",
		"C\r",
		"CT\r",
		"I\r",
		"F\r"
};


void init_UPS_value(void)
{
	UPS.Freq_in = 0;
	UPS.VAC_in = 0;
	UPS.VAC_out = 0;
	UPS.Temp = 0;
	UPS.Load = 0;
	UPS.SOC = 0;
	UPS.work_time = 0;
	UPS.Status = 0;
	UPS.Present = false;
}

void send_MegaTec_cmd(cmdMegaTecEnums_t command)
{
	if(command == ups_test_time){

	}
	else if(command == ups_shutdown){

	}
	else if(command == ups_shutdown_restore){

	}
	else{
		ups_send_block(MegaTecCMD[command], strlen(MegaTecCMD[command]));
	}
}

bool ups_megatec_rx_pdu(void)
{
	int c = 0;

	ups_pdu.len = 0;

	while ((ups_pdu.len < UPS_PDU_MAX_LEN) && (c != 0x0d)) {
		c = ups_getchar(500);//portMAX_DELAY
		if(c < 0)
		{
			ups_pdu.len = 0;
			break;
		}
		ups_pdu.data[ups_pdu.len++] = c;
	}

	if (ups_pdu.len == 0)
		return false;

	return true;
}

void ups_status_response(char *data)
{
	char *endValue;
	char value[10];
	uint8_t len = 0;
	if(data[0] != '(')
		return;

	data++;

	memset(value, 0, 10);
	endValue = strpbrk(data," ");
	len = endValue - data;
	strncpy(value, data, len);
	data += (len + 1);
	UPS.VAC_in = atof(value);

	//TODO
	memset(value, 0, 10);
	endValue = strpbrk(data," ");
	len = endValue - data;
	strncpy(value, data, len);
	data += (len + 1);

	memset(value, 0, 10);
	endValue = strpbrk(data," ");
	len = endValue - data;
	strncpy(value, data, len);
	data += (len + 1);
	UPS.VAC_out = atof(value);

	memset(value, 0, 10);
	endValue = strpbrk(data," ");
	len = endValue - data;
	strncpy(value, data, len);
	data += (len + 1);
	UPS.Load = atoi(value);

	memset(value, 0, 10);
	endValue = strpbrk(data," ");
	len = endValue - data;
	strncpy(value, data, len);
	data += (len + 1);
	UPS.Freq_in = atof(value);

	//TODO
	memset(value, 0, 10);
	endValue = strpbrk(data," ");
	len = endValue - data;
	strncpy(value, data, len);
	data += (len + 1);

	memset(value, 0, 10);
	endValue = strpbrk(data," ");
	len = endValue - data;
	strncpy(value, data, len);
	data += (len + 1);
	UPS.Temp = atof(value);

	//TODO
}

void ups_info_response(uint8_t *data)
{

}

void ups_megatec_process_pdu(cmdMegaTecEnums_t command)
{
	switch(command)
	{
	case ups_status_req:
		ups_status_response(ups_pdu.data);
		break;
	case ups_info:
		ups_info_response(ups_pdu.data);
		break;
	case ups_rating_info:

		break;
	default:
		break;
	}
}

void request_task(void)
{

		for(;;)
		{
			send_MegaTec_cmd(ups_status_req);
			if (ups_megatec_rx_pdu())
				ups_megatec_process_pdu(ups_status_req);

	        vTaskDelay(1000);

		}
}

void ups_megatec_init(void) {
	init_UPS_value();

	xTaskCreate(request_task, ( char * ) "request_task", configMINIMAL_STACK_SIZE * 2, NULL, tskIDLE_PRIORITY, NULL);

}