HS191L_HK/USER/GPS/TSGpsProcess.c

 /**********************************************************************************
 * File Name: TSGpsProcess.c
 * Function Describe:device for Gps Process	for TS/T808
 * Relate Module:
 * Explain:	采用TCP或UDP格式传输
 * Writer:  wuzhao
 * Date:	2015.12.14
 *外设类型：0x01，
 *命令类型：0x05
***********************************************************************************/
#define THIS_FILE_ID 24
//-------------------------------------------------------------------------------------------

#include "includes.h"

SUT_GPS_SEND_DATA sutGpsSendData;
//SUT_PRODUCT_PARA TSsutProductPara;
REGISTRATION Regist;
AVL_MSG_BODY_ATTRIB msgBodyAttrib;
MSG_HEAD msghead;
MSG_PACKET msgPacket;
AUTH auth;
SIM SimData;
unsigned int a;
unsigned int b;
char GPSDataBuf[8];
char GPSDataBuf1[8];
//*p_buf -- *m_data   size -- m_size
/**********************************************************************************
GpsSendHead
***********************************************************************************/
void TSGpsServerConect(void)
{	
	int len;
	unsigned char buf[100];
	unsigned char temp[5];
	SUTDS ds;
	SlwTrace(INF, "Device ACK",1);
	memcpy(temp, (unsigned char*)&sutFeed.feedliushuiID,2);
	ds.Data.usData=sutFeed.feedID;
	temp[2] = ds.Data.ucData.b2;
	temp[3] = ds.Data.ucData.b1;
	temp[4] = sutFeed.result;
	len=TSGpsPacket(buf,sutProductPara.PSN,TS_TERMINAL_UNIVERSAL_ANSWER,temp,sizeof(temp));
	MC8332ModemSendTcpData(GPS_DATA_SOCKET,buf,len);
}
//从厂商编号到用户数据依次累加的累加和，取累加的档�8位作为校验码
unsigned char TSGetCheckSum(unsigned char *pData,int len)
{
	int i;
	unsigned char sum= pData[1];           //sum=0;
	for(i=1;i<len-1;i++){
		sum=sum^pData[i+1];
	}	
	return sum;
}

/*************************************************************************************
*
**************************************************************************************/
// replace 0x7d 0x01 with 0x7d and 0x7d 0x02 with 0x7e  接收
//长度不会变大，只会变小或不变
int reduce(unsigned char *pData,int DataLen)
{  
	unsigned char *p = pData;
	int data_len=0;
	int i;
	
	if(DataLen==0) return 0;
	for(i=0;i<DataLen-1;i++)
	{
		if(pData[i] == 0x7d && pData[i+1] == 0x01)
		{
			*p++ = 0x7d;i++;
		}else if(pData[i] == 0x7d && pData[i+1] == 0x02)
		{
			*p++ = 0x7e;i++;
		}else *p++=pData[i];
		data_len++;
	}
	
	return data_len;
}
// loop every character, replace 0x7d with 0x7d 0x01 and 0x7e with 0x7d 0x02  发送
int  escapse(unsigned char *pData,int DataLen) {  
   
	  unsigned char *p= (unsigned char *)malloc(DataLen * 2);  
	  unsigned char * q = p;
    int data_len = 0; 
		int i;	
	if (DataLen == 0) {  
        return 0;  
    }     
    	
    memset(p, 0, DataLen * 2);  
      
    for (i = 0; i < DataLen; i ++) {  
        if (pData[i] == 0x7d) {  
            *q ++ = 0x7d;  
            *q ++ = 0x01;  
            data_len += 2;  
        } else if (pData[i] == 0x7e) {  
            *q ++ = 0x7d;  
            *q ++ = 0x02;  
            data_len += 2;  
        } else {  
            *q ++ = pData[i];  
            data_len += 1;  
        }  
    }   
		memcpy(pData, p, data_len);
		free(p);
		DataLen	 = data_len;	
		//free(p); 
		return DataLen;
}  


/******************************************************/
int* TenToTwo(int Datalen)
{
	 static int c[10]={0};
	 int i=0;
		do {
        c[i++]=Datalen%2;
        Datalen/=2;
    } while(Datalen!=0);
		
		return c;
}
/**********************
**消息头12字节，消息体属性2个字节，这两个字节的16位。低10位是消息体长度
因此消息消息最长小于1024字节，Bit13是分包标志，看终端发到平台一个消息，可能很长，一个消息体发不完，分包发出去那么
Bit12置为1，消息头长度变成16字节，消息头的后4个字节为消息包分装项内容，总共
有多少个包，这次发送的消息包是分包中的第几个消息包
sutProductPara.APN
**************************/
int TSGpsPacket(unsigned char *Buffer,unsigned long PSN,unsigned short ID,unsigned char *pData,int DataLen)
{
	static unsigned short liushiID=0;
	unsigned char *pBuf=Buffer,sum;
	int j,flag = 0,i=0;
	int talpage=1,MSnum = 0;
  char Psnsv[12];
	static unsigned short snum = 1;
	unsigned short Len=DataLen+6;
	unsigned short pageItem=DataLen+12;

	snprintf(Psnsv, sizeof(Psnsv),"%010u",(unsigned int)PSN);
	pBuf[i++]=0x7e;	
	
	pBuf[i++]=(ID>>8)&0xff;
  pBuf[i++]=ID&0xff;

	//消息体属性
	msgBodyAttrib.EncrypType=NO_ENCRYP;//NO_ENCRYP;
	msgBodyAttrib.msgBodyLength=(DataLen);
	pBuf[i++]=msgBodyAttrib.EncrypType;
	pBuf[i++]=msgBodyAttrib.msgBodyLength;

	//SIM卡号
	pBuf[i++]=0; //
	for (j=0;j<10;j+=2) 
	{
  pBuf[i++]=(Psnsv[j]<<4)|(Psnsv[j+1]&0x0F);
  }
	
	//消息流水号
	pBuf[i++] = (liushiID>>8)&0xff;
	pBuf[i++] = liushiID&0xff;
	liushiID++;
	
	if(pData!=NULL)
	{
		//snum++;
		//消息包封装项
		//msgPacket.msgPacketID=0x30;
		//msgPacket.msgTotalCount=0x30;
		//pBuf[i++] = msgPacket.msgPacketID;
		//pBuf[i++] = msgPacket.msgTotalCount;
		//MSnum++;
		//包封装项  4
		for(j=0;j<DataLen;j++)
		{//0
			pBuf[i++]= pData[j];
		}
	}
	sum = TSGetCheckSum(pBuf,i);
	
	pBuf[i++] = sum;
	//对整体数据，除sum进行转义
	i=escapse(&pBuf[1],i-1);//头的7E不转义
	i++;
	pBuf[i++] = 0x7e;

	return i;
}

/************************************************************
位置信息汇报
*************************************************************/
/**********************************************************************************
GpsSendPosition	   
发送位置数据
Head(2) Cmd(2) Len(2) PSN(4) GpsData(34) Check(1) End(1)  
Cmd=0x0200
总长度=2+2+2+40=46
***********************************************************************************/
void TSGpsSendPosition(void)
{
	int i;
	int len;
	char tmp[5];
	char buf[150];
	unsigned char GpsBuf[50];
  len=TSGpsPacket(GpsBuf,sutProductPara.PSN,0x0200,(unsigned char *)&sutGpsSendData,sizeof(SUT_GPS_SEND_DATA));
	//sprintf(buf,"AT+ZIPSEND=0,%d\r",len);
	snprintf(buf, sizeof(buf),"AT^IPSEND=1,%d\r",len);//+ 1?
	ModemSendAT(buf);
	ModemSendData(GpsBuf,len);
	

	strcpy(buf,"SendGpsD:");
	for(i=0;i<len;i++){
		snprintf(tmp, sizeof(tmp),"%02x,",GpsBuf[i]);
		strcat(buf,tmp);
	}	
	SlwTrace(INF,buf,1);
}


/*******************************************************
GPRMC信息，与，之间的子信息处理，存储到相应的结构体中元素中
 *******************************************************/
void TSGPS_GPRMC_Handle(unsigned char *ch,unsigned char ch1)	//1处		  	
{
	unsigned char x,y;
//	send_byte('d');	
	switch(ch1)
	{			 
		case 0:	   //时间
			for(x=0,y=0;x<8;x++)
			{
				if(x==2||x==5){ sutGpsInfo.Time[x]=0x3a;}
				else  sutGpsInfo.Time[x]=ch[y++];
			}
		//	send_byte(time[7]);
			break;
		case 1:	   //状态
			 sutGpsInfo.Status=ch[0];
			break;
		case 2:		//纬度
			 for(x=10,y=0;x<17;x++)
			{
				if(x==12||x==15) {}
				else  sutGpsInfo.Location[x]=ch[y++];
			}
			break;
		case 3:	   //南北纬
			 sutGpsInfo.Location[9]=ch[0];
			break;
		case 4:		//经度
			for(x=1,y=0;x<8;x++){
				if(x==4||x==7){}
				else  sutGpsInfo.Location[x]=ch[y++];
			}
			break;
		case 5:	  //东西经
			 sutGpsInfo.Location[0]=ch[0];
			break;
		case 6:		//航速
			for(x=0;x<6;x++){
				 sutGpsInfo.Speed[x+1]=ch[x];	
			}
			 sutGpsInfo.Speed[6]=0x20;
			 sutGpsInfo.Speed[7]=0x20;
			break;
		case 7:         //信息自己定义
			break;
		case 8:		//信息自己定义
			break;
		case 9:		//信息自己定义
			break;
		case 10:		//信息自己定义
			break;
		case 11:		//信息自己定义
			break;
		default:break;						 
	}
}	
/*******************************************************
 处理GPRMC信息
 *******************************************************/
void TSGPS_GPRMC_Alysis(char *RMC_Data)		//2处				
{
	unsigned char 	i,j,k;
	unsigned char	count;
	unsigned char temp[10];	
	//send_byte('a');
for(i=0;i<strlen(RMC_Data);)
{
	switch(RMC_Data[i])
	{
	case '$':
		j=i++;							//标记$的起始位置
		while(RMC_Data[i]!=',')			//RMC_Data[i]==','时结束循环。
		{i++;}
	//	uart1_sendbytes(GPRMC[RMC_Count].RMC_ID);
		break;					
	case ',':
		j=i++;												//标记,的起始位置
		while((RMC_Data[i]!=',')&&(RMC_Data[i]!='*')) 		//RMC_Data[i]==','或者=='*'时结束循环。
		{i++;}
		if(j+1!=i)
		{
			
			for(j=j+1,k=0;j<i;j++)
			{
				temp[k++]=RMC_Data[j];	
			}
			temp[k]='\0';
//				send_byte(temp[0]);	
		}
		else temp[0]='\0';
	//	send_byte('c'); 
		TSGPS_GPRMC_Handle(temp,count++);
		break;
	case '*':			
			i=strlen(RMC_Data);									//处理完成，软件结束。		
			break;	
	default:break;
		 
	}	
}
//	send_byte('e');	
}
void TSGpsDataInit(void)
{
	unsigned char *p;
	char buf2[20];
	p=(unsigned char *)&sutGpsSendData;
	memset(p, 0, sizeof(SUT_GPS_SEND_DATA));	
	p=(unsigned char *)&sutGpsInfo;
	memset(p, 0, sizeof(SUT_GPS_INF));	
	
	#if 1

  snprintf(buf2, sizeof(buf2), "Gpstime=%d",GPS_TimeTable[newPara.gpsTimeIndex]);
	SlwTrace(INF, buf2,1);
	#else
	sutGpsInfo.SendTime=10;//默认主动上报时间间隔 单位为15秒
	sutGpsInfo.GPSSendTime=10;
	#endif
	
	sutGpsInfo.isGpsAuthOk = 0;//未鉴权
}

/*************************************************************************
*检查GPS 服务器发过来的数据包是否正确
非法 返回0
合法 返回命令码
**************************************************************************/
//"7e8300 000c 000009771810000001 4130313233343536373839 b87e"
unsigned char TSGpsServerCheckPack(unsigned char *data,unsigned short DataLen)//3处		
{
	unsigned char cmd;
	unsigned short len;
	unsigned long PSN;
	
	//判断数据包的包头是否正确
//	escapse(data,DataLen);
	if(data[0]!=TSGPS_PACK_HEAD)return 0;			
	//判断数据包的校验是否正确

	if(data[DataLen-2] != TSGetCheckSum(data,DataLen-2))
		return 255;
	//判断数据包的结尾是否正确
	if(data[DataLen-1] != TSGPS_PACK_END)
		return 255;
	//获取数据包的长度	并判断长度是否正确
	len=(unsigned short)data[3]*256+data[4];
	if(DataLen!=(len+5))return 255;
//	//判断终端编号是否正确
//	PSN=(unsigned long)data[5]<<24;
//	PSN+=(unsigned long)data[6]<<16;
//	PSN+=(unsigned long)data[7]<<8;
//	PSN+=(unsigned long)data[8];
//	if(PSN!=sutNetPara.PSN)	return 0;
	//解析当前命令
	cmd = data[2];
	sutGpsInfo.HostCmd = cmd;
	return cmd;
}
/**************************************************************************************************
*		// TS_PROID  440000
		// TS_CITYID  440300
车牌D4C1423738583134
***************************************************************************************************/
void TSMakeSendData(void)
{
	#if 0
		int i,len;
//		static  int Table[20]={0};
		static  int Table1[20]={0};
	  static int Temp[8];
		static int Temp1[4];
		const unsigned char acTemp[]={
		0x34,0x31,0x30,0x30,0x30,//制造商ID Regist.Manufacturers
			//32 30 31 34 30 34 00 00 00 00 00 00 00 00 00 00 00 00 00 00
		0x32,0x30,0x31,0x34,0x30,0x34,0x00,0x00,0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, //终端型号Regist.TerMod
		0x65,0x30,0x30,0x72, //终端IDRegist.TerID
	};

	const unsigned char TSacTemp[]={
		0xD4,0xC1,0x42,0x37,0x38,0x58,0x31,0x34,
	};
//		len = strlen(sutProductPara.REG);
//	if(!len){
//		Regist.CityID = ((TS_CITYID>>8)&0xffff);
//		Regist.CityID = (TS_CITYID&0xffff);
//		Regist.CityID = ((TS_CITYID>>24)&0xffff);
//		Regist.CityID = ((TS_CITYID>>16)&0xffff);
//		
//		Regist.proID =((TS_PROID>>8)&0xff);
//		Regist.proID =(TS_PROID&0xff);
//		
//		for(i = 0; i < 5; i++){
//		Regist.Manufacturers[i] = acTemp[i];
//		}
//		for(i = 0; i < 20; i++){
//		Regist.TerMod[i]= acTemp[i+5];
//		}
//		for(i = 0; i < 4; i++){
//		Regist.TerID[i]= acTemp[i+25];
//		}
//		
//		Regist.PlateColor=0x01;//未上牌取值为0
//	//  车牌颜色为0  表示车辆VIN
//		for(i = 0; i < 8; i++){//7会返回
//			Regist.Plate[i] = TSacTemp[i];
//		}
//	}else{
			Regist.proID =((sutProductPara.proID>>8)&0xff);
			Regist.proID =(sutProductPara.proID&0xff);
			
			Regist.CityID = ((sutProductPara.CityID>>24)&0xffff);
			Regist.CityID = ((sutProductPara.CityID>>16)&0xffff);
			Regist.CityID = ((sutProductPara.CityID>>8)&0xffff);
			Regist.CityID = (sutProductPara.CityID&0xffff);
	
			for(i = 0; i < 5; i++){
			Regist.Manufacturers[i] = sutProductPara.Manufacturers[i];
			}
			
			for(i = 0; i < 20; i++){
			//sscanf(sutProductPara.TerMod+2*i,"%2x",&Table1[i]);
				if((i<20)&&(sutProductPara.TerMod[i]!='0')){
					//sscanf(sutProductPara.TerMod+2*i,"%2x",&Table1[i]);
					Regist.TerMod[i]= sutProductPara.TerMod[i];
			}else{
			Regist.TerMod[i]=0x00;
			}
			
			}
			for(i = 0; i < 4; i++){
			sscanf(sutProductPara.TerID+2*i,"%2x",&Temp1[i]);
			Regist.TerID[i]= Temp1[i];
			}

			Regist.PlateColor=sutProductPara.PlateColor;//

			for(i = 0; i < 8; i++){
			sscanf(sutProductPara.Plate+2*i,"%2x",&Temp[i]);
			Regist.Plate[i] = Temp[i];
	
			}
//		}	
			#else
			memcpy((unsigned char *)&Regist, (unsigned char *)&newPara.authPara.registerPara, sizeof(Regist));
			#endif
}
/************************************************************
终端注册、注销
*3431303030制作商ID
3230313430340000000000000000000000000000终端型号
30303030313131 终端ID
*************************************************************/
uint32_t Process_TSRegistration(char* buf, uint32_t len)
{
	unsigned char SendBuf[100];
	unsigned short PacketLen;
	
	if(g_ucSelect==1){
	TSMakeSendData();
	}else{
	TSRegData();
	}
	//REGISTRATION Regist;
	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_TERMINAL_REGISTRATION,(unsigned char *)&Regist,sizeof(REGISTRATION));
	MC8332ModemSendTcpData(0,SendBuf,PacketLen);
	return len;
	
}
void Registration(void)
{
	SlwTrace(INF,"Try-Reg!",1);
//	if(sutProductPara.SIMFlag){SIMReg();}
#if 0
	if(sutProductPara.Select==1) TSMakeSendStrData();  // 串口注册
	else TSRegData(sutProductPara.PSN);
#else
	TSRegData();
#endif
}

void RegistrationLogout(void)
{
	unsigned char SendBuf[100];
	unsigned short PacketLen;
	
	unsigned char *data=NULL;
	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_TERMINAL_CANCELLATION,data,0);
	MC8332ModemSendTcpData(0,SendBuf,PacketLen);
}

/************************************************************
终端鉴权
*************************************************************/

void Authentication(void)
{
	unsigned char SendBuf[100];
	unsigned short PacketLen;

	SlwTrace(INF,"Re-Authentication!",1);
	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_TERMINAL_AUTHENTICATION,newPara.authPara.authCode,sizeof(newPara.authPara.authCode));//实际是返回的鉴权信息
	MC8332ModemSendTcpData(GPS_DATA_SOCKET,SendBuf,PacketLen);
}
//以下
uint32_t Process_TSAuthentication(char* buf, uint32_t len)
{
	unsigned char SendBuf[100];
	unsigned short PacketLen;
	
	TSMakeGpsSendData();
	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_TERMINAL_AUTHENTICATION,(unsigned char *)&auth,sizeof(AUTH));
	MC8332ModemSendTcpData(0,SendBuf,PacketLen);
	return len;
}

/************************************************************
位置信息查询
*************************************************************/
uint32_t Process_TSCenterGetPos_rsp(unsigned char* buf, unsigned short len)
{
	unsigned char SendBuf[100];
	unsigned short PacketLen;
	TSMakeGpsSendData();
	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_LOCATION_INFORMATION_INQUIRY,(unsigned char *)&sutGpsSendData,sizeof(SUT_GPS_SEND_DATA));
	MC8332ModemSendTcpData(0,SendBuf,PacketLen);
	return 0;
}
uint32_t Process_TSClient_rsp(char* buf,  unsigned short len)
{	
	if(!sutGpsInfo.isServerLogin){
		sutGpsInfo.isServerLogin=1;
		SlwTrace(INF,"[Gps Logined]",1);
	}	
	return 0;
}

/**************************************************************************************************
*看下 如果一直发注册信息会如何
***************************************************************************************************/
void TSGpsTimingSendPos(void)
{
	unsigned char SendBuf[100];
	unsigned short PacketLen;

	SlwTrace(INF,"TSGpsTimingSendPos",1);	
	TSMakeGpsSendData();
	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_LOCATION_INFORMATION_REPORTING,(unsigned char *)&sutGpsSendData,sizeof(SUT_GPS_SEND_DATA));
	MC8332ModemSendTcpData(GPS_DATA_SOCKET,SendBuf,PacketLen);
	return ;
}
/***********************************************************************************
*服务器设置主动上报时间
*数据格式
HEAD1 HEAD2 CMD LEN1 LEN2 PSN1 PSN2 PSN3 PSN4 X1 X2 CHECK END
29 29 34 00 08 PSN[4] X1 X2 CHECK 0D
time=X1*256+X2
***********************************************************************************/
uint32_t Process_TSCenterGetPosTimerout(char* buf, uint32_t len)
{
	char SendBuf[100];
	unsigned short t;
	unsigned short PacketLen;
	//跳过终端序列号4 bytes
		
	//获取时间
	sutGpsInfo.GPS_UploadTime =((unsigned short)buf[9]&0xff<<8) + (unsigned short)buf[10]&0xff ;
	snprintf(SendBuf, sizeof(SendBuf),"[GpsTime=%d]",sutGpsInfo.GPS_UploadTime);
	SlwTrace(INF,SendBuf,1);
	TSMakeGpsSendData();
	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_EVENT_REPORT,(unsigned char *)&sutGpsSendData,sizeof(SUT_GPS_SEND_DATA));
	MC8332ModemSendTcpData(0,SendBuf,PacketLen);
	return len;
}

/************************************************************
建立好连接后，向平台发送终端鉴权消息进行鉴权、建立链接
*************************************************************/

/************************************************************
连接建立和终端鉴权成功后，终端周期性向平台发送终端心跳信息，拼图收到后
向终端发送平台通用应答消息，发送周期由终端参数指定、链接维持
*************************************************************/
uint32_t Process_TSPlatformAnswer(char* buf, uint32_t len)
{
	unsigned char SendBuf[100];
	unsigned short PacketLen;
	TSMakeGpsSendData();
	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_PLATFORM_UNIVERSAL_ANSWER,(unsigned char *)&sutGpsSendData,sizeof(SUT_GPS_SEND_DATA));
	MC8332ModemSendTcpData(0,SendBuf,PacketLen);
	return 0;
}

uint32_t Process_TSTerminalHeartbeat(char* buf, uint32_t len)
{
	unsigned char SendBuf[100];
	unsigned short PacketLen;

	TSMakeGpsSendData();
	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_TERMINAL_HEARTBEAT,(unsigned char *)&sutGpsSendData,sizeof(SUT_GPS_SEND_DATA));
	MC8332ModemSendTcpData(0,SendBuf,PacketLen);
	return 0;
}

void TS_SendHeartTick(void)
{
	unsigned char SendBuf[100];
	unsigned short PacketLen;

	SlwTrace(INF, "HeartTick",1);
	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_TERMINAL_HEARTBEAT,0,0);
	MC8332ModemSendTcpData(GPS_DATA_SOCKET,SendBuf,PacketLen);
}

void TS_SendSOSMessage(void)
{
	unsigned char SendBuf[100];
	unsigned short PacketLen;

	SlwTrace(INF, "SOS Send",1);
	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_SEND_SOS_SMS,0,0);
	MC8332ModemSendTcpData(GPS_DATA_SOCKET,SendBuf,PacketLen);
}

void TS_ReqRealTime(void)
{
	unsigned char SendBuf[100];
	unsigned short PacketLen;

	SlwTrace(INF, "ReqRealTime",1);
	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_TERMINAL_REQTIME,0,0);
	MC8332ModemSendTcpData(GPS_DATA_SOCKET,SendBuf,PacketLen);
}

/************************************************************
平台主发消息，终端主发消息
*************************************************************/
/******************************************************************************
*目前服务器只做了：注册，取消注册，位置信息，鉴权消息
*******************************************************************************/
TSCmd_struct TSCmd_info[] = 
{
	{TS_TERMINAL_REGISTRATION, Process_TSRegistration},//终端注册
//	{TS_TERMINAL_REGISTRATION_REPLY, Process_TSRegistrationReply},//终端注册应答
	{TS_TERMINAL_AUTHENTICATION, Process_TSAuthentication},//鉴权
//	{TS_SETTING_TERMINAL_PARAMETERS, Process_TSParametersSet},
	{TS_LOCATION_INFORMATION_INQUIRY, Process_TSCenterGetPos_rsp},//位置查询
//	{XINGAN_PACKET_CENTER_CMD_GET_STAT, Process_XinganCenterGetStat_rsp},
//	{XINGAN_PACKET_CENTER_CMD_RESET, Process_XinganCenterReset_rsp},
//	{XINGAN_PACKET_CENTER_CMD_DEFAULT_SET, Process_XinganCenterDefaultSet_rsp},
	{TS_TERMINAL_HEARTBEAT, Process_TSCenterGetPosTimerout},
//	{XINGAN_PACKET_CENTER_CMD_GET_POS_LENOUT, Process_XinganCenterGetPosLenout},
//	{XINGAN_PACKET_CENTER_CMD_CLOSE_WARNING, Process_XinganCenterCloseWarning_rsp},
//	{XINGAN_PACKET_CENTER_CMD_OPEN_OIL_WAY, Process_XinganCenterOpenOilWay_rsp},
//	{XINGAN_PACKET_CENTER_CMD_CLOSE_OIL_WAY, Process_XinganCenterCloseOilWay_rsp},
//	{XINGAN_PACKET_CENTER_CMD_GET_VER, Process_XinganCenterGetVer_rsp},
//	{XINGAN_PACKET_CENTER_CMD_DIAL_CALL, Process_XinganCenterDialCall_rsp} ,
//	{XINGAN_PACKET_CENTER_CMD_HIGH_SPEED_WARNING, Process_XinganCenterHighSpeedWarning_rsp},
//	{XINGAN_PACKET_CENTER_CMD_STATISTICS_MILE, Process_XinganCenterStatisticsMile_rsp},
//	{XINGAN_PACKET_CENTER_CMD_UDP_IPPORT, Process_XinganCenterIPport_rsp},
//	{XINGAN_PACKET_CENTER_CMD_APN, Process_XinganCenterApn_rsp},
//	
	{TS_EVENT_REPORT, Process_TSClient_rsp},
//								 
//	{XINGAN_PACKET_CLIENT_CMD_CONNECT, Process_XinganClientConnectReq},
//	{XINGAN_PACKET_CLIENT_SEND_POS_DATA, Process_XinganClientSendPosData},
//	{XINGAN_PACKET_CLIENT_CMD_SEND_WARNING_DATA, Process_XinganClientSendWarnData},
//{TS_QUERY_TERMINAL_PARAMETERS, Process_TSParametersQuery},
//{TS_TERMINAL_CONTROL, Process_TSTerminalContrl},
	{TS_PLATFORM_UNIVERSAL_ANSWER, Process_TSPlatformAnswer},
	{TS_TERMINAL_HEARTBEAT, Process_TSTerminalHeartbeat},
};
TSGPS_process_packet GetTSProcessFun(uint32_t Cmd)
{
	uint32_t j;
	for(j=0;j<sizeof(TSCmd_info)/sizeof(TSCmd_struct);j++)
	{
		if(Cmd == TSCmd_info[j].cmd)
		{
			return TSCmd_info[j].process_packet;
		}
	}
	return NULL;
}


/***************************************************************
处理GPS服务器发过来的信息
返回：
无效消息 不处理 返回0
否则返回命令码
****************************************************************/	
unsigned char TSGpsServerProcess(unsigned char *data, unsigned short DataLen)//4处		
{
	unsigned char cmd;
	TSGPS_process_packet ProcessFun;
	cmd=TSGpsServerCheckPack(data,DataLen);
	if(255 == cmd) return 0;
	ProcessFun = GetTSProcessFun(cmd);
	if(ProcessFun !=NULL)
	{
		ProcessFun(data, DataLen); 
	}
	return cmd;
}
/*********************************************************
*************************************************************/
unsigned long power(int base, int times)
{
	int i;
	unsigned long rslt = 1;

	for(i=0; i<times; i++){
			 rslt *= base;
	}
	return rslt;
}
/********************************************************
BCD转10进制
********************************************************/
unsigned long   BCDtoDec(const unsigned char *bcd, int length)
{
	 int i, tmp;
	 unsigned long dec = 0;

	 for(i=0; i<length; i++)
		{
			 tmp = ((bcd[i]>>4)&0x0F)*10 + (bcd[i]&0x0F);   
			 dec += tmp * power(100, length-1-i);          
		}

	 return dec;
}
/********************************************************
10进制转BCD
********************************************************/
int DectoBCD(int Dec, unsigned char *Bcd, int length)
{
	 int i;
	 int temp;

	 for(i=length-1; i>=0; i--)
		{
			temp = Dec%100;
			Bcd[i] = ((temp/10)<<4) + ((temp%10) & 0x0F);
			Dec /= 100;
		}

	 return 0;
}

//#define GPS_DEBUG_GPS_SEND_DATA
/***************************************************************************
*MakeGpsSendData
根据sutGpsInfo生成sutGpsSendData
****************************************************************************/
void TSMakeGpsSendData(void)//5处		
{
	char sv[17];
	char data[3];
	char buf[10];
	int buf1[3];
	int j,temp,num;
	char *pTemp;
	char WWWW[5];
	static  int Table[4]={0};
	static  int Table1[4]={0};

	sutGpsSendData.Time[0] = sutGpsInfo.year;
	sutGpsSendData.Time[1] = sutGpsInfo.month;
	sutGpsSendData.Time[2] = sutGpsInfo.day;
	sutGpsSendData.Time[3] = sutGpsInfo.hour;
	sutGpsSendData.Time[4] = sutGpsInfo.minu;
	sutGpsSendData.Time[5] = sutGpsInfo.sec;

	sutGpsSendData.St=0x00;

#if 0
	if(sutGpsInfo.isGpsValid)
	{//wjl 1121
		sutGpsSendData.status |=(0x01<<24);//ACC
		sutGpsSendData.status |=(0x01<<25);//定位标志
		sutGpsSendData.status |=(0x01<<28);//运营状态
	}else sutGpsSendData.status=0;
#else
	sutGpsSendData.status=0;
	if(sutGpsInfo.isGpsValid)
	{
		sutGpsSendData.status |=(1<<24);//b0 1 acc
		sutGpsSendData.status |=(1<<25);//b1 1 定位
		if(sutGpsInfo.NSFlag=='S')
		sutGpsSendData.status |=(1<<26);//b2 1 南纬
		if(sutGpsInfo.EWFlag=='W')
		sutGpsSendData.status |=(1<<27);//b3 1 西经
		sutGpsSendData.status |=(1<<28);//b4 1 运营
		//sutGpsSendData.status |=(1<<29);//b5 1 经纬度已加密
		//sutGpsSendData.status |=(1<<30);//b6 保留
		//sutGpsSendData.status |=(1<<31);//b7 保留
		
		//sutGpsSendData.status |=(1<<16);//b8 载状态-1
		//sutGpsSendData.status |=(1<<17);//b9 载状态-0
		//sutGpsSendData.status |=(1<<18);//b10 车辆油状态
		//sutGpsSendData.status |=(1<<19);//b11 车辆电路状态
		//sutGpsSendData.status |=(1<<20);//b12 车锁状态
		//sutGpsSendData.status |=(1<<21);//b13 门1状态
		//sutGpsSendData.status |=(1<<22);//b14 门2状态
		//sutGpsSendData.status |=(1<<23);//b15 门3状态
		
		//sutGpsSendData.status |=(1<<8);//b16 门4状态
		//sutGpsSendData.status |=(1<<9);//b17 门5状态
		//sutGpsSendData.status |=(1<<10);//b18 是否使用GPS卫星定位
		//sutGpsSendData.status |=(1<<11);//b19 是否使用北斗卫星定位
		//sutGpsSendData.status |=(1<<12);//b20 是否使用GLONASS卫星定位
		//sutGpsSendData.status |=(1<<13);//b21 是否使用Galileo卫星定位
	}
#endif
	sutGpsSendData.Mileag=((sutGpsInfo.StatisticsMile>>8)&0xFF)|(((sutGpsInfo.StatisticsMile)&0xFF)<<8);
	sutGpsSendData.SSFF=((sutGpsInfo.speed>>8)&0xFF)|(((sutGpsInfo.speed)&0xFF)<<8);
	sutGpsSendData.Acpect=sutGpsInfo.aspect;
	
	GetCoordinates(1);
	sutGpsSendData.WWWW[0] = sutGpsInfo.testWD>>24;
	sutGpsSendData.WWWW[1] = sutGpsInfo.testWD>>16;
	sutGpsSendData.WWWW[2] = sutGpsInfo.testWD>>8;
	sutGpsSendData.WWWW[3] = sutGpsInfo.testWD;

	sutGpsSendData.JJJJ[0] = sutGpsInfo.testJD>>24;
	sutGpsSendData.JJJJ[1] = sutGpsInfo.testJD>>16;
	sutGpsSendData.JJJJ[2] = sutGpsInfo.testJD>>8;
	sutGpsSendData.JJJJ[3] = sutGpsInfo.testJD;
}
void AscStrTurnHexStr(char *AscStr, char *HexStr)
{
	char *pAscStr=AscStr;
	int i=4;
	unsigned char d,h,l;
	while(i){
	  d=(unsigned char)*pAscStr++;
		l=d&0x0f;
		h=d>>4;
		*HexStr++=AscToHex(h);
		*HexStr++=AscToHex(l);
		i--;
	}
	*HexStr=0;
}
void getData(void)
{
//	  char buf[10];	
//	  char buf1[8];
//		char buf2[4]={0};
//		char temp[3];
//		char temp1[3];
//		char temp2[5];
//		char temp3[5];
//		char data[6];
//		char data1[6];
//		char data2[6];
//		int i,num,num1,j,w,Gdata,k;
//		double Jnum1,Jnum2,Jnum3;//有小数位 8位有效
//		double Wnum1,Wnum2,Wnum3;//有小数位 8位有效
//		char b[]="0123456789ABCDEF";

//	 	MakeGpsSendData();
////		AscStrToHexStr((char *)sutLcdGpsSendData.JJJJ,buf1);	
//		AscStrTurnHexStr((char *)sutLcdGpsSendData.JJJJ,buf1);	
//    memset(temp, 0, sizeof(temp));
//		for(i=0;i<3;i++){
//			temp[i]=buf1[i];
//		}
//		j=atoi(temp);
//		memset(temp2, 0, sizeof(temp2));
//		for(i=0;i<6;i++){
//			temp2[i]=buf1[i+3];
//		}
//		num=atoi(temp2);
//		Jnum1=num/1000;
//		Jnum1 /=60;
//		Jnum2 = (num%1000)*60;
//		Jnum2 /=3600000;
//		Jnum3=Jnum1+Jnum2;
//		
//		//sutLcdGpsSendData.j=j*1000000+Jnum3*1000000;
//		sutLcdGpsSendData.j = (j+Jnum3)*1000000;
//		sprintf(buf,",%d,",sutLcdGpsSendData.j);
//  	SlwTrace(INF,buf);
//		i =0; 
//		k=6;
//		memset(data, 0, sizeof(data));
//		while(sutLcdGpsSendData.j>0){
//		data[i]=sutLcdGpsSendData.j%16; 
//		GPSDataBuf[k]=b[data[i]];//data1
//		sutLcdGpsSendData.j=sutLcdGpsSendData.j/16; 
//		k--;
//		i++;
//		}
//		SlwTrace(INF,GPSDataBuf);

////		AscStrToHexStr((char *)sutLcdGpsSendData.WWWW,buf2);
//		AscStrTurnHexStr((char *)sutLcdGpsSendData.WWWW,buf2);	
//		for(i=0;i<3;i++){
//			temp1[i]=buf2[i];
//		}
//		w=atoi(temp1);
//		for(i=0;i<6;i++){//5
//			temp3[i]=buf2[i+3];
//		}
//		num1=atoi(temp3);
//		Wnum1=num1/1000;
//		Wnum1 /=60;
//		Wnum2 = (num1%1000)*60;
//		Wnum2 /=3600000;
//		Wnum3=Wnum1+Wnum2;
//		
//		//sutLcdGpsSendData.W=w*1000000+Wnum3*1000000;
//		sutLcdGpsSendData.W=(w+Wnum3)*1000000;
//		buf[0]=0;
//	  sprintf(buf,"%d",sutLcdGpsSendData.W);
//  	SlwTrace(INF,buf);
//		i =0; 
//		k=6;
//		data1[0]=0;
//		while(sutLcdGpsSendData.W>0){
//		data1[i]=sutLcdGpsSendData.W%16; 
//		GPSDataBuf1[k]=b[data1[i]];//data1
//		sutLcdGpsSendData.W=sutLcdGpsSendData.W/16; 
//		k--;
//		i++;
//		}
//	SlwTrace(INF,GPSDataBuf1);
		
//	buf[0]=0;
//	sprintf(buf,"%d",sutLcdGpsSendData.j);
//	SlwTrace(INF,buf);
//	buf[0]=0;
//	sprintf(buf,"%d",sutLcdGpsSendData.W);
//	SlwTrace(INF,buf);
}
void TSRegData(void){

	int i;
	static int Temp1[7];
	static  int Table1[20]={0};
	static int Temp[8];
	unsigned char SendBuf[100],len;
	unsigned short PacketLen,data1,data2,data3,data4;
  unsigned int PSN;

	PSN=sutProductPara.PSN;
	
	Regist.proID=0;
	Regist.CityID=0;

	for(i = 0; i < 5; i++) Regist.Manufacturers[i] = 0;

	for(i = 0; i < 20; i++) Regist.TerMod[i]= 0x00;

	Regist.TerID[0]=(unsigned char)((PSN>>24)&0xff);//没出来显示乱码
	Regist.TerID[1]=(unsigned char)((PSN>>16)&0xff);
	Regist.TerID[2]=(unsigned char)((PSN>>8)&0xff);
	Regist.TerID[3]=(unsigned char)(PSN&0xff);
	for(i = 0; i < 3; i++) Regist.TerID[i+4]= 0x00;
	
	Regist.PlateColor=0;

	for(i = 0; i < 8; i++) Regist.Plate[i] = 0x00;

	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_TERMINAL_REGISTRATION,(unsigned char *)&Regist,sizeof(REGISTRATION));
	MC8332ModemSendTcpData(GPS_DATA_SOCKET,SendBuf,PacketLen);
}
void SIMReg(void)
{
//	int i;
//	static  int Table1[6]={0};
//	for(i = 0; i < 6; i++){
//	sscanf(sutProductPara.SIM+2*i,"%2x",&Table1[i]);
//	SimData.SIM[i]= Table1[i];
//	}
}
char  TSMakeTeminalInfoData(unsigned char *pData)
{
	short InfoType=0x000f;
	char ProductId[5]={0};
	char TeminalModel[20]={0};
	char TeminalId[7]={0};
	char SIMICCID[10]={0};
	char Hardlen=1;
	char Firmlen=1;
	char buf[21]={0};
	char *p;
	char i,j;
	
	strcpy(ProductId,"HGS");
	snprintf(TeminalModel,sizeof(TeminalModel),"%s",PRODUCT_NAME);
	p=getICCID();
	
	/*
	//SIM卡号
	pBuf[i++]=0; //
	for (j=0;j<10;j+=2) {
    pBuf[i++]=(Psnsv[j]<<4)|(Psnsv[j+1]&0x0F);
  }
	*/
	for(i=0;i<10;i++){
		SIMICCID[i]=(p[2*i]<<4&0xf0)|(p[2*i+1]&0x0f);
	}
	
	i=0;
	pData[i++]=InfoType;
	pData[i++]=InfoType>>8&0xff;
	
	for(j=0;j<5;j++)pData[i++]=ProductId[j];
	
	for(j=0;j<20;j++)pData[i++]=TeminalModel[j];
	
	for(j=0;j<7;j++)pData[i++]=TeminalId[j];
	
	for(j=0;j<10;j++)pData[i++]=SIMICCID[j];
	
	pData[i++]=Hardlen;
	pData[i++]=0;
	
	pData[i++]=Firmlen;
	pData[i++]=0;
	return i;
}


void buBiaoICCID(unsigned char socketID)
	{
	unsigned char info[120];
	unsigned char PackData[60]={0};
	unsigned short PacketLen;
	SlwTrace(INF, "buBiaoTEMINAL_INFO",1);
	PacketLen=TSMakeTeminalInfoData(PackData);
	PacketLen=TSGpsPacket(info,sutProductPara.PSN,TS_TERMINAL_ATTRIBUTEINFO_ANSWER,PackData,PacketLen);
	//tcpSocketSendData(socketID, info, PacketLen);
	MC8332ModemSendTcpData(GPS_DATA_SOCKET,info,PacketLen);
}


void buSendEvent(unsigned char socketID)
	{
	unsigned char info[120];
	unsigned char PackData=0x05;
	unsigned short PacketLen;
	SlwTrace(INF, "buBiaoDIANMING",1);
	PacketLen=sizeof(PackData);
	PacketLen=TSGpsPacket(info,sutProductPara.PSN,TS_EVENT_REPORT,&PackData,PacketLen);
	//tcpSocketSendData(socketID, info, PacketLen);
	MC8332ModemSendTcpData(GPS_DATA_SOCKET,info,PacketLen);
}