#include "tt808.h"
#include "usart.h"
#include "key.h"
#include <stdio.h>
#include <time.h>
#include <stdlib.h>
#include <string.h>
//*整型
int rlt;
uint8_t xxtnewlength=0;
uint16_t uploadtime=0;	//上传时间
uint16_t hccd = 0;//ascii个数(*2)
uint8_t xxtfzData[100];	//放入封装后数据
uint8_t tcppacket[100]; //消息数据
uint8_t header[12];		//处理头部
uint8_t index_2c = 0;
uint8_t MIPurc[100];	//接收平台数据
uint8_t MIPurc1[100];	//接收平台数据
uint8_t MIPurcXXTCSJ[100];//平台下行透传数据
uint8_t speedBegin=0;
uint8_t speedEnd=0;
uint8_t speed[10];		//处理头部
double dSpeed=0;
double dWd=0;
double dJd=0;
char cSpeed[10];
char wd[15];
char jd[15];
char MGNSSLOC[100];	//接收定位数据

char MGNSSLOC_time[6];	//接收定位数据
uint32_t Stamp =0;
uint8_t GNSSdata[40]={0};
//*结构体
TT808 tt808;
extern TipsFlag tipsflag;	
extern Menu_table menu;	
extern bool refresh;
extern Database db;
//*布尔
bool ZDJQflag = false;
bool GnssFlag = false;

void chuli(uint16_t XXID)
{

	uint16_t XXTSXdata = xxtnewlength;
	XXTSXdata |= ( xxtnewlength | (TCPJMFSNULL<<10)); // 将长度左移3位后和加密方式进行按位或操作(001 RSA ,000 无加密)
	
	header[0] 	= ((XXID>>8)&0xff);
	header[1] 	= (XXID&0xff);				//消息ID
	header[2] 	= ((XXTSXdata>>8)&0xff);
	header[3] 	= (XXTSXdata&0xff);			//消息属性
	header[4] 	= 0x00;
	header[5] 	= 0x00;
	header[6] 	= 0x16;
	header[7] 	= 0x00;
	header[8] 	= 0x00;
	header[9] 	= 0x08;						//“手机号”
	header[10] 	=  ((tt808.LSH>>8)&0xff);;
	header[11] 	=  (tt808.LSH&0xff);;
	

	
	int index = 0;
	tcppacket[index++] = TT808FLAG;  // Set the headflag 0x7E
		
	for (int i = 0; i < 12; i++) {
		tcppacket[index++] = header[i];
	}
	// Copy message body to packet
	for (size_t i = 0; i < xxtnewlength; i++) {
		tcppacket[index++] = xxtfzData[i];
	}
	tcppacket[index++] = xorBytes(&tcppacket[1],12+xxtnewlength);;  // Set the checksum
	tcppacket[index++] = TT808FLAG;      // Set the flag at the end
	
	
//	for (int i = 0; i < index; i++) {
//		printf("%02X ", tcppacket[i]);  // 以十六进制格式打印每个元素
//	}
	
	
	
	char TCPvalue[100];
	char *ptr = TCPvalue;
	ptr += sprintf(ptr, "AT+MIPSEND=1,%d,\"",index);
	for (int i = 0; i < index; i++) {
		ptr += sprintf(ptr, "%02X", tcppacket[i]);
	}
	sprintf(ptr, "\"\r\n");//TCPvalue
	if(sendCmd_4G(TCPvalue, "+MIPSEND:", 1, 1))//发送
	{
		printf("#发送完成\r\n");
	}
	
	tt808.LSH+=1;//需做写入处理
}

/**
  * @breaf 消息体封装
  * xxt[] 消息数据;	xxtlength 消息数据长度;	outXxt[] 封装后消息数据; XXID 消息ID
  */
