#include "serial_at_cmd_app.h"
#include "global_param.h"
#include <string.h>
#include <stdio.h>
#include "dw_app.h"
#include "RTC.h"
uint8_t m_frame_data[MAX_FRAME_LEN] = {0};
uint8_t m_frame_data_len = 0;
uint8_t g_pairstart=0;
void ParseFrame(void)
{
	if(!memcmp(m_frame_data, "DIS1", 4))
	{
		g_com_map[ALARM_DISTANCE1] =0;
		for(uint8_t i=5; i < m_frame_data_len; i++)
		{
			if(m_frame_data[i]<58 && m_frame_data[i]>47)
			{
				g_com_map[ALARM_DISTANCE1] = g_com_map[ALARM_DISTANCE1]*10 + m_frame_data[i]- '0';
			}
			else
			{
				printf("Error: Wrong DISTANCE.\r\n");
				break;
			}
		}
		printf("When distance1 < %d cm, alarm1 is on.\n", g_com_map[ALARM_DISTANCE1]);
		save_com_map_to_flash();
	}
	else if(!memcmp(m_frame_data, "DIS2", 4))
	{
		g_com_map[ALARM_DISTANCE2] =0;
		for(uint8_t i=5; i < m_frame_data_len; i++)
		{
			if(m_frame_data[i]<58 && m_frame_data[i]>47)
			{
				g_com_map[ALARM_DISTANCE2] = g_com_map[ALARM_DISTANCE2]*10 + m_frame_data[i]- '0';
			}
			else
			{
				printf("Error: Wrong DISTANCE.\r\n");
				break;
			}
		}
		printf("When distance2 < %d cm, alarm2 is on.\n", g_com_map[ALARM_DISTANCE2]);
		save_com_map_to_flash();
	}
	else if(!memcmp(m_frame_data, "DIS3", 4))
	{
		g_com_map[ALARM_DISTANCE3] =0;
		for(uint8_t i=5; i < m_frame_data_len; i++)
		{
			if(m_frame_data[i]<58 && m_frame_data[i]>47)
			{
				g_com_map[ALARM_DISTANCE3] = g_com_map[ALARM_DISTANCE3]*10 + m_frame_data[i]- '0';
			}
			else
			{
				printf("Error: Wrong DISTANCE.\r\n");
				break;
			}
		}
		printf("When distance3 < %d cm, alarm3 is on.\n", g_com_map[ALARM_DISTANCE3]);
		save_com_map_to_flash();
	}
	else if(!memcmp(m_frame_data, "DEV", 3))
	{
		g_com_map[ALARM_DEV] = m_frame_data[4]-'0';
		printf("Alarm device is %d. \n", g_com_map[ALARM_DEV]);
		save_com_map_to_flash();
	}
	else if(!memcmp(m_frame_data, "ID", 2))
	{
	dev_id = 0;
		for(uint8_t i=3; i < m_frame_data_len; i++)
		{
			if(m_frame_data[i]<='9' && m_frame_data[i]>='0')
			{
				dev_id = (dev_id<<4)|(m_frame_data[i]- '0');
			}else if(m_frame_data[i]<='f' && m_frame_data[i]>='a')
			{
				dev_id = (dev_id<<4)|(m_frame_data[i]- 'a'+10);
			}else if(m_frame_data[i]<='F' && m_frame_data[i]>='A')
			{
				dev_id = (dev_id<<4)|(m_frame_data[i]- 'A'+10);
			}
			else
			{
				printf("Error: Wrong ID.\r\n");
				break;
			}
		}
		g_com_map[DEV_ID_L] = dev_id;
		g_com_map[DEV_ID_H] = dev_id>>16;
		Dw1000_App_Init();
		printf("set dev id = %x. \r\n", dev_id);
		save_com_map_to_flash();
	}else if(!memcmp(m_frame_data, "INT", 3))
	{
		g_com_map[COM_INTERVAL] = 0;
		for(uint8_t i=4; i < m_frame_data_len; i++)
		{
			if(m_frame_data[i]<58 && m_frame_data[i]>47)
			{
				g_com_map[COM_INTERVAL] = g_com_map[COM_INTERVAL]*10 + m_frame_data[i]- '0';
			}
			else
			{
				printf("Error: Wrong COM_INTERVAL.\r\n");
				break;
			}
		}
		printf("set dev interval = %d ms. \r\n", g_com_map[COM_INTERVAL]);
		RTC_Configuration(g_com_map[COM_INTERVAL]*20);
		save_com_map_to_flash();
	}else if(!memcmp(m_frame_data, "PAIRID", 6))
	{
		g_com_map[PAIR_ID] = 0;
		for(uint8_t i=7; i < m_frame_data_len; i++)
		{
			if(m_frame_data[i]<58 && m_frame_data[i]>47)
			{
				g_com_map[PAIR_ID] = g_com_map[PAIR_ID]*10 + m_frame_data[i]- '0';
			}
			else
			{
				printf("Error: Wrong PAIR_ID.\r\n");
				break;
			}
		}
		printf("set dev PAIR_ID = %d . \r\n", g_com_map[PAIR_ID]);
		save_com_map_to_flash();
	}else if(!memcmp(m_frame_data, "STARTPAIR", 9))
	{
		g_pairstart=1;
		printf("Start Pair Mode. \r\n");
	}else{
		printf("Error: Wrong Command.\r\n");
	}
}

void UsartParseDataHandler(uint8_t data)
{
	static uint8_t s_usart_state = 0;
	static uint8_t s_data_pos;
	
	switch(s_usart_state)
	{
		case 0:
			if(data=='A')	s_usart_state=  1;
		break;
			
		case 1:
			if(data=='T')	s_usart_state = 2;
		break;
		
		case 2:
			if(data=='+')
			{ 
				s_usart_state = 3;
				s_data_pos = 0;
				m_frame_data_len = 0;
			}
		break;
			
		case 3:
			m_frame_data_len = s_data_pos;
			m_frame_data[s_data_pos++] = data;
			if(data == 0x0d)
			{
				s_usart_state = 4;
			}
			if(s_data_pos >= MAX_FRAME_LEN) //Èç¹û³¬¹ý×î´ó³¤¶È
			{
				m_frame_data_len = MAX_FRAME_LEN;
				ParseFrame();
				s_usart_state = 0;
			}
		break;
			
		case 4:
			if(data == 0x0a)
			{
				ParseFrame();
				s_usart_state = 0;
			}
		break;
			
		default: break;
	}
}