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


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


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


int turn(int a)
{
	a = ~a + 1;
	return a;
}

/**************************************************************************************************
*¿´Ï Èç¹ûÒ»Ö±·¢×¢²áÐÅÏ¢»áÈçºÎ
***************************************************************************************************/
void TSGpsTimingSendPos(void)
{
	unsigned char SendBuf[100];

//	unsigned char Jbuf[10];
//	unsigned char Wbuf[10];
		
		signed int Jtmp;
		signed int Wtmp;
	
//	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);
	/***************M20*************///´ò°ü·¢ËÍGPSÊý¾Ý¡£ 
	
	//AT+POC=525&ʱ¼ä&¾­¶È&γ¶È&¸ß¶È&ËÙ¶È&·½Î»&ÎÀÐÇÊý
	
	//time=	((sutGpsInfo.hour/16*10+sutGpsInfo.hour%16)*3600+(sutGpsInfo.minu/16*10+sutGpsInfo.minu%16)*60+(sutGpsInfo.sec/16*10+sutGpsInfo.sec%16));  //ʱ¼ä

	GetCoordinates(1);
//	snprintf(Jbuf,sizeof(Jbuf),"%9d",sutGpsInfo.testJD);  //¾­¶È γ¶È
//	snprintf(Wbuf,sizeof(Wbuf),"%9d",sutGpsInfo.testWD);
	if(sutGpsInfo.EWFlag=='W') Jtmp= turn(sutGpsInfo.testJD);
		else Jtmp=sutGpsInfo.testJD;
	if(sutGpsInfo.NSFlag=='S') Wtmp= turn(sutGpsInfo.testWD);//S
		else Wtmp=sutGpsInfo.testWD;

	snprintf(SendBuf,sizeof(SendBuf),"AT+POC=525&%9d&%d&%d&%d&%d&%d&%d\r\n",sutGpsInfo.SendTime,Jtmp,Wtmp,sutGpsInfo.hight,sutGpsInfo.AvgSpeed,sutGpsInfo.aspect,sutGpsInfo.startnum);
	SlwTrace(INF,"GPS start/**************************************************************/",1);
	ModemSendAT(SendBuf);
	SlwTrace(INF,SendBuf,1);
	SlwTrace(INF,"GPS end/***************************************************************/",1);
	return ;
}



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


	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.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;
}