uint8_t xxtFZ(uint8_t xxt[], uint8_t xxtlength, uint8_t outXxt[],uint16_t XXID)
{
	int index = 0;
	uint8_t newlength = 0;//加首尾 25/23/crc
	
	if(XXID==XXID_zdjq || XXID==XXID_zdxt)//不加头尾（鉴权、心跳）
	{
		newlength = xxtlength;//不加首尾
		uint8_t newXxt[newlength];
		
		for (int i = 0; i < xxtlength; i++) {
			newXxt[index++] = xxt[i];  // 将消息头拷贝到报文中
		}
		
		newlength = index;
		
		for(int i =0;i<newlength;i++)
		{
			outXxt[i]=newXxt[i];
		}
	}
	else if(XXID==XXID_zddz)				//终端地址
	{
		
		newlength = xxtlength;//不加首尾
		uint8_t newXxt[newlength];
		
		for (int i = 0; i < xxtlength; i++) {
			newXxt[index++] = xxt[i];  // 将消息头拷贝到报文中
		}
		//*begin
		newXxt[index++] = 0xEB;
		//待添加
		
		//*end
		newlength = index;
		
		for(int i =0;i<newlength;i++)
		{
			outXxt[i]=newXxt[i];
		}
	}
	else//加首尾
	{
		newlength = xxtlength+3;//加首尾 25/23/crc
		uint8_t newXxt[newlength];
		
		newXxt[index++]=newlength;
		newXxt[index++]=0x2A;
		for (int i = 0; i < xxtlength; i++) {
			newXxt[index++] = xxt[i];  // 将消息头拷贝到报文中
		}
		newXxt[index++]=0x23;
		newXxt[index++]=xorBytes(&newXxt[1],newlength-1);
		newlength = index;
		
		for(int i =0;i<newlength;i++)
		{
			outXxt[i]=newXxt[i];
		}
	}
	
	//test
//	for (int i = 0; i < newlength; i++) {
//		printf("%02X ", newXxt[i]);  // 以十六进制格式打印每个元素
//	}
	return  newlength;
}

/*需要传入消息体长度sizeof(xxt)/sizeof(xxt[0]);*/
void tt808FsFunc(uint8_t xxt[], uint8_t xxtlength, uint16_t XXID)
{
	HAL_Delay(200);
	xxtnewlength = xxtFZ(xxt, xxtlength, xxtfzData, XXID);
	chuli(XXID);
	
}




// 函数用于提取第7到第8个逗号之间的字符串
void extractString(char* receiveStr, char* result, uint8_t start, uint16_t end)
{
  int comma_count = 0;
  int start_index = -1;
  int end_index = -1;
  int length = strlen(receiveStr);
  // 遍历字符串，统计逗号数量和记录起始和结束索引
  for (int i = 0; i < length; i++)
  {
    if (receiveStr[i] == ',')
    {
      comma_count++;
      if (comma_count == start)
      {
        start_index = i + 1; // 第start个逗号之后的字符
      }
      else if (comma_count == end)
      {
		if(start==1 && end==2)//*纬度去尾符号 
		{
			end_index = i-1; // 第end个逗号之前的字符
		}
		else if(start==2 && end==3)//*经度去尾符号 
		{
			end_index = i-1; // 第end个逗号之前的字符
		}
		else
		{
			end_index = i; // 第end个逗号之前的字符
		}
        
        break;
      }
    }
  }
  
  // 提取字符串并存储在result数组中
  if (start_index != -1 && end_index != -1 && start_index < end_index)
  {
    strncpy(result, receiveStr + start_index, end_index - start_index);
    result[end_index - start_index] = '\0'; // 添加字符串结束符
  }
}

double convertToDouble(char* str) {
  double result;
  sscanf(str, "%lf", &result);
  return result;
}

char hex2asc(const char *hex)
{
	char asc = 0;
	char a = (hex[0]>='A' && hex[0]<='F')?(hex[0]^32):hex[0];
	char b = (hex[1]>='A' && hex[1]<='F')?(hex[1]^32):hex[1];
	if ((a>='0' && a<='9' || a>='a' && a<='f') && (b>='0' && b<='9' || b>='a' && b<='f')){
		asc = ((('a'<=a && a<='f')?(a-'a')+10:a-'0')<<4)|(('a'<=b && b<='f')?(b-'a')+10:b-'0');
	}
	return asc;
}

char *bin2hex(char *hex, const unsigned char *bin, int size)
{
	size_t i;
	for(i=0; i<size; i++)
	{
		sprintf(hex+i*2, "%02x", bin[i]);
	}
	hex[i+i] = 0;
	return hex;
}

int hex2bin(unsigned char *bin, const char *hex)
{
	const char *h = hex;
	unsigned char *b = bin;
	int rlt = 0;
	while(*h){
		*b++ = hex2asc(h);
		h = h + 2;
		rlt++;
	}
	return rlt;//长度
}

