#include "includes.h"
WIFISTATUE WifiStatue;
DEVICELOGIN DeviceLogin;
SERVERRESP ServerResp;
unsigned char HeartTickCt;
unsigned char HeartTimeOut;
/************************************************************
״̬ÐÅÏ¢»ã±¨
StaueSendPosition	   
·¢ËÍλÖÃÊý¾Ý
Cmd=0x0200
×ܳ¤¶È=

***********************************************************************************/
void TSStatueSendPosition(short cmd)
{
	int i;
	int len;
	unsigned char buf[400];//150
	char temp[3];
	char printfbuf[20];
	switch(cmd)
	{
		case TS_LOCATION_INFORMATION_REPORTING: //״̬ÉÏ´«
			
			len=TSTcpPacket(buf,sutProductPara.PSN,TS_LOCATION_INFORMATION_REPORTING,(unsigned char *)&Device_Up,sizeof(SUT_UP));
			HeartTickCt=0;
			break;
		case  TS_TERMINAL_LOGIN: //µÇ¼°ü
				SlwTrace(INF,"----怬----\r\n");
				memset(&DeviceLogin,0,sizeof(DeviceLogin));
				DeviceLogin.DeviceSN=sutProductPara.PSN;
				len=TSTcpPacket(buf,sutProductPara.PSN,TS_TERMINAL_LOGIN,(unsigned char *)&DeviceLogin,sizeof(DEVICELOGIN));		
				HeartTickCt=0;
			break;
		case TS_TERMINAL_HEARTBEAT: //ÐÄÌø°ü
			SlwTrace(INF,"---ÐÄÌø----\r\n");
			len=TSTcpPacket(buf,sutProductPara.PSN,TS_TERMINAL_HEARTBEAT,0,0);
		
		 break;
			
		default:
			
			break;

	}
		/////////////////////////////////////
	  SlwTrace(INF,"/**********start***********/\r\n");
	snprintf(printfbuf,sizeof(printfbuf),"LEN====%d\r\n",len);
		SlwTrace(INF,printfbuf);
	
		for(i=0;i<len;i++){	
		FEED_EXTWATCHDOG();
		sprintf(temp, "%02x",buf[i]);
		temp[2]=0;
		SlwTrace(INF,temp);	
	}
	SlwTrace(INF," \r\n");
	buf[len]=0x0d;
	buf[len+1]=0x0a;
	buf[len+2]=0x0;
	SlwTrace(INF,"/**********end***********/\r\n");
	if(sutProductPara.ConnectType==1)ModemSendData(buf,len);
	if(sutProductPara.ConnectType==0)WiredSendTcpData(buf,len);
}

/*************************************************************************************
*
**************************************************************************************/
// 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 +300);  //*2
	  unsigned char * q = p;
    int data_len = 0; 
		int i;	
	
	if (DataLen == 0) {  
        return 0;  
    }     
    	
    memset(p, 0, DataLen+300);  //*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;
}  



//´Ó³§É̱àºÅµ½Óû§Êý¾ÝÒÀ´ÎÀÛ¼ÓµÄÀۼӺͣ¬È¡ÀۼӵĵµÍ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;
}


//ÅжϴóС¶Ë
int Check_sys()
{
    union Un
    {
        char c;
        int i;
    }un;
    un.i = 1;
    return un.c;
}



/**********************
**ÏûϢͷ12×Ö½Ú£¬ÏûÏ¢ÌåÊôÐÔ2¸ö×Ö½Ú£¬ÕâÁ½¸ö×Ö½ÚµÄ16λ¡£µÍ14λÊÇÏûÏ¢Ì峤¶È
sutProductPara.APN
**************************/
int TSTcpPacket(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),"%08u",(unsigned int)PSN);
	pBuf[i++]=0x7e;	
	
	pBuf[i++]=(ID>>8)&0xff;
	
  pBuf[i++]=ID&0xff;
	
	//ÏûÏ¢ÌåÊôÐÔ
	pBuf[i++]=DataLen &0x3f;
	pBuf[i++]=DataLen &0xff;
	

	//PSN
	for(j=0;j<8;j++){
		
		pBuf[i++]=Psnsv[j];
	
	}	
	
	//ÏûÏ¢Á÷Ë®ºÅ
	pBuf[i++] = (liushiID>>8)&0xff;
	pBuf[i++] = liushiID&0xff;
	liushiID++;
	if(liushiID>65533){
		liushiID=0;
	}
	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;
	
}

