/*******************************************************************************
 * File Name         : TCPClient.c
 * Description       :
 * Created on        : 2021?1?9?
 * Author            : www.hido-studio.com
 *******************************************************************************/

/*******************************************************************************
 *                              Include Files                                  *
 *******************************************************************************/
#include "TCPClient.h"
#include "Socket.h"
#include "HIDO_Debug.h"
#include "Internet.h"
#include "string.h"
#include "HIDO_Timer.h"
#include "HIDO_Util.h"
#include "global_param.h"
#include "Uart.h"
#include "mk_4G.h"
#include "mk_trace.h"
#include "dw_app_anchor.h"
#include "PCA9555.h"
#include "WS2812.h"
#include "PCA9555.h"
#include "mk_flash.h"
#include <serial_at_cmd_app.h>
#include "DBG.h"
/*******************************************************************************
 *                                  Macro                                      *
 *******************************************************************************/
#define STRCMP(cmd, header)         strncmp((HIDO_CHAR *)_u8Data, header, sizeof(header) - 1)
/*******************************************************************************
 *                             Type Definition                                 *
 *******************************************************************************/
typedef enum
{
    TCP_CLIENT_STATE_IDLE,
    TCP_CLIENT_STATE_CONNECTING,
    TCP_CLIENT_STATE_CONNECTED,
} E_TCPClientState;

/*******************************************************************************
 *                             Local Variable                                  *
 *******************************************************************************/
HIDO_INT32 l_i32TCPClientID = 0;
uint8_t gps_power_state;
static E_TCPClientState l_eTCPClientState = TCP_CLIENT_STATE_IDLE;
static HIDO_UINT32 l_u32HeartBeatTick = 0;
static HIDO_UINT8 l_au8CmdBuff[1024];

uint8_t TCPfail_flag = 0,flag_first_TCPconnect=0;
static uint32_t TCPfailetimer;
uint16_t ip0,ip1,ip2,ip3,port;

/*******************************************************************************
 *                        Local Function Declaration                           *
 *******************************************************************************/
static HIDO_INT32 TCPClient_Heartbeat(HIDO_VOID);
void TCPHeartBeatUpload(void);
void UDPClient_UploadGPS(HIDO_CHAR *_pcGGA);
void TCPReceiveMessageReply(void);
/*******************************************************************************
 *                             Local Function                                  *
 *******************************************************************************/
/*******************************************************************************
 * Function Name     : TCPClient_DataProc
 * Description       :
 * Input             :
 * Output            :
 * Return            :
 * Author            : www.hido-studio.com
 * Modified Date:    : 2021Äê1ÔÂ9ÈÕ
 *******************************************************************************/