void ReMIPURC(void)
{
	 //4D 49 50 55 52 43
	 if(U4_4GrecvBuff[1]==0x4D && U4_4GrecvBuff[2]==0x49 && U4_4GrecvBuff[3]==0x50 \
		  && U4_4GrecvBuff[4]==0x55 && U4_4GrecvBuff[5]==0x52 && U4_4GrecvBuff[6]==0x43 )	//监测平台回复+MIPURC: 
	 { 
		uint8_t high_byte = (U4_4GrecvBuff[18]&0x0f) *10; 
		uint8_t low_byte = U4_4GrecvBuff[19]&0x0f; 
		hccd = high_byte + low_byte;
		memcpy(MIPurc1,&U4_4GrecvBuff[21],hccd*2);
		const char *hex = (const char *)MIPurc1;  // 将 uint8_t * 转换为 const char *
		int size = strlen(hex) / 2;  // 计算二进制数据的长度
		unsigned char *bin = (unsigned char *)malloc(size);  // 分配足够的内存用于存储二进制数据
		rlt = hex2bin(bin, hex);  // 调用hex2bin函数进行转换
		memcpy(MIPurc, bin, rlt);  // 将 bin 中的 rlt 个字节复制到 MIPurc1 中						接收到的数据放入MIPurc1中
		free(bin);  // 释放内存  
		 
		memset(U4_4GrecvBuff,0,BUFFER_SIZE);
		memset(MIPurc1,0,100);
		 
	 }
	 
				//时间     纬度(北纬)   经度(东经)  水平精度因子  海拔高度    定位类型(1无,2 2d,3 3d) 运动角度    水平运动速度(KM/h)    水平运动速度(Knots)	日月年	卫星数量	差分定位标识(1单点,2差分)
//eg.+MGNSSLOC: 015032.301,3014.8605N,12001.9250E,1.8,			17.6,		3,                      0.00,		3.6,			      1.9,					080424,	12,			1	 
	 else if((U4_4GrecvBuff[2]==0x47 || (U4_4GrecvBuff[0]==0x4F && U4_4GrecvBuff[1]==0x4B)) && MgnssFlag)	//监测平台回复+MGNSSLOC OK4f4b
	 {

		memcpy(MGNSSLOC,&U4_4GrecvBuff[11],75);
		
		GnssFlag=true;
	
		memset(U4_4GrecvBuff,0,BUFFER_SIZE);
	 }
	 

	else if(U5_BTrecvBuff[0]==0x66 && U5_BTrecvBuff[1]==0x00 && U5_BTrecvBuff[2]==0x02 && U5_BTrecvBuff[3]==0x01)//解封接收
	{
		if(U5_BTrecvBuff[4]==0x01)
		{//接收完成
			tipsflag = FinshOK;
			HAL_Delay(1000);
			if(preworkUp==3)
			{
				SET_MENU_STATUS(4,1,0,3);
			}
			else if(preworkUp==2)
			{
				SET_MENU_STATUS(5,1,0,3);
			}
			else if(preworkUp==1)
			{
				SET_MENU_STATUS(6,1,0,3);
			}
			else if(preworkUp==0)
			{
				SET_MENU_STATUS(7,1,0,3);
			}
			//USART_SendString(&huart5, "AT+DISCONN=0\r\n");//断开连接
		}
		else if(U5_BTrecvBuff[4]==0x02)
		{//流水号异常
			
		}
		
	}
	else if(U5_BTrecvBuff[0]==0x66 && U5_BTrecvBuff[1]==0x00 && U5_BTrecvBuff[2]==0x03 && U5_BTrecvBuff[3]==0x01)//解封接收
	{
		if(U5_BTrecvBuff[4]==0x01)
		{//接收完成
			tipsflag = FinshOK;
			HAL_Delay(1000);
			if(preworkUp==3)
			{
				SET_MENU_STATUS(4,1,0,3);
			}
			else if(preworkUp==2)
			{
				SET_MENU_STATUS(5,1,0,3);
			}
			else if(preworkUp==1)
			{
				SET_MENU_STATUS(6,1,0,3);
			}
			else if(preworkUp==0)
			{
				SET_MENU_STATUS(7,1,0,3);
			}
			//USART_SendString(&huart5, "AT+DISCONN=0\r\n");//断开连接
		}
		else if(U5_BTrecvBuff[4]==0x02)
		{//流水号异常
			
		}
		
	}
	
	
	else if(U5_BTrecvBuff[0]==0x2B && U5_BTrecvBuff[1]==0x43 && U5_BTrecvBuff[2]==0x50 && U5_BTrecvBuff[3]==0x49 && U5_BTrecvBuff[4]==0x4E && \
		U5_BTrecvBuff[5]==0x3A && U5_BTrecvBuff[6]==0x20 && U5_BTrecvBuff[7]==0x53 && U5_BTrecvBuff[8]==0x49 && U5_BTrecvBuff[9]==0x4D && U5_BTrecvBuff[10]==0x20 && U5_BTrecvBuff[11]==0x52)//+CPIN: SIM R
	{
		reset4Gmodule = true;
	}

 }