//´Ósource²éÕÒ³¤¶ÈΪtargetLenÄ¿±êµÄtarget£¬ÕÒµ½ºó·µ»ØÄ¿±ê¶ÎºóÒ»×Ö½ÚµÄË÷Òý£¬Ã»ÕÒµ½·µ»Ø-1£¬source½áÊøΪsourceEndIndicator
//witchOne: ÕÒµÚ¼¸¸öÄ¿±ê
//targetIndex=FindTargetIndex(pMsg, '\r', ",",1,2)
short FindTargetIndex(char *source, char sourceEndIndicator, char *target, unsigned char targetLen,unsigned char witchOne)
{
	unsigned short targetIndex;
	unsigned char targetNum;
	targetIndex=0;
	targetNum=0;
	
	while(*source!=sourceEndIndicator){
	
		if(0==memcmp(source, target, targetLen))
		{//ÕÒµ½ÁË
			targetNum++;
			if(targetNum == witchOne)
			  return (targetIndex+targetLen);
		}
		source++;
		targetIndex++;
	
	}
	return -1;
}

/**********************************
½«TCPÊý¾Ý½âÎöÈë½á¹¹Ìå¡£
**************************************/
void TcpDataPack(unsigned char *pMsg)
{
//1¡¢Òì»òÅжÏÕû°üÊý¾ÝÊÇ·ñÕýÈ·
	//LED[3]
	Device_Down.Led[0]=pMsg[15];
	Device_Down.Led[1]=pMsg[16];
	Device_Down.Led[2]=pMsg[17];
	//beep
	Device_Down.Beep=pMsg[18];
	
	if(Device_Down.Led[0]==1)WARN_LED1_HIGH;
	else WARN_LED1_LOW;
	if(Device_Down.Led[1]==1)WARN_LED2_HIGH;
	else WARN_LED2_LOW;
	if(Device_Down.Led[2]==1)WARN_LED3_HIGH;
	else WARN_LED3_LOW;
	
	if(Device_Down.Beep==1)WARN_BEEP_HIGH;
	else WARN_BEEP_LOW;
	
	//Rigister
	memcpy(&Device_Down.sut_device_write,&pMsg[19],sizeof(SUT_DEVICE_WRITE)*32);
}


/************************************************************************************************/
void ESP8285_TCP_RecvHandle(unsigned char *pMsg,unsigned short tempLen)
{
	
	char buf[20];
	char result[10];
	unsigned short cmd,ackCmd,smsLen;
	unsigned char Result,i,buBiaoResponsed;
	short targetIndex;
	short z=0;

	
	//////////´¦Àí²¼±êÀàÐÍÖ¸Áî
	cmd = (pMsg[1]<<8) | (pMsg[2]&0xff);
	buBiaoResponsed=1;
	sprintf(buf, "\r\ncmd=%04x\r\n", cmd);
	SlwTrace(INF, buf);

//7E 8100 000A 000166000016 0250 0100 00 20161118165030 E07E ³É¹¦

switch(cmd)
{//²¼±êÃüÁî·µ»Ø
		
		case TS_TERMINAL_CONTROL://	
				//½âÎöÊý¾Ý°üÈë½á¹¹Ìå
			SlwTrace(INF,"/**************TCP data*************************/\r\n");
			SlwTrace(INF,"\r\n");
			for(z=0;z<tempLen;z++){
				//printf("%02x",pMsg[z]);
				sprintf(buf,"%02x",pMsg[z]);
				SlwTrace(INF, buf);
			}
			SlwTrace(INF,"\r\n");
			SlwTrace(INF,"/**************TCP data End*************************/\r\n");
			TcpDataPack(pMsg);
			ProcessSetControl();
		
			break;
		case TS_PLATFORM_LOGIN_ANSWER:
				//µÇ¼Ӧ´ð
			/*********************************************************************/
				sut_sys_status.Logined=pMsg[4]; 
				ServerStatus=OPENED;
			break;
			
		case TS_TERMINAL_HEARTBEAT_ANSWER: //ÐÄÌøÓ¦´ð
			 if(sut_sys_status.Logined==1) HeartTimeOut=20;
			break;
	
		default:
			buBiaoResponsed=0;
			break;
	}

	
}


void TcpProcess(unsigned char *pMsg,unsigned int ret)
{
	short targetIndex;
	 unsigned short tempLen;
	sut_sys_status.SetSlaveing=1;
	
	if(sutProductPara.ConnectType==1)
		{
			//2¡¢½â°üÊý¾Ý ÎÞÏß
					if(-1 != (targetIndex=FindTargetIndex(pMsg, '\r', ",",1,1)))
					{
						tempLen = atoi(&pMsg[targetIndex]);
						if(-1 != (targetIndex=FindTargetIndex(pMsg, '\r', ":",1,1)))
						{
									//×ß²¼±êÅжÏ
									if(pMsg[targetIndex] == 0x7e && pMsg[targetIndex+tempLen-1] == 0x7e)
									{//ÊDz¼±êЭÒ飬½øÐÐתÒå
										tempLen=reduce((unsigned char *)&pMsg[targetIndex+1], tempLen-1);
									//
										ESP8285_TCP_RecvHandle((unsigned char *)&pMsg[targetIndex],tempLen);
									}else
									{
										SlwTrace(INF, "Unknown Protocol");
									}
							}
					 }
		 }else{
		 	//2¡¢½â°üÊý¾Ý ÓÐÏß
									//×ß²¼±êÅжÏ
									if(pMsg[0] == 0x7e && pMsg[ret-1] == 0x7e)
									{//ÊDz¼±êЭÒ飬½øÐÐתÒå
										tempLen=reduce((unsigned char *)&pMsg[1], ret-1);
									//
										ESP8285_TCP_RecvHandle((unsigned char *)&pMsg[0],ret);
									}else
									{
										SlwTrace(INF, "Unknown Protocol");
									}
		 }
		 
		 sut_sys_status.SetSlaveing=0;
		 
}

	
	
void TcpProcess2(char *pMsg)
{
	short targetIndex;
	 unsigned short tempLen;


			//2¡¢½â°üÊý¾Ý ÎÞÏß
					if(-1 != (targetIndex=FindTargetIndex(pMsg, '\r', ",",1,1)))
					{
						tempLen = atoi(&pMsg[targetIndex]);
						if(-1 != (targetIndex=FindTargetIndex(pMsg, '\r', ":",1,1)))
						{
									//×ß²¼±êÅжÏ
									if(pMsg[targetIndex] == 0x7e && pMsg[targetIndex+tempLen-1] == 0x7e)
									{//ÊDz¼±êЭÒ飬½øÐÐתÒå
										tempLen=reduce((unsigned char *)&pMsg[targetIndex+1], tempLen-1);
									//
										ESP8285_TCP_RecvHandle((unsigned char *)&pMsg[targetIndex],tempLen);
									}else
									{
										SlwTrace(INF, "Unknown Protocol");
									}
							}
					 }
		 
	}
	
	
	
	

	

void Tcptick( void )
{
	static char step;
	static int sucSecCt=0;
	static char LoginTryCt=0;
	static char ReLoginTryct=0;
//	static char HeartTickCt=0;
	
	
	//===========ÒÔÏ¿ØÖÆÿÃëÖ´ÐÐÒ»´Î============
	if(os_time_get() < sucSecCt) return;
		sucSecCt=os_time_get()+100;
///////////////////////////////////////////////////////////////////////////////////////
	
	if(sut_sys_status.Logined==0 && WifiStatue==CONNECTOK)//Á´½ÓÕý³£ÇÒδµÇ¼
	{
			/***********δµÇ¼ʱºò·¢Ë͵Ǽ°ü*****************/
		
		if(ReLoginTryct>3){
			/************µÇ¼δ³É¹¦£¬Ã¿2·ÖÖÓÇëÇóÒ»´Î************/
				if(LoginTryCt++>20){
				
					TSStatueSendPosition(TS_TERMINAL_LOGIN);
				}
		
		}else if(++LoginTryCt>10){
					LoginTryCt=0;
					ReLoginTryct++;
					TSStatueSendPosition(TS_TERMINAL_LOGIN);
			}
		   
	}else if(sut_sys_status.Logined==1 && WifiStatue==CONNECTOK){
	
			/***********¶¨Ê±15S·¢ËÍÐÄÌø°ü*****************/
				if(HeartTickCt++>15){
					TSStatueSendPosition(TS_TERMINAL_HEARTBEAT);
					HeartTickCt=0;
					HeartTimeOut=0;
				}
				if(HeartTimeOut--==0)WifiStatue=WIFIINVALID; //ÐÄÌø³¬Ê±
				
	}else{
		///////////////////Á´½ÓÒì³£////////////////////////////////////////ÖØÐÂÁ´½Ó
			WifiStatue=WIFIINVALID;
	
	}



}