extern uint8_t gps_4g_flag,search_open_flag,gps_open_flag,gps_wait_count,gps_need_data_flag,gps_wait_count2;
uint8_t ota_flag;
extern Operation_step UWB_work_state;
Commend_Datestruct TCP_command;
uint8_t result;
char applyid[10];
uint16_t receive_id;
uint16_t g_com_position;
uint16_t g_com_num;
uint8_t testdata[100];
static HIDO_INT32 TCPClient_DataProc(HIDO_UINT8 *_u8Data, HIDO_UINT32 _u32Len)
{
    HIDO_CHAR *apcSplitStr[12];
    HIDO_UINT32 u32SplitCnt = 0;
    
    HIDO_UINT32 u32Len = 0;

//    HIDO_Debug("%s\r\n", l_au8CmdBuff);

    /* $config,id,gps_hz,ip,port */
    if(STRCMP(_u8Data, "$config,") == 0)
    {
        u32SplitCnt = HIDO_UtilStrSplit((HIDO_CHAR *)_u8Data, ',', apcSplitStr, HIDO_ARRARY_COUNT(apcSplitStr));

        if(u32SplitCnt < 5)
        {
            return HIDO_ERR;
        }

        /* É豸ID¼ì²é */
        if(HIDO_UtilHexStrToInt(apcSplitStr[1]) == g_com_map[DEV_ID])
        {
            HIDO_UINT32 u32Temp = 0;
            HIDO_BOOL bChange = HIDO_FALSE;
            HIDO_UINT8 au8IP[4];

            /* GPS HZ */
            u32Temp = HIDO_UtilStrToInt(apcSplitStr[2]);
            if(u32Temp != g_com_map[GPS_HZ])
            {
                g_com_map[GPS_HZ] = u32Temp;
                bChange = HIDO_TRUE;
            }

            /* IP=192.168.1.1 */
            HIDO_UtilIPStringToByteArrary(apcSplitStr[3], au8IP);
            /* IP±ä»¯ */
            if((au8IP[0] != g_com_map[IP_0]) || (au8IP[1] != g_com_map[IP_1])
                    || (au8IP[2] != g_com_map[IP_2]) || (au8IP[3] != g_com_map[IP_3]))
            {
                bChange = HIDO_TRUE;
                g_com_map[IP_0] = au8IP[0];
                g_com_map[IP_1] = au8IP[1];
                g_com_map[IP_2] = au8IP[2];
                g_com_map[IP_3] = au8IP[3];

                l_eTCPClientState = TCP_CLIENT_STATE_IDLE;
            }

            /* ¶Ë¿Ú=0-65535 */
            if( g_com_map[PORT] != HIDO_UtilStrToInt(apcSplitStr[4]))
            {
                g_com_map[PORT] = HIDO_UtilStrToInt(apcSplitStr[4]);
                bChange = HIDO_TRUE;
            }

            if(bChange)
            {
                save_com_map_to_flash();
              g_com_map[CNT_RESTART] = 1;
            }
        }
    }
    /* $update,id,url,version */
    else if(STRCMP(_u8Data, "$update,") == 0)
    {
        u32SplitCnt = HIDO_UtilStrSplit((HIDO_CHAR *)_u8Data, ',', apcSplitStr, HIDO_ARRARY_COUNT(apcSplitStr));

        if(u32SplitCnt < 4)
        {
            return HIDO_ERR;
        }

        /* É豸ID¼ì²é */
        if(HIDO_UtilHexStrToInt(apcSplitStr[1]) == g_com_map[DEV_ID])
        {
//              ota_flag=1;
//              LOG_INFO(TRACE_MODULE_APP,"OTAÎļþµØÖ·Ãû³Æ:%s.\r\n",(char *)&apcSplitStr[2]);
//              uart_send(UART_ID1, (char *)&apcSplitStr[2],strlen(apcSplitStr[3]), NULL);
//            memcpy(testdata,(HIDO_UINT8*)apcSplitStr[2],strlen(apcSplitStr[2]) + 1);
//              OTA_Start((HIDO_UINT8*)apcSplitStr[2]);
            
//            g_com_map[OTA_FLAG]=1;
//            g_com_map[OTA_URL_CHANGDU]=strlen(apcSplitStr[2]) + 1;
//            memcpy(g_com_map+OTA_URL_INDEX,(HIDO_UINT8*)apcSplitStr[2],strlen(apcSplitStr[2]) + 1);
//            save_com_map_to_flash();
//            delay_us(100000);
            uint16_t tmp = 0xCCCC;
            uint8_t flag = 0;
            __disable_irq();
            result=flash_open(FLASH_ID0,NULL);
            if(!result) 
            {
            flash_erase(FLASH_ID0, APP_CONFIG_IAPFLAG_SECTOR_ADDR, FLASH_SECTOR_SIZE);//²Á³ýAPPFLAG
            flash_write_nbytes(FLASH_ID0, APP_CONFIG_IAPFLAG_MAP, (uint8_t*)&tmp, sizeof(tmp));
            flash_erase(FLASH_ID0, APP_CONFIG_IAP_PARAM_MAP, FLASH_SECTOR_SIZE);//²Á³ýAPPFLAG
            flash_write_nbytes(FLASH_ID0, APP_CONFIG_IAP_PARAM_MAP, (HIDO_UINT8 *)&flag, 1);
            flash_write_nbytes(FLASH_ID0, APP_CONFIG_IAP_PARAM_MAP+1, (HIDO_UINT8*)apcSplitStr[2], strlen(apcSplitStr[2]) + 1);
            }
            __enable_irq();
            NVIC_SystemReset(); //Èí¸´Î»»Øµ½bootloader
        }
    }
    /* $getlog,id,url */
    else if(STRCMP(_u8Data, "$getlog,") == 0)
    {
        u32SplitCnt = HIDO_UtilStrSplit((HIDO_CHAR *)_u8Data, ',', apcSplitStr, HIDO_ARRARY_COUNT(apcSplitStr));

        if(u32SplitCnt < 3)
        {
            return HIDO_ERR;
        }

        /* É豸ID¼ì²é */
        if(HIDO_UtilHexStrToInt(apcSplitStr[1]) == g_com_map[DEV_ID])
        {
#if 0
            Log_Upload(apcSplitStr[2]);
#endif
        }
    }    /* $control,id,bepper,time */
    else if(STRCMP(_u8Data, "$control,") == 0)
    {
        u32SplitCnt = HIDO_UtilStrSplit((HIDO_CHAR *)_u8Data, ',', apcSplitStr, HIDO_ARRARY_COUNT(apcSplitStr));
     if(u32SplitCnt < 3)
        {
            return HIDO_ERR;
        }

        /* ?õôID??? */
        if(HIDO_UtilHexStrToInt(apcSplitStr[1]) == g_com_map[DEV_ID])
        {
            if(strcmp(apcSplitStr[2],"beeper")==0)
            {
               
//                    beepontime = HIDO_UtilStrToInt(apcSplitStr[3]);
                    
            }
            
                if(strcmp(apcSplitStr[2],"TTS")==0)
                {
                    PCA9555_Set_One_Value_Output(TTS_ENABLE,1);         //´ò¿ªTTSµçÔ´
                    delay_ms(800);                //ÔÙ¶ÌÒ»µã£¬»á¶ªÊ§ÓïÒôµÄµÚÒ»¸ö×Ö£¬²»ÊDz»¶Á£¬¶øÊǾÍÏñûÓÐÏ·¢µÚÒ»¸ö×Ö
                    
//                    TTS_Play((HIDO_UINT8 *)apcSplitStr[3], strlen(apcSplitStr[3]));             //·þÎñÆ÷ÓïÒô²¥±¨
                    
                    
                    u32Len = HIDO_UtilSnprintf((HIDO_CHAR *)l_au8CmdBuff, sizeof(l_au8CmdBuff), "$Receivevoice,%X\r\n",
                    g_com_map[DEV_ID]);
                    
                    Socket_Send(l_i32TCPClientID, (HIDO_UINT8 *)l_au8CmdBuff, u32Len);
                    
                   
                }
          
        }
    }
    else if(STRCMP(_u8Data, "$userdata,") == 0)
    {
//        if(DBG_GetMode() == DBG_MODE_CFG)
//        HIDO_Debug2("%s\r\n", l_au8CmdBuff);
    }
    else if(STRCMP(_u8Data, "$settone,") == 0)
    {
        HIDO_DataStruct stData;
        HIDO_DataStruct stId;

        if(HIDO_UtilParseFormat(_u8Data, _u32Len, "$settone,%p,%p\r\n", &stId, &stData) == 2)
        {
            ((char *)stId.m_pData)[stId.m_u32Len] = '\0';
            if(g_com_map[DEV_ID] == HIDO_UtilHexStrToInt((char *)stId.m_pData))
            {
//                TONE_Play((HIDO_UINT8 *)stData.m_pData, stData.m_u32Len);
                
                u32Len = HIDO_UtilSnprintf((HIDO_CHAR *)l_au8CmdBuff, sizeof(l_au8CmdBuff), "$Receivevoice,%X\r\n",
                g_com_map[DEV_ID]);                                                                      //TTSÊÕµ½»Ø¸´
                
                Socket_Send(l_i32TCPClientID, (HIDO_UINT8 *)l_au8CmdBuff, u32Len);
            }
        }
    }else if(STRCMP(_u8Data, "$setpara,") == 0)
    {
        uint16_t tempindex,tempval;
        u32SplitCnt = HIDO_UtilStrSplit((HIDO_CHAR *)_u8Data, ',', apcSplitStr, HIDO_ARRARY_COUNT(apcSplitStr));
        if(HIDO_UtilHexStrToInt(apcSplitStr[1]) == g_com_map[DEV_ID])
        {
            if(u32SplitCnt < 2)
            {
                return HIDO_ERR;
            }
            tempindex = HIDO_UtilStrToInt(apcSplitStr[2]);
            tempval = HIDO_UtilStrToInt(apcSplitStr[3]);
            if(tempindex == MOTOR_ONTIME_INDEX)
            {
//              beepontime = tempval;
            }else{
            if(tempindex < COM_MAP_SIZE)
            g_com_map[tempindex] = tempval;
            save_com_map_to_flash();
            g_com_map[CNT_RESTART] = 1;
            }
        }
    }
    else if(STRCMP(_u8Data, "$readpara,") == 0)
    {
        uint16_t tempindex,templen,buffer_len,datalen;
        char send_buffer[500];
        u32SplitCnt = HIDO_UtilStrSplit((HIDO_CHAR *)_u8Data, ',', apcSplitStr, HIDO_ARRARY_COUNT(apcSplitStr));
        if(HIDO_UtilHexStrToInt(apcSplitStr[1]) == g_com_map[DEV_ID])
        {
            if(u32SplitCnt < 2)
            {
                return HIDO_ERR;
            }
            tempindex = HIDO_UtilStrToInt(apcSplitStr[2]);
            templen = HIDO_UtilStrToInt(apcSplitStr[3]);
						if(templen>10)
							templen=10;
            buffer_len = sprintf(send_buffer,"$replypara,");
            datalen = sprintf(&send_buffer[buffer_len],"%x,",g_com_map[DEV_ID]);
            buffer_len += datalen;
            for(uint16_t i=tempindex;i<templen+tempindex;i++)
            {
                datalen = sprintf(&send_buffer[buffer_len],"%d,",g_com_map[i]);
                buffer_len += datalen;
            }
            send_buffer[buffer_len++] = 'e';
            send_buffer[buffer_len++] = 'n';
            send_buffer[buffer_len++] = 'd';
            send_buffer[buffer_len++] = 0x0d;
            send_buffer[buffer_len++] = 0x0a;
            Socket_Send(l_i32TCPClientID,(uint8_t*)send_buffer,buffer_len);
        }
    }
    /* $download_audio,http://39.106.210.13:8080/hfs/xxx.bin */
    else if (STRCMP(_u8Data, "$download_audio,") == 0)
    {
        u32SplitCnt = HIDO_UtilStrSplit((HIDO_CHAR *)_u8Data, ',', apcSplitStr, HIDO_ARRARY_COUNT(apcSplitStr));

        if (u32SplitCnt < 3)
        {
            return HIDO_ERR;
        }
        if (HIDO_UtilHexStrToInt(apcSplitStr[1]) == g_com_map[DEV_ID])
        {
            uint16_t tmp = 0xCCCC;
            uint8_t flag = 1;

            __disable_irq();
            result = flash_open(FLASH_ID0, NULL);
            if (!result)
            {
                flash_erase(FLASH_ID0, APP_CONFIG_IAPFLAG_SECTOR_ADDR, FLASH_SECTOR_SIZE); // ²Á³ýAPPFLAG
                flash_write_nbytes(FLASH_ID0, APP_CONFIG_IAPFLAG_MAP, (uint8_t *)&tmp, sizeof(tmp));
                flash_erase(FLASH_ID0, APP_CONFIG_IAP_PARAM_MAP, FLASH_SECTOR_SIZE); // ²Á³ýAPPFLAG
                flash_write_nbytes(FLASH_ID0, APP_CONFIG_IAP_PARAM_MAP, (HIDO_UINT8 *)&flag, 1);
                flash_write_nbytes(FLASH_ID0, APP_CONFIG_IAP_PARAM_MAP + 1, (HIDO_UINT8 *)apcSplitStr[2], strlen(apcSplitStr[2]) + 1);
            }
            __enable_irq();
            NVIC_SystemReset(); // Èí¸´Î»»Øµ½bootloader
        }
    }
    /* $play_audio,0-9 */
    else if (STRCMP(_u8Data, "$play_audio,") == 0)
    {
        u32SplitCnt = HIDO_UtilStrSplit((HIDO_CHAR *)_u8Data, ',', apcSplitStr, HIDO_ARRARY_COUNT(apcSplitStr));

        if (u32SplitCnt < 3)
        {
            return HIDO_ERR;
        }
        if (HIDO_UtilHexStrToInt(apcSplitStr[1]) == g_com_map[DEV_ID])
        {
            PCA9555_Set_One_Value_Output(TTS_ENABLE,1);//Êä³ö¸ßµçƽÇл»Îª5VÊäÈë
            delay_ms(100);
            WT588E_PLAY(atoi(apcSplitStr[2]));
        }
    }
    else if (STRCMP(_u8Data, "$set_gpsuwbpara,") == 0)
    {
        u32SplitCnt = HIDO_UtilStrSplit((HIDO_CHAR *)_u8Data, ',', apcSplitStr, HIDO_ARRARY_COUNT(apcSplitStr));
        uint16_t buffer_len,datalen;
        char send_buffer[20]={"ERROR\r\n"};
        if (u32SplitCnt < 6)
        {
            return HIDO_ERR;
        }
        if (HIDO_UtilHexStrToInt(apcSplitStr[1]) == g_com_map[DEV_ID])
        {
            HIDO_INT32 gpskaiguan,uwbkaiguan,gpspinlv,uwbpinlv,gpsbaudrate1;
            gpskaiguan= HIDO_UtilStrToInt(apcSplitStr[2]);
            g_com_map[GPSENBLE] = gpskaiguan;
            uwbkaiguan= HIDO_UtilStrToInt(apcSplitStr[3]);
            g_com_map[UWBENBLE] = uwbkaiguan;
            gpspinlv= HIDO_UtilStrToInt(apcSplitStr[4]);
            g_com_map[GPSFrequency] = gpspinlv;
            uwbpinlv= HIDO_UtilStrToInt(apcSplitStr[5]);
            g_com_map[UWBFrequency] = uwbpinlv;
            gpsbaudrate1= HIDO_UtilStrToInt(apcSplitStr[6]);
            g_com_map[GPSBAUDRATE1_INDEX] = gpsbaudrate1>>16;
            g_com_map[GPSBAUDRATE2_INDEX] = gpsbaudrate1;
            
            
            if((g_com_map[GPSENBLE]||g_com_map[GPSENBLE]==0)
             &&(g_com_map[UWBENBLE]||g_com_map[UWBENBLE]==0)
             &&(g_com_map[GPSFrequency]<65535&&g_com_map[GPSFrequency]>0)
             &&(g_com_map[UWBFrequency]==1||g_com_map[UWBFrequency]==3||g_com_map[UWBFrequency]==5||g_com_map[UWBFrequency]==10)
             &&(gpsbaudrate1==9600||gpsbaudrate1==115200)
            )
            {
            save_com_map_to_flash();
//            Socket_Send(l_i32TCPClientID,(uint8_t*)send_buffer,buffer_len);
            g_com_map[CNT_RESTART] = 1;
            }
            else
            {
            Socket_Send(l_i32TCPClientID,(uint8_t*)send_buffer,10);
            }
        }
    }
    else if (STRCMP(_u8Data, "$read_gpsuwbpara,") == 0)
    {
        u32SplitCnt = HIDO_UtilStrSplit((HIDO_CHAR *)_u8Data, ',', apcSplitStr, HIDO_ARRARY_COUNT(apcSplitStr));
        uint16_t buffer_len,datalen;
        char send_buffer[200]={"ERROR\r\n"};
        if (u32SplitCnt < 1)
        {
            return HIDO_ERR;
        }
        if (HIDO_UtilHexStrToInt(apcSplitStr[1]) == g_com_map[DEV_ID])
        {
            uint16_t checksum = 0;
            send_buffer[0] = 0x55;
            send_buffer[1] = 0xAA;
            send_buffer[2] = 0x03;
            send_buffer[3] = 160+5;
            send_buffer[4] = CMD_REPLY;
            send_buffer[5] = 0;
            send_buffer[6] = 160;
            memcpy(&send_buffer[7], &g_com_map, 160);
            for(uint8_t i = 0; i<(160+5); i++)
            {
                checksum += send_buffer[2+i];
            }
            checksum = Checksum_u16(&send_buffer[2],5+160);
            memcpy(&send_buffer[7+160],&checksum,2);
            
            Socket_Send(l_i32TCPClientID,send_buffer,9+160);
        }
    }

    return HIDO_OK;
}

/*******************************************************************************
 * Function Name     : TCPClient_SocketEventProc
 * Description       :
 * Input             :
 * Output            :
 * Return            :
 * Author            : www.hido-studio.com
 * Modified Date:    : 2021?1?9?
 *******************************************************************************/
static  HIDO_VOID TCPClient_SocketEventProc(HIDO_INT32 _i32SockID, E_SocketEvent _eEvent, HIDO_VOID *_pData)
{
    switch(_eEvent)
    {
    case SOCKET_EVENT_CONNECT_FAILED:
    {
        if(l_eTCPClientState ==  TCP_CLIENT_STATE_CONNECTING)
        {
            TCPfail_flag = 0;
            l_eTCPClientState = TCP_CLIENT_STATE_IDLE;
        }

        break;
    }
    case SOCKET_EVENT_CONNECTED:
    {
        if(l_eTCPClientState ==  TCP_CLIENT_STATE_CONNECTING)
        {
            l_eTCPClientState = TCP_CLIENT_STATE_CONNECTED;
        }
        break;
    }
    case SOCKET_EVENT_CLOSED:
    {
        TCPfail_flag = 0;
        l_eTCPClientState = TCP_CLIENT_STATE_IDLE;
        break;
    }
    case SOCKET_EVENT_RECV_DATA:
    {
        HIDO_INT32 i32Ret = 0;
        HIDO_UINT32 u32RecvLen = 0;

        i32Ret = Socket_Recv(l_i32TCPClientID, l_au8CmdBuff, sizeof(l_au8CmdBuff) - 1, &u32RecvLen);
        if(HIDO_OK == i32Ret)
        {
            TCPClient_DataProc(l_au8CmdBuff, u32RecvLen);
        }
        break;
    }
    default:
    {
        break;
    }
    }
}

/*******************************************************************************
 *                             Global Function                                 *
 *******************************************************************************/
/*******************************************************************************
 * Function Name     :
 * Description       :
 * Input             :
 * Output            :
 * Return            :
 * Author            : www.hido-studio.com
 * Modified Date:    : 2021?1?9?
 *******************************************************************************/
extern uint8_t bat_percent,taglist_num;
uint8_t alarm_type;
extern double jd,wd;
extern int32_t distance;
extern  uint8_t userkey_state;
uint8_t gps_timeout_flag;
extern uint8_t GPS_GGAmessage[150];
uint16_t g_spsum,g_snum,ave_sp;
extern uint8_t GPS_ParseGGA_data[256];
extern uint8_t GPS_ParseGGA_changdu;
uint8_t uwbsendnum,gpssendnum;

extern uint8_t exercise_state;
extern uint32_t step_count;    
extern uint16_t gaodu;void UDPClient_UploadGPS(HIDO_CHAR *_pcGGA)
{
    if(TCP_CLIENT_STATE_CONNECTED == l_eTCPClientState)
    {
        

#ifdef JIBU_XIUMIAN				
        HIDO_UINT32 u32Len = HIDO_UtilSnprintf((HIDO_CHAR *)l_au8CmdBuff, sizeof(l_au8CmdBuff), "%s,%X,%02x,%x,%d,%d,%d%\r\n",
//                _pcGGA, g_com_map[DEV_ID], bat_percent,ave_sp,0,0,0);
                _pcGGA, g_com_map[DEV_ID], bat_percent,ave_sp,gaodu,(uint8_t)(step_count),exercise_state);
#else
        HIDO_UINT32 u32Len = HIDO_UtilSnprintf((HIDO_CHAR *)l_au8CmdBuff, sizeof(l_au8CmdBuff), "%s,%X,%02x,%x,%d,%d,%d%\r\n",
                _pcGGA, g_com_map[DEV_ID], bat_percent,ave_sp,gaodu,0,0);

#endif
       
//        if((l_u32UploadBuffLen + u32Len) < sizeof(l_acUploadBuff))
//        {
//            memcpy(l_acUploadBuff + l_u32UploadBuffLen, l_au8CmdBuff, u32Len);
//            l_u32UploadBuffLen += u32Len;
//        }
        //memcpy(l_acUploadBuff + l_u32UploadBuffLen, l_au8CmdBuff, u32Len);
        //l_u32UploadBuffLen += u32Len;
       // if((l_u32UploadBuffLen + u32Len )> sizeof(l_acUploadBuff))
//        if((HIDO_TimerGetTick() - l_u32UdpsendTick) >= 200)
        {
//            l_u32UdpsendTick = HIDO_TimerGetTick();
            Socket_Send(l_i32TCPClientID, (HIDO_UINT8 *)l_au8CmdBuff, u32Len);
            gpssendnum++;
//            l_u32UploadBuffLen = 0;
        }


    }
}
char senddata[2048];
void HexToAsciiSendUDP(uint8_t* data,uint8_t len)
{
    static HIDO_CHAR l_acUploadBuff[2048];
    static HIDO_UINT32 l_u32UploadBuffLen = 0;
    static HIDO_UINT32 l_u32UdpsendTick = 0;
	uint8_t i,temp;
	
	for(i=0;i<len;i++)
	{
		temp = *data++;
		sprintf(&senddata[2*i],"%x",temp>>4);
		sprintf(&senddata[2*i+1],"%x",temp&0xf);
	}
    senddata[2*len] = 0x0d;
    senddata[2*len+1] = 0x0a;
//    if(DBG_GetMode() == DBG_MODE_CFG)
//    Uart_Send(0, (HIDO_UINT8 *) senddata, 2*len+2);
//    UDPClient_Uploadhex(senddata,2*len+2);
    if(TCP_CLIENT_STATE_CONNECTED == l_eTCPClientState)
    {
        memcpy(l_acUploadBuff + l_u32UploadBuffLen, senddata, 2*len+2);
        l_u32UploadBuffLen += 2*len+2;
       // if((l_u32UploadBuffLen + u32Len )> sizeof(l_acUploadBuff))
//        if((HIDO_TimerGetTick() - l_u32UdpsendTick) >= 200)
//        {
//            l_u32UdpsendTick = HIDO_TimerGetTick();
            Socket_Send(l_i32TCPClientID, (HIDO_UINT8 *)l_acUploadBuff, l_u32UploadBuffLen);
            uwbsendnum++;
            l_u32UploadBuffLen = 0;
//        }


    }
}
void TCPHeartBeatUpload(void)
{
    HIDO_UINT32 u32Len = 0;
    if(TCP_CLIENT_STATE_CONNECTED == l_eTCPClientState)
    {
			
        if(g_com_map[RTCMMODE_INDEX] == RTCMMODE_TCP)
        {   u32Len = HIDO_UtilSnprintf((HIDO_CHAR *)l_au8CmdBuff, sizeof(l_au8CmdBuff), "$XTB,%X,%02u%%,%d.%d,%s,%d,3:%d.%d.%d.%d:%d.,1",
                                       g_com_map[DEV_ID], bat_percent, g_com_map[VERSION]>>8,g_com_map[VERSION]&0xff, Module_GetCCID(),\
            userkey_state,g_com_map[TCP_IP_0],g_com_map[TCP_IP_1],g_com_map[TCP_IP_2],g_com_map[TCP_IP_3],g_com_map[TCP_PORT]);
        } else if(g_com_map[RTCMMODE_INDEX] == RTCMMODE_NTRIP)
        {
            u32Len = HIDO_UtilSnprintf((HIDO_CHAR *)l_au8CmdBuff, sizeof(l_au8CmdBuff), "$XTB,%X,%02u%%,%d.%d,%s,%d,2%s %s,1",
                                       g_com_map[DEV_ID], bat_percent, g_com_map[VERSION]>>8,g_com_map[VERSION]&0xff, Module_GetCCID(),\
            userkey_state,(char *)&g_com_map[NTRIP_HOST_INDEX],(char *)&g_com_map[NTRIP_USERNANME_INDEX]);
        } else if(g_com_map[RTCMMODE_INDEX] == RTCMMODE_NONE)
        {
            u32Len = HIDO_UtilSnprintf((HIDO_CHAR *)l_au8CmdBuff, sizeof(l_au8CmdBuff), "$XTB,%X,%02u%%,%d.%d,%s,%d,1.,1",
                                       g_com_map[DEV_ID], bat_percent, g_com_map[VERSION]>>8,g_com_map[VERSION]&0xff, Module_GetCCID(),\
            userkey_state,g_com_map[TCP_IP_0],g_com_map[TCP_IP_1],g_com_map[TCP_IP_2],g_com_map[TCP_IP_3],g_com_map[TCP_PORT]);
        }
				userkey_state=0;
        Socket_Send(l_i32TCPClientID, (HIDO_UINT8 *)l_au8CmdBuff, u32Len);
    }
//	u32HeartLen = HIDO_UtilSnprintf((HIDO_CHAR *)acHeart, sizeof(acHeart), "$XTB,%X,%02u%%,%d.%d,%s",
//                    g_com_map[DEV_ID], bat_percent, g_com_map[VERSION]>>8,g_com_map[VERSION]&0xff, Module_GetCCID()); 
//    Socket_Send(l_i32TCPClientID, (HIDO_UINT8 *)acHeart, u32HeartLen);
    
    
}
void TCPReceiveMessageReply(void)
{
    HIDO_CHAR acHeart[200];
    HIDO_UINT32 u32HeartLen = snprintf(acHeart, sizeof(acHeart), "$rec_message,%04x",g_com_map[DEV_ID]);
    Socket_Send(l_i32TCPClientID, (HIDO_UINT8 *)acHeart, u32HeartLen);
}
void _4GAlarmUpload(uint8_t alarm)
{
    alarm_type = alarm;
    TCPHeartBeatUpload();
    if(alarm_type == 2)
        alarm_type = 0;
}
extern uint32_t uwbled,rtkled,led4g,powerled;
extern uint8_t heartbeasend_flag;
HIDO_INT32 TCPClient_Poll(void)
{
    if (Internet_IsIPReady() == HIDO_TRUE)
    {
        HIDO_UINT32 u32CurTick = HIDO_TimerGetTick();
        if (TCP_CLIENT_STATE_IDLE == l_eTCPClientState)
        {
            led4g=RED;
            if (!TCPfail_flag)
            {
                l_eTCPClientState = TCP_CLIENT_STATE_CONNECTING;


               HIDO_UtilSnprintf((HIDO_CHAR *) l_au8CmdBuff, sizeof(l_au8CmdBuff), "%u.%u.%u.%u", g_com_map[IP_0], g_com_map[IP_1], g_com_map[IP_2], g_com_map[IP_3]);

                Socket_Connect(l_i32TCPClientID, (HIDO_CHAR *) l_au8CmdBuff, g_com_map[PORT]);

//             HIDO_UtilSnprintf((HIDO_CHAR *) l_au8CmdBuff, sizeof(l_au8CmdBuff), "123.57.87.125");
//                Socket_Connect(l_i32TCPClientID, (HIDO_CHAR *) l_au8CmdBuff, 8888);
                
//                          HIDO_UtilSnprintf((HIDO_CHAR *) l_au8CmdBuff, sizeof(l_au8CmdBuff), "111.198.60.6");    
//                Socket_Connect(l_i32TCPClientID, (HIDO_CHAR *) l_au8CmdBuff, 1234);
               TCPfail_flag = 1;
            }
            else
            {
                if (u32CurTick - TCPfailetimer > HIDO_TIMER_TICK_S(5))
                {
                    TCPfailetimer = u32CurTick;
                    TCPfail_flag = 0;
                }
            }
        }
        else if (TCP_CLIENT_STATE_CONNECTED == l_eTCPClientState)
        {
           led4g=GREEN;
           if ((u32CurTick - l_u32HeartBeatTick) >= HIDO_TIMER_TICK_S(60)||flag_first_TCPconnect||heartbeasend_flag)
					 //if ((u32CurTick - l_u32HeartBeatTick) >= HIDO_TIMER_TICK_S(g_com_map[SEND_4G_SECOND])||flag_first_TCPconnect)
            {
                heartbeasend_flag=0;
                flag_first_TCPconnect = 0;
                l_u32HeartBeatTick = u32CurTick;
                // ÕâÀïÊÇ×Ô¶¨ÒåÐÄÌø
                TCPHeartBeatUpload();
								//UDPClient_UploadGPS();//ÏȲ»ÅªÐÄÌø
//                HIDO_CHAR acHeart[128];
//                HIDO_UINT32 u32HeartLen = snprintf(acHeart, sizeof(acHeart), "$message heart,%04x,00001,1,50,50,50,,,,\r\n", g_com_map[DEV_ID]);
//                Socket_Send(l_i32TCPClientID, (HIDO_UINT8 *)acHeart, u32HeartLen);
            }
        }
    }
    else
    {
        led4g=RED;
        l_eTCPClientState = TCP_CLIENT_STATE_IDLE;
    }

    return HIDO_OK;
}

/*******************************************************************************
 * Function Name     : TCPClient_Upload
 * Description       :
 * Input             :
 * Output            :
 * Return            :
 * Author            : www.hido-studio.com
 * Modified Date:    : 2021Äê1ÔÂ9ÈÕ
 *******************************************************************************/
HIDO_INT32 TCPClient_Upload(HIDO_UINT8 *_pu8Data, HIDO_UINT32 _u32Len)
{
    Socket_Send(l_i32TCPClientID, _pu8Data, _u32Len);

    return HIDO_OK;
}
HIDO_INT32 TCPClient_Uploadhex(uint8_t *_pcGGA,uint16_t u32Len)
{
    static HIDO_CHAR l_acUploadBuff[1024];
    static HIDO_UINT32 l_u32UploadBuffLen = 0;
    static HIDO_UINT32 l_u32UdpsendTick = 0;
    
    if(TCP_CLIENT_STATE_CONNECTED == l_eTCPClientState)
    {
        memcpy(l_acUploadBuff + l_u32UploadBuffLen, _pcGGA, u32Len);
        l_u32UploadBuffLen += u32Len;
       // if((l_u32UploadBuffLen + u32Len )> sizeof(l_acUploadBuff))
        if((HIDO_TimerGetTick() - l_u32UdpsendTick) >= 200)
        {
            l_u32UdpsendTick = HIDO_TimerGetTick();
            Socket_Send(l_i32TCPClientID, (HIDO_UINT8 *)l_acUploadBuff, l_u32UploadBuffLen);
            l_u32UploadBuffLen = 0;
        }


    }

    return HIDO_OK;
}
HIDO_BOOL TCPClient_IsSendOver(HIDO_VOID)
{
    return Socket_IsSendQueueEmpty(l_i32TCPClientID);
}

/*******************************************************************************
 * Function Name     : TCPClient_Init
 * Description       : TCP¿Í»§¶Ë³õʼ»¯
 * Input             : None
 * Output            : None
 * Return            : HIDO_OK ³É¹¦,HIDO_ERR ʧ°Ü
 * Author            : www.hido-studio.com
 * Modified Date:    : 2021Äê1ÔÂ9ÈÕ
 *******************************************************************************/
HIDO_INT32 TCPClient_Init(void)
{
    l_eTCPClientState = TCP_CLIENT_STATE_IDLE;
    Socket_Create(&l_i32TCPClientID, SOCKET_TYPE_UDP, TCPClient_SocketEventProc, HIDO_NULL);

    // ÕâÀïÊǹ̶¨µÄÐÄÌø£¬ÓÉ4G×ÔÐз¢ËÍ
#if 0
    HIDO_CHAR acHeart[64];
    HIDO_UINT32 u32HeartLen = snprintf(acHeart, sizeof(acHeart), "$message heart2,%04x\r\n", g_com_map[DEV_ID]);
    Socket_HeartbeatConfig(l_i32TCPClientID, (HIDO_UINT8 *)acHeart, u32HeartLen, 180);
#endif

    return HIDO_OK;
}
#ifdef _GPS_115200
char str[19]= {"AT+IPR=115200;&W\r\n"};
void AIR780E_Reset(void)
{
		PCA9555_Set_One_Value_Output(AIR780E_ENBALE,0);//¹Ø±Õ4G
    delay_ms(1500);
    PCA9555_Set_One_Value_Output(AIR780E_ENBALE,1);//´ò¿ª4G
    delay_ms(3000);
//    Uart_ReConfigBaudRate(UART_ID_4G,115200);
//    uart_send(UART_ID0, str,17, NULL);
//    Uart_ReConfigBaudRate(UART_ID_4G,9600);
} 
void AIR780E_Reset_usart(void)
{
	PCA9555_Set_One_Value_Output(AIR780E_ENBALE,0);//¹Ø±Õ4G
    delay_ms(1500);
    PCA9555_Set_One_Value_Output(AIR780E_ENBALE,1);//´ò¿ª4G
    delay_ms(3000);
    Uart_ReConfigBaudRate(UART_ID_4G,9600);
    uart_send(UART_ID0, str,19, NULL);
    Uart_ReConfigBaudRate(UART_ID_4G,115200);
    delay_ms(200);
    rtkled=GREEN;
    uwbled=GREEN;
    led4g=GREEN;
    powerled=GREEN;
    Set4LEDColor(uwbled,rtkled,led4g,powerled);
    PCA9555_Set_One_Value_Output(AIR780E_ENBALE,0);
    delay_ms(1500);
    PCA9555_Set_One_Value_Output(AIR780E_ENBALE,1);
    NVIC_SystemReset();
}
#else
char str[17]= {"AT+IPR=9600;&W\r\n"};
void AIR780E_Reset(void)
{
		PCA9555_Set_One_Value_Output(AIR780E_ENBALE,0);//¹Ø±Õ4G
    delay_ms(1500);
    PCA9555_Set_One_Value_Output(AIR780E_ENBALE,1);//´ò¿ª4G
    delay_ms(3000);
//    Uart_ReConfigBaudRate(UART_ID_4G,115200);
//    uart_send(UART_ID0, str,17, NULL);
//    Uart_ReConfigBaudRate(UART_ID_4G,9600);
}
void AIR780E_Reset_usart(void)
{
	PCA9555_Set_One_Value_Output(AIR780E_ENBALE,0);//¹Ø±Õ4G
    delay_ms(1500);
    PCA9555_Set_One_Value_Output(AIR780E_ENBALE,1);//´ò¿ª4G
    delay_ms(3000);
    Uart_ReConfigBaudRate(UART_ID_4G,115200);
    uart_send(UART_ID0, str,17, NULL);
    Uart_ReConfigBaudRate(UART_ID_4G,9600);
    delay_ms(200);
    rtkled=GREEN;
    uwbled=GREEN;
    led4g=GREEN;
    powerled=GREEN;
    Set4LEDColor(uwbled,rtkled,led4g,powerled);
    PCA9555_Set_One_Value_Output(AIR780E_ENBALE,0);
    delay_ms(1500);
    PCA9555_Set_One_Value_Output(AIR780E_ENBALE,1);
    NVIC_SystemReset();
}
#endif
uint8_t IfTCPConnected(void)
{
    if(TCP_CLIENT_STATE_CONNECTED == l_eTCPClientState)
    {
        return 1;
    } else {
        return 0;
    }
}