dtu/Core/Src/tt808.c

#include "tt808.h"
#include "usart.h"
#include "key.h"
#include <stdio.h>
#include <time.h>
#include <stdlib.h>
#include <string.h>
#include "rtc.h"
//*整型
int rlt;
uint16_t uploadtime=0;	//上传时间
uint16_t hccd = 0;//ascii个数(*2)
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 dlatitude=0;
double dlongitude=0;
char cSpeed[10];
char clatitude[15];
char clongitude[15];
char csatellitesNum[5];
char MGNSSLOC[100];	//接收定位数据
char CSQ[12];	//接收定位数据

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;
//*布尔
bool ZDJQflag = false;
bool GnssFlag = false;



uint8_t Messagetemp_length=0;
uint8_t MessageHandleData[100];	//放入封装后数据
uint8_t tcppacket[100]; //消息数据
void MessageHandle(uint16_t MessageID)
{

	uint16_t MessageAttributeData = Messagetemp_length;
	MessageAttributeData |= ( Messagetemp_length | (TCPJMFSNULL<<10)); // 将长度左移3位后和加密方式进行按位或操作(001 RSA ,000 无加密)
	
	header[0] 	= ((MessageID>>8)&0xff);
	header[1] 	= (MessageID&0xff);				//消息ID
	header[2] 	= ((MessageAttributeData>>8)&0xff);
	header[3] 	= (MessageAttributeData&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 < Messagetemp_length; i++) {
		tcppacket[index++] = MessageHandleData[i];
	}
	tcppacket[index++] = xorBytes(&tcppacket[1],12+Messagetemp_length);;  // 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 消息体封装
  * Message[] 消息数据;	length 消息数据长度;	outMessage[] 封装后消息数据; MessageID 消息ID
  */
uint8_t Message_bodydata(uint8_t *Message, uint8_t length, uint8_t outMessage[],uint16_t MessageID)
{
	int index = 0;
	uint8_t temp_length = 0;//加首尾 25/23/crc
	
	if(MessageID==MessageID_authentication  || MessageID==MessageID_heartbeat)//不加头尾（鉴权、心跳）
	{
		temp_length = length;//不加首尾
		uint8_t temp_Message[temp_length];
		
		for (int i = 0; i < length; i++) {
			temp_Message[index++] = Message[i];  // 将消息头拷贝到报文中
		}
		
		temp_length = index;
		
		for(int i =0;i<temp_length;i++)
		{
			outMessage[i]=temp_Message[i];
		}
	}
	else if(MessageID==MessageID_location)//终端地址0200 有附加信息
	{
		
		temp_length = length+6;//不加首尾
		uint8_t temp_Message[temp_length];
		
		for (int i = 0; i < length; i++) {
			temp_Message[index++] = Message[i];  // 将消息头拷贝到报文中
		}
		//*begin
		temp_Message[index++] = 0x30;//信号强度关键字
		temp_Message[index++] = 0x01;//信号强度数据长度
		temp_Message[index++] = dblocptr->location.CSQ;//信号强度值
		temp_Message[index++] = 0x31;//信号强度关键字
		temp_Message[index++] = 0x01;//信号强度数据长度
		temp_Message[index++] = dblocptr->location.satellitesNum;//卫星数量
		
		for(int i =0;i<temp_length;i++)
		{
			outMessage[i]=temp_Message[i];
		}
	}
	else//加首尾
	{
		temp_length = length+3;//加首尾 25/23/crc
		uint8_t temp_Message[temp_length];
		
		temp_Message[index++]=temp_length;
		temp_Message[index++]=0x2A;
		for (int i = 0; i < length; i++) {
			temp_Message[index++] = Message[i];  // 将消息头拷贝到报文中
		}
		temp_Message[index++]=0x23;
		temp_Message[index++]=xorBytes(&temp_Message[1],temp_length-1);
		temp_length = index;
		
		for(int i =0;i<temp_length;i++)
		{
			outMessage[i]=temp_Message[i];
		}
	}
	
	//test
//	for (int i = 0; i < temp_length; i++) {
//		printf("%02X ", temp_Message[i]);  // 以十六进制格式打印每个元素
//	}
	return  temp_length;
}

/*需要传入消息体长度sizeof(Message)/sizeof(Message[0]);*/
void tt808FsFunc(uint8_t* Message, uint8_t length, uint16_t MessageID)
{
	HAL_Delay(200);
	Messagetemp_length = Message_bodydata(Message, length, MessageHandleData, MessageID);
	MessageHandle(MessageID);
	
}

void printBytes(uint8_t *data, size_t length) {
    for (size_t i = 0; i < length; i++) {
        printf("%02x ", data[i]);
    }
    printf("\n");
}
// 函数用于提取第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) {
	if(str == csatellitesNum)
	{
	  uint8_t result;
	  sscanf(str, "%hhu", &result);
	  return result;
	}
	else
	{
	  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;
}
uint8_t testHex2Asc(const char *hex) {
    char asc = hex2asc(hex);
    printf("Hex: %s\tASC: %d\n", hex, asc);
	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;//长度
}

// 将单个十六进制数转换为 BCD 码
uint8_t hexToBcd(uint8_t hex) {
    return ((hex / 10) << 4) | (hex % 10);
}
// 将整数数组中的所有十六进制数转换为 BCD 码
void hexArrayToBcd(uint8_t* array, size_t length, uint8_t* out) {
	array[3]+=8;
    for (size_t i = 0; i < length; i++) {
        out[i] = hexToBcd(array[i]);
    }
}

//MgnssFlag = true;
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 && U4_4GrecvBuff[10] != 0x64)	//监测平台回复+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);
		 
	 }
	//64 69 73 63 6f 6e 6e 22 2c 31 2c 31 "disconn"
	 else if(U4_4GrecvBuff[10]== 0x64 && U4_4GrecvBuff[11]== 0x69 && U4_4GrecvBuff[12]== 0x73 && U4_4GrecvBuff[13]== 0x63 && U4_4GrecvBuff[14]== 0x6f \
		 && U4_4GrecvBuff[15]== 0x6e && U4_4GrecvBuff[16]== 0x6e && U4_4GrecvBuff[17]== 0x22 \
		 && U4_4GrecvBuff[18]== 0x2c && U4_4GrecvBuff[19]== 0x31 && U4_4GrecvBuff[20]== 0x2c && U4_4GrecvBuff[21]== 0x31)
	 {
		 ML307AReset();
		 memset(U4_4GrecvBuff,0,BUFFER_SIZE);
	 }

				//时间     纬度(北纬)   经度(东经)  水平精度因子  海拔高度    定位类型(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;
	 }
	 else if(U4_4GrecvBuff[1]== 0x4D && U4_4GrecvBuff[2]== 0x47 && U4_4GrecvBuff[3]== 0x4E && U4_4GrecvBuff[4]== 0x53 && U4_4GrecvBuff[5]== 0x53 \
		 && U4_4GrecvBuff[6]== 0x55 && U4_4GrecvBuff[7]== 0x52 && U4_4GrecvBuff[8]== 0x43 \
		 && U4_4GrecvBuff[9]== 0x3A && U4_4GrecvBuff[10]== 0x20 && U4_4GrecvBuff[11]== 0x22 && U4_4GrecvBuff[12]== 0x73 \
		 && U4_4GrecvBuff[19]== 0x31 )
	 {
		 MgnssFlag = true;
	 }
	 else if(U4_4GrecvBuff[1]== 0x43 && U4_4GrecvBuff[2]== 0x53 && U4_4GrecvBuff[3]== 0x51)//CSQ 信号
	 {
		memcpy(CSQ,U4_4GrecvBuff,U4_4GrecvLength);
		tt808.CSQ = (CSQ[6]&0xf*10)+(CSQ[7]&0xf);
		memset(CSQ,0,12);
		memset(U4_4GrecvBuff,0,BUFFER_SIZE);
	 }

 }

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 == MessageID_authentication)//回复鉴权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 == MessageID_heartbeat)//回复鉴权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[] = {0x05};			//test心跳
		 tt808FsFunc(test,1,MessageID_heartbeat);		//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]-8;
	timeinfo.tm_min = tt808.Rtime[4];
	timeinfo.tm_sec = tt808.Rtime[5];
	timestamp = mktime(&timeinfo);
		
	dblocptr->location.timeStamp = timestamp;
}



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

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


		// 调用函数提取字符串
		extractString(MGNSSLOC, clatitude,1 ,2);//采集
		dlatitude = convertToDouble(clatitude);	//转换浮点数
		dblocptr->location.latitude = convertGPS(dlatitude);
		
		extractString(MGNSSLOC, clongitude,2 ,3);//采集
		dlongitude = convertToDouble(clongitude);	//转换浮点数
		dblocptr->location.longitude = convertGPS(dlongitude);
		
		
		extractString(MGNSSLOC, csatellitesNum,10 ,11);//采集卫星个数
		tt808.satellitesNum = convertToDouble(csatellitesNum);	//转换浮点数
		//printf("%d",tt808.satellitesNum);
		
		
		dblocptr->location.speed  = (uint16_t)dSpeed;
		
		
		if(dSpeed !=0 && dlongitude!=0 && dlatitude!=0) //有数据进行更新！
		{
			signal = true;			
			
			if(menu.current == 0xBB && tipsflag!= ConnOK)
			{
				menu.current = 0;
				refresh=true;
			}
			else if(tipsflag == Back && signal)
			{
				menu.current = 0;
				refresh=true;
			}
		}
 		else
		{
			if(signal && sys_mode[0]!=0xFFFF)
			{ 
				signal = false;
				menu.current = 0xBB;
				tipsflag = Nosignal;
				refresh=true;
			}

		}
		
		
		memset(MGNSSLOC,0,100);

	}
}