void MIPURCHandle(void)
{
	 if(MIPurc[0]==0x7E)
	 {
		 uint16_t PTXXID = MIPurc[1]<<8 | MIPurc[2];		//消息ID
		 uint16_t xxtcLen = MIPurc[3]<<8 | MIPurc[4];		//数据长度
		 uint16_t xxRE = MIPurc[15]<<8 | MIPurc[16];		//回复ID
		 uint8_t YESorNO = MIPurc[17];						//00 success ; 01 fail
		 
		 if(PTXXID==XXID_pttyyd)			//收到平台通用应答0x8001
		 {
			 			 
			if(xxRE == XXID_zdjq)//回复鉴权ID
			{
				if(YESorNO==YES)
				{
					printf("@鉴权应答yes\r\n");
					ZDJQflag = true;
				}
				else if(YESorNO==NO)
				{
					printf("@鉴权应答no\r\n");
				}
				memset(MIPurc,0,rlt);//rlt下发长度 
			}
			if(xxRE == XXID_zdxt)//回复鉴权ID
			{
				if(YESorNO==YES)
				{
					printf("@心跳应答yes\r\n");
				}
				else if(YESorNO==NO)
				{
					printf("@心跳应答no\r\n");
				}
				memset(MIPurc,0,rlt);//rlt下发长度 
				
			}
		 }
		 
		 else if(PTXXID == XXID_ptxxtc)	//收到平台消息透传 8900
		 {
			 uint8_t tcsjLen = MIPurc[13];
			 memcpy(MIPurcXXTCSJ,&MIPurc[13],xxtcLen);
			 printf("@得到透传数据,%d\r\n",tcsjLen);
			 memset(MIPurc,0,rlt);//rlt下发长度 
			 
		 }

	 
	 }
	 
	 else if(ZDJQflag)
	 {
		 ZDJQflag = false;
		 HAL_Delay(500);
	 	 uint8_t test[] = {0xAA};			//test心跳
		 tt808FsFunc(test,1,XXID_zdxt);		//test心跳
		 uploadtime = HAL_GetTick();//获取首次发送状态信息基准时间
	 }
	 

	 
}


time_t timestamp ;
void time_bj(void) {
	
		struct tm timeinfo;
		timeinfo.tm_year = tt808.Rtime[0]+2000-1900;
		timeinfo.tm_mon = tt808.Rtime[1]-1;
		timeinfo.tm_mday = tt808.Rtime[2];
		timeinfo.tm_hour = tt808.Rtime[3];
		timeinfo.tm_min = tt808.Rtime[4];
		timeinfo.tm_sec = tt808.Rtime[5];
		timestamp = mktime(&timeinfo);
			
		db.timeStamp[0] = (timestamp >> 16)&0xFFFF;
		db.timeStamp[1] = (timestamp)&0xFFFF;
}







void ReU4Proces(void)
{
	if(GnssFlag)
	{
		GnssFlag=false;
		RTCtime();//同步时间

		// 调用函数提取字符串
		extractString(MGNSSLOC, cSpeed,7 ,8);//采集
		dSpeed = convertToDouble(cSpeed);	//转换浮点数
		dSpeed*=100;


		// 调用函数提取字符串
		extractString(MGNSSLOC, wd,1 ,2);//采集
		dWd = convertToDouble(wd);	//转换浮点数
		dWd*=10000;

		// 调用函数提取字符串
		extractString(MGNSSLOC, jd,2 ,3);//采集
		dJd = convertToDouble(jd);	//转换浮点数
		dJd*=10000;
		
		if(dSpeed !=0 && dWd!=0 &&dJd!=0) //有数据进行更新！
		{
			db.speed[0] = (uint16_t)dSpeed;
			db.WD_u16[0] = ((uint32_t)dWd >> 16) &0xffff;
			db.WD_u16[1] = ((uint32_t)dWd) &0xffff;		// 打印提取到的字符串
			db.JD_u16[0] = ((uint32_t)dJd >> 16) &0xffff;
			db.JD_u16[1] = ((uint32_t)dJd) &0xffff;
		
//			printf("提取到的字符串为：%s\n", speed);
//			printf("Converted double: %.f\n", dSpeed);
//			printf("Converted double: %04X\n", db.speed[0]);
//			printf("提取到的字符串为：%s\n", wd);
//			printf("Converted double: %.f\n", dWd);
//			printf("Converted double: %04X%04X\n", db.WD_u16[0],db.WD_u16[1]);		 
//			printf("提取到的字符串为：%s\n", jd);
//			printf("Converted double: %.f\n", dJd);
//			printf("Converted double: %04X%04X\n", db.JD_u16[0],db.JD_u16[1]);	
			if(menu.current == 0xBB)
			{
				menu.current = 0;
				refresh=true;
			}
		}
 		else
		{
			if(signal)
			{ 
				//signal = false;
				menu.current = 0xBB;
				tipsflag = Nosignal;
				refresh=true;
			}

		}

		//printf("Time: %04X%04X\n", db.timeStamp[0],db.timeStamp[1]);		

		memset(MGNSSLOC,0,100);

	}
}