HS121L/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;
REGISTRATION Regist;
AVL_MSG_BODY_ATTRIB msgBodyAttrib;
MSG_HEAD msghead;
MSG_PACKET msgPacket;
AUTH auth;
SIM SimData;
SUT_LCDGPS_SEND_DATA sutLcdGpsSendData;

//从厂商编号到用户数据依次累加的累加和，取累加的档�8位作为校验码
unsigned char TSGetCheckSum(unsigned char *pData,int len)
{
	int i;
	unsigned char sum= pData[1];
	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[11];
	static unsigned short snum = 1;
	unsigned short Len=DataLen+6;
	unsigned short pageItem=DataLen+12;

	sprintf(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卡号
	if(sutNewSegmentPara.SIMFlag!=1){
	pBuf[i++]=0; //
	for (j=0;j<10;j+=2) 
	{
  pBuf[i++]=(Psnsv[j]<<4)|(Psnsv[j+1]&0x0F);
  }
	}else{
	for(j=0;j<6;j++){
	pBuf[i++]=SimData.SIM[j];
	}
	}
	//消息流水号
	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);
	sprintf(buf,"AT^IPSEND=1,%d\r",len);//+ 1?
	ModemSendAT(buf);
	ModemSendData(GpsBuf,len);
	

	strcpy(buf,"SendGpsD:");
	for(i=0;i<len;i++){
		sprintf(tmp,"%02x,",GpsBuf[i]);
		strcat(buf,tmp);
	}	
	//strcat(buf,"\r\n");
	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));	
	
	//sutGpsInfo.SendTime=15;
	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)
{
	int i,len;
	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
		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};

	Regist.proID =((sutNewSegmentPara.proID>>8)&0xff);
	Regist.proID =(sutNewSegmentPara.proID&0xff);
	
	Regist.CityID = ((sutNewSegmentPara.CityID>>24)&0xffff);
	Regist.CityID = ((sutNewSegmentPara.CityID>>16)&0xffff);
	Regist.CityID = ((sutNewSegmentPara.CityID>>8)&0xffff);
	Regist.CityID = (sutNewSegmentPara.CityID&0xffff);

	for(i = 0; i < 5; i++)
		Regist.Manufacturers[i] = sutNewSegmentPara.Manufacturers[i];
	
	for(i = 0; i < 20; i++)
	{
		if((i<20)&&(sutNewSegmentPara.TerMod[i]!='0')) Regist.TerMod[i]= sutNewSegmentPara.TerMod[i];
		else Regist.TerMod[i]=0x00;
	}
	for(i = 0; i < 4; i++)
	{
		sscanf(sutNewSegmentPara.TerID+2*i,"%2x",&Temp1[i]);
		Regist.TerID[i]= Temp1[i];
	}

	Regist.PlateColor=sutNewSegmentPara.PlateColor;//

	for(i = 0; i < 8; i++)
	{
		sscanf(sutNewSegmentPara.Plate+2*i,"%2x",&Temp[i]);
		Regist.Plate[i] = Temp[i];
	}
}
/************************************************************
终端注册、注销
*3431303030制作商ID
3230313430340000000000000000000000000000终端型号
30303030313131 终端ID
*************************************************************/
uint32_t Process_TSRegistration(char* buf, uint32_t len)
{
	unsigned char SendBuf[100];
	unsigned short PacketLen;
	
	if(sutNewSegmentPara.Select==1) TSMakeSendData();
	else TSRegData(sutProductPara.PSN);

	//REGISTRATION Regist;
	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_TERMINAL_REGISTRATION,(unsigned char *)&Regist,sizeof(REGISTRATION));
	MC8332ModemSendTcpData(GPS_DATA_SOCKET,SendBuf,PacketLen);

	return len;
	
}
void Registration(void)
{
	SlwTrace(INF, "Registration",1);
	if(sutNewSegmentPara.SIMFlag){SIMReg();}
	TSRegData(sutProductPara.PSN);
}

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(GPS_DATA_SOCKET,SendBuf,PacketLen);
}
/************************************************************
终端鉴权
*************************************************************/

void Authentication(void)
{
	unsigned char SendBuf[100];
	unsigned short PacketLen;
	unsigned char temp[27];
	SlwTrace(INF, "Authentication!",1);
	memset(temp,0,sizeof(temp));
	memcpy(temp,(unsigned char *)&sutNewSegmentPara.AutH,sizeof(sutNewSegmentPara.AutH));
	memcpy(&temp[sizeof(sutNewSegmentPara.AutH)],CCID,sizeof(CCID));
	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_TERMINAL_AUTHENTICATION,temp,sizeof(temp));//实际是返回的鉴权信息
	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(GPS_DATA_SOCKET,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(GPS_DATA_SOCKET,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;
	TSMakeGpsSendData();
	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_LOCATION_INFORMATION_REPORTING,(unsigned char *)&sutGpsSendData,sizeof(SUT_GPS_SEND_DATA));
  MC8332ModemSendTcpData(GPS_DATA_SOCKET,SendBuf,PacketLen);
}
/***********************************************************************************
*服务器设置主动上报时间
*数据格式
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)
{

	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(GPS_DATA_SOCKET,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(GPS_DATA_SOCKET,SendBuf,PacketLen);
	return 0;
}

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

	PacketLen=TSGpsPacket(SendBuf,sutProductPara.PSN,TS_TERMINAL_HEARTBEAT,0,0);
	MC8332ModemSendTcpData(GPS_DATA_SOCKET,SendBuf,PacketLen);
}

/*********************************************************
*************************************************************/
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;
}

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 MakeGpsSendData(void)
 {
	char buf[12];
	unsigned char *data=(unsigned char *)&sutLcdGpsSendData;
	memset(data, 0, sizeof(SUT_LCDGPS_SEND_DATA));
	data[0] = (sutGpsInfo.latitue>>24)&0xFF;
	data[1] = (sutGpsInfo.latitue>>16)&0xFF;
	data[2] = (sutGpsInfo.latitue>>8)&0xFF;
	data[3] = (sutGpsInfo.latitue)&0xFF;
	
	data[4] = (sutGpsInfo.longitue>>24)&0xFF;
	data[5] = (sutGpsInfo.longitue>>16)&0xFF;
	data[6] = (sutGpsInfo.longitue>>8)&0xFF;
	data[7] = (sutGpsInfo.longitue)&0xFF; 
//	sprintf(buf,"%d",sutGpsInfo.latitue);
//	SlwTrace(INF,buf,1);
//	buf[0]=0;
//	sprintf(buf,"%d",sutGpsInfo.longitue);
//	SlwTrace(INF,buf,1);
 }
 
 /*****************************************************
 深圳北纬22.33 东经114.07 
 经过试验数据比较准确，但是东西南北不知道
 ******************************************************/
 void GetCoordinates(unsigned char type)
 {
	 //type 0 UI时调用
	 //     1 上传时调用
	char buf[10];
	char buf0[10]={0};
	char buf1[8];
  char buf2[4]={0};
	char temp[3];
	char temp1[3];
	char temp2[5];
	char temp3[5];
	int i,num,num1,w,j;

	double Jnum1,Jnum2,Jnum3;//有小数位 8位有效
	double Wnum1,Wnum2,Wnum3;//有小数位 8位有效
	
	 	MakeGpsSendData();
		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;

		sutGpsInfo.testJD = j*1000000+Jnum3*1000000;//上传时使用

		AscStrTurnHexStr((char *)sutLcdGpsSendData.WWWW,buf2);
    for(i=0;i<3;i++) temp1[i]=buf2[i];
		w=atoi(temp1);
		for(i=0;i<6;i++) temp3[i]=buf2[i+3];
		num1=atoi(temp3);
		Wnum1=num1/1000;
		Wnum1 /=60;
		Wnum2 = (num1%1000)*60;
		Wnum2 /=3600000;
		Wnum3=Wnum1+Wnum2;
    sutGpsInfo.testWD = w*1000000+Wnum3*1000000;
 }
 
//#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(sutGpsInfo.isGpsValid)
	{//wjl 1121
		sutGpsSendData.status |=(0x01<<24);//ACC
		sutGpsSendData.status |=(0x01<<25);//定位标志
		sutGpsSendData.status |=(0x01<<28);//运营状态
	}else sutGpsSendData.status=0;

	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 TSRegData(unsigned long PSN){

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


	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(sutNewSegmentPara.SIM+2*i,"%2x",&Table1[i]);
	SimData.SIM[i]= Table1[i];
	}
}