ap/app/zte_amt/amt.c

/**
 * 
 * @file      amt.c
 * @brief     
 *            This file is part of FTM.
 *            AMT´úÀíÓ¦Óòã
 *            
 * @details   
 * @author    Tools Team.
 * @email     
 * @copyright Copyright (C) 2013 Sanechips Technology Co., Ltd.
 * @warning   
 * @date      2019/02/02
 * @version   1.1
 * @pre       
 * @post      
 *            
 * @par       
 * Change History :
 * ---------------------------------------------------------------------------
 * date        version  author         description
 * ---------------------------------------------------------------------------
 * 2015/04/28  1.0      lu.xieji       Create file
 * 2019/02/02  1.1      jiang.fenglin  ÐÞ¸Ä×¢ÊÍ·½Ê½Îªdoxygen
 * ---------------------------------------------------------------------------
 * 
 * 
 */

#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <pthread.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/ioctl.h>
#include <sys/msg.h>
#include <fcntl.h>
#include <unistd.h>
#include "linux/rpmsg_zx29.h"
#include <sys/socket.h>
#include <netdb.h>
#include <netinet/in.h>
#include <linux/netlink.h>
#include <arpa/inet.h>
#include <netinet/in.h>
#include <signal.h>
#include <errno.h>
#include "port_com.h"
#include "amt.h"
#include "os_type_def.h"
#include "softap_api.h"
#include "other_msg.h"
#include "message.h"
#include "amt_agent_devicetest.h"
#include "kwatch_msg.h"
#include "amtnv.h"
#include "libcpnv.h"
#include <sys/prctl.h>
#include "sys/wait.h"
#include "ref_nv_def.h"
#include "nv_api.h"




/**
 * Íⲿº¯ÊýÒýÓÃ
 */
extern int Amt_Wifi_Init(void);
extern int Amt_Wifi_ProcessMsg(unsigned int msg_id, unsigned char *msg_buf, unsigned int msg_len);
extern int Amt_Gps_ProcessMsg(unsigned int msg_id, unsigned char *msg_buf, unsigned int msg_len);
extern int Amt_DeviceTest_ProcessMsg(unsigned int msg_id, unsigned char *msg_buf, unsigned int msg_len);
extern int Amt_Process_Gps_Rsp(MSG_BUF *msg,unsigned int msg_id);
extern int Amt_FuncTest_ProcessMsg(unsigned int msg_id, unsigned char *msg_buf, unsigned int msg_len);
extern int wifi_ioctl_handle(int cmd);


/**
 * È«¾Ö±äÁ¿ÉùÃ÷
 */
static int g_amt_fd_cp = -1;
static int g_amt_fd_usb = -1;
static int g_amt_fd_usb_hotplug = -1;
static int g_amt_fd_socket_client = -1;
static int g_amt_fd_socket_server = -1;
static fd_set g_amt_fdsread;
static int g_amt_fd_max = 0;
static volatile int *g_amt_fd_current = NULL;
static int g_amt_iMsgHandle = 0;
unsigned int g_amt_at_mode = 0;
#ifdef USE_CAP_SUPPORT
static int g_amt_fd_cap = -1;
#endif




/**
 * @brief AMTÏûÏ¢·¢Ë͸øPC
 * @param[in] fd ÎļþÃèÊö·û
 * @param[in] buf ½ÓÊÕÊý¾Ýbuffer
 * @param[in] buf_len ½ÓÊÕÊý¾Ýbuffer³¤¶È
 * @return ·µ»Ø·¢Ë͵ÄÊý¾Ý³¤¶È
 * @note
 * @see 
 */
static int Amt_SendData(int fd, unsigned char* buf, unsigned int buf_len)
{
    int write_len = PortSend(fd, (unsigned char*)&buf_len, sizeof(unsigned int), WAIT_ALL);

    //if (write_len > 0)
    {
        write_len = PortSend(fd, buf, buf_len, WAIT_ALL);

        if (write_len <= 0)
        {
            AmtPrintf(AMT_ERROR "%s: PortSend 'data' to device(fd = %d): write_len(%d) is wrong.\n", __FUNCTION__, fd, write_len);
        }
    }
	/*
    else
    {
        AmtPrintf(AMT_ERROR "%s: PortSend 'length' to device(fd = %d): write_len(%d) is wrong.\n", __FUNCTION__, fd, write_len);
    }
    */

    return write_len;
}

/**
 * @brief AMTÏûÏ¢·¢ËÍ
 * @param[in] fd ÎļþÃèÊö·û
 * @param[in] buf ½ÓÊÕÊý¾Ýbuffer
 * @param[in] buf_len ½ÓÊÕÊý¾Ýbuffer³¤¶È
 * @return ·µ»Ø·¢Ë͵ÄÊý¾Ý³¤¶È
 * @note
 * @see 
 */
static int Amt_SendDataToAmtagent(int fd, unsigned char* buf, unsigned int buf_len)
{
	int  write_len = PortSend(fd, buf, buf_len, NO_WAIT);

    if (write_len <= 0)
    {
    	AmtPrintf(AMT_ERROR "%s: PortSend 'data' to device(fd = %d): write_len(%d) is wrong.\n", __FUNCTION__, fd, write_len);
    }
	else
	{
        AmtPrintf(AMT_INFO "%s: PortSend 'data' to device(fd = %d): write_len(%d),buf_len(%d) \n", __FUNCTION__, fd, write_len,buf_len);
	}
    return write_len;
}


/**
 * @brief AMTÏûÏ¢½ÓÊÕ
 * @param[in] fd ÎļþÃèÊö·û
 * @param[in] buf ½ÓÊÕÊý¾Ýbuffer
 * @param[in] buf_len ½ÓÊÕÊý¾Ýbuffer³¤¶È
 * @return ·µ»Ø½ÓÊÕµ½µÄÊý¾Ý³¤¶È
 * @note
 * @see 
 */
static int Amt_ReceiveData(int fd, unsigned char* buf, unsigned int buf_len)
{
    int read_len = PortRecv(fd, buf, sizeof(unsigned int), WAIT_ALL);

    if (read_len > 0)
    {
        unsigned int packet_len = *((unsigned int *)buf);
        if (packet_len > 0 && packet_len <= buf_len)
        {
            read_len = PortRecv(fd, buf, packet_len, WAIT_ALL);

            if (read_len <= 0)
            {
                AmtPrintf(AMT_ERROR "%s: PortRecv 'data' from device(fd = %d): read_len(%d) is wrong.\n", __FUNCTION__, fd, read_len);
            }
        }
        else
        {
            AmtPrintf(AMT_ERROR "%s: fd = %d, packet_len(%d) is wrong.\n", __FUNCTION__, fd, packet_len);
            read_len = -1;
        }
    }
    else
    {
        AmtPrintf(AMT_ERROR "%s: PortRecv 'length' from device(fd = %d): read_len(%d) is wrong.\n", __FUNCTION__, fd, read_len);
    }

    return read_len;
}

#if 0
static void str_to_int( int *data, char *str )
{
    int Lc = 0;
    int	Len = 0;
    char *Begb = NULL;
    char *Endb = NULL;
    char *ptr = NULL;
    char s1[100] = "";
    char s2[50] = "";	
    memset(s1, 0, sizeof(s1));
    strcpy(s1, str);
    strcat(s1, ",");
    Begb = s1;						//ÆðʼµØÖ·
    Endb = strchr(s1,',');			//µÚÒ»¸ö¶ººÅλÖÃ
	if (Endb == NULL)
		return;
    Lc = 0;	
    do
    {
        Len = 0;
        Len = Endb - Begb;			//³¤¶È
        memset(s2, 0, sizeof(s2));	//½ØÈ¡Á½¸ö¶ººÅ¼äµÄ×Ö·û´®
        strncpy(s2, Begb, Len);		//½ØÈ¡Á½¸ö¶ººÅ¼äµÄ×Ö·û´®
        data[Lc] = atoi(s2);			//string to int
        ptr = Endb + 1;				//Ö¸ÏòϸöÊýµÄÆðʼµØÖ·
        strcpy(s1, ptr);			//È¥µôÒÑת»¯µÄ×Ö·û´®
        Begb = s1;					//ÆðʼµØÖ·¸üÐÂ
        Endb = strchr(s1,',');		//ϸö¶ººÅλÖÃ
        Lc++;
    }while(Endb!=NULL); 
}
#endif

static void str_to_double( double *data, char *str )
{
    int Lc = 0;
    int	Len = 0;
    char *Begb = NULL;
    char *Endb = NULL;
    char *ptr = NULL;
    char s1[100] = "";
    char s2[50] = "";	
    memset(s1, 0, sizeof(s1));
    memcpy(s1, str,sizeof(s1) - 1);
    strcat(s1, ",");
    Begb = s1;						//ÆðʼµØÖ·
    Endb = strchr(s1,',');			//µÚÒ»¸ö¶ººÅλÖÃ
	if (Endb == NULL)
		return;
    Lc = 0;	
    do
    {
        Len = 0;
        Len = Endb - Begb;			//³¤¶È
        memset(s2, 0, sizeof(s2));	//½ØÈ¡Á½¸ö¶ººÅ¼äµÄ×Ö·û´®
        memcpy(s2, Begb, sizeof(s2) - 1);		//½ØÈ¡Á½¸ö¶ººÅ¼äµÄ×Ö·û´®
        data[Lc] = atof(s2);			//string to int
        ptr = Endb + 1;				//Ö¸ÏòϸöÊýµÄÆðʼµØÖ·
        memcpy(s1, ptr, 99);			//È¥µôÒÑת»¯µÄ×Ö·û´®
        Begb = s1;					//ÆðʼµØÖ·¸üÐÂ
        Endb = strchr(s1,',');		//ϸö¶ººÅλÖÃ
        Lc++;
    }while(Endb!=NULL); 
}

#ifdef USE_CAP_SUPPORT
/**
 * @brief ¶ÁÈ¡cap²àµÄ·´À¡ÏûÏ¢Ï̺߳¯Êý
 * @param[in] args Ï̺߳¯Êý²ÎÊý
 * @return N/A
 * @note
 * @see 
 */
static void* ReadFromCAPThread(void* args)
{
    // Read from AP-CAP channel
    char *receive_buffer = NULL;

	UNUSED(args);
	
	receive_buffer = malloc(MAX_PACKET_LENGTH);
    if (receive_buffer == NULL)
    {
        return NULL;
    }

	prctl(PR_SET_NAME, "AmtReadFromCAP");

    while (1)
    {
        int read_len = Amt_ReceiveData(g_amt_fd_cap, (unsigned char *)receive_buffer, MAX_PACKET_LENGTH);

        if (read_len > 0)
        {
            AmtPrintf(AMT_INFO "%s: Receive cap data, read_len = %d!.\n", __FUNCTION__, read_len);

            if (g_amt_fd_current && *g_amt_fd_current >= 0)
            {
                if(g_amt_at_mode != 1)
                {
                    Amt_SendData(*g_amt_fd_current, (unsigned char *)receive_buffer, read_len);
                }
            }
            else
            {
                AmtPrintf(AMT_ERROR "%s: Current fd is wrong.\n", __FUNCTION__);
            }
        }
    }

    free(receive_buffer);
    return NULL;
}
#endif


/**
 * @brief ¶ÁÈ¡cp²àµÄ·´À¡ÏûÏ¢Ï̺߳¯Êý
 * @param[in] args Ï̺߳¯Êý²ÎÊý
 * @return N/A
 * @note
 * @see 
 */
static void* ReadFromCPThread(void* args)
{
    // Read from AP-CP channel
    char *receive_buffer = NULL;

	UNUSED(args);
	
	receive_buffer = malloc(MAX_PACKET_LENGTH);
    if (receive_buffer == NULL)
    {
        return NULL;
    }

	prctl(PR_SET_NAME, "AmtReadFromCP");

    while (1)
    {
        int read_len = Amt_ReceiveData(g_amt_fd_cp, (unsigned char *)receive_buffer, MAX_PACKET_LENGTH);

        if (read_len > 0)
        {
            AmtPrintf(AMT_INFO "%s: Receive cp data, read_len = %d!.\n", __FUNCTION__, read_len);

            if (g_amt_fd_current && *g_amt_fd_current >= 0)
            {
                if(g_amt_at_mode != 1)
                {
                    Amt_SendData(*g_amt_fd_current, (unsigned char *)receive_buffer, read_len);
                }
            }
            else
            {
                AmtPrintf(AMT_ERROR "%s: Current fd is wrong.\n", __FUNCTION__);
            }

            
            unsigned int status = cpnv_FsGcWait(FS_NVROFS);
            if(status != CPNV_OK)
                AmtPrintf(AMT_INFO "%s: cpnv_FsGcWait fail, err = %d.\n", __FUNCTION__, status);
        }
    }

    free(receive_buffer);
    return NULL;
}


/**
 * @brief ¶ÁÈ¡ÆäËûappµÄÏûÏ¢Ï̺߳¯Êý
 * @param[in] args Ï̺߳¯Êý²ÎÊý
 * @return N/A
 * @note
 * @see 
 */
static void* RecvMsgFromAppThread(void* args)
{
    int iRet ;
    MSG_BUF stMsg = {0};
    LONG msgSize =  sizeof(MSG_BUF) - sizeof(LONG);

	UNUSED(args);

    prctl(PR_SET_NAME, "AmtRecvAppMsg");
    while(1)
    {
        iRet = 0;
        memset(&stMsg, 0x00, sizeof(MSG_BUF));

        iRet = msgrcv(g_amt_iMsgHandle, &stMsg, msgSize, 0, 0);
        if(iRet >= 0)
        {
            AmtPrintf(AMT_INFO "%s: msgcmd = 0x%x,datalen=%d.\n", __FUNCTION__,stMsg.usMsgCmd,stMsg.usDataLen);
			
            switch (stMsg.usMsgCmd)
            {
            case MSG_CMD_AMT_BATTERY_VOLTAGE_TEST_RSP:
            {
                AmtPrintf(AMT_INFO "%s: recv  MSG_CMD_AMT_BATTERY_VOLTAGE_TEST_RSP.\n", __FUNCTION__);
                int result = AMT_SUCCESS_RET;
                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_BATTERY_VOLTAGE, result, (unsigned char *)stMsg.aucDataBuf, stMsg.usDataLen);
                break;
            }
            
            case MSG_CMD_AMT_KEY_TEST_START_RSP:
            {
                int result = AMT_ERROR_RET;
				int* pAucDataBuf = (int*)stMsg.aucDataBuf;
                result =  *pAucDataBuf;
                if (result ==  0)
                {
                    result = AMT_SUCCESS_RET;
                }
                else
                {
                    result = AMT_ERROR_RET;
                    AmtPrintf(AMT_INFO "%s: KEY_TEST_START fail.", __FUNCTION__);
                }

                 Amt_DeviceTest_SendMsg(MSG_DEVICETEST_KEYBOARD_START, result, NULL, 0);
                 break;
            }
            
            case MSG_CMD_AMT_KEY_TEST_STOP_RSP:
            {
                int result = AMT_SUCCESS_RET;
                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_KEYBOARD_STOP, result, (unsigned char *)stMsg.aucDataBuf, stMsg.usDataLen);
                break;
            }
            
            case MSG_CMD_AMT_LCD_TEST_START_RSP:
            {
                int result = AMT_ERROR_RET;
				int* pAucDataBuf = (int*)stMsg.aucDataBuf;
                result =  *pAucDataBuf;
                if (result ==  0)
                {
                    result = AMT_SUCCESS_RET;
                }
                else
                {
                    result = AMT_ERROR_RET;
                    AmtPrintf(AMT_INFO "%s: LCD_TEST_START fail.", __FUNCTION__);
                }

                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_LCD_START, result, NULL, 0);
                break;
            }
            
            case MSG_CMD_AMT_LCD_TEST_STOP_RSP:
            {
                int result = AMT_ERROR_RET;
				int* pAucDataBuf = (int*)stMsg.aucDataBuf;
                result =  *pAucDataBuf;
				AmtPrintf(AMT_INFO "%s: LCD_TEST_STOP result=%d\n", __FUNCTION__,result);
                if (result ==  0)
                {
                    result = AMT_SUCCESS_RET;
                }
                else
                {
                    result = AMT_ERROR_RET;
                    AmtPrintf(AMT_INFO "%s: LCD_TEST_STOP fail.", __FUNCTION__);
                }

                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_LCD_STOP, result, NULL, 0);
                break;
            }

            case MSG_CMD_AMT_LCD_BACKLIGHT_TEST_START_RSP:
            {
                int result = AMT_ERROR_RET;
				int* pAucDataBuf = (int*)stMsg.aucDataBuf;
                result =  *pAucDataBuf;
                if (result ==  1)
                {
                    result = AMT_SUCCESS_RET;
                }
                else
                {
                    result = AMT_ERROR_RET;
                    AmtPrintf(AMT_INFO "%s: LCD_BACKLIGHT_TEST_START fail.", __FUNCTION__);
                }

                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_LCDBACKLIGHT_START, result, NULL, 0);
                break;
            }
            
            case MSG_CMD_AMT_LCD_BACKLIGHT_TEST_STOP_RSP:
            {
                int result = AMT_ERROR_RET;
				int* pAucDataBuf = (int*)stMsg.aucDataBuf;
                result =  *pAucDataBuf;
                if (result ==  0)
                {
                    result = AMT_SUCCESS_RET;
                }
                else
                {
                    result = AMT_ERROR_RET;
                    AmtPrintf(AMT_INFO "%s: LCD_BACKLIGHT_TEST_STOP fail.", __FUNCTION__);
                }

                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_LCDBACKLIGHT_STOP, result, NULL, 0);
                break;
            }

            case MSG_CMD_AMT_VIBRATOR_TEST_START_RSP:
            {
                int result = AMT_ERROR_RET;
				int* pAucDataBuf = (int*)stMsg.aucDataBuf;
                result =  *pAucDataBuf;
                if (result ==  1)
                {
                    result = AMT_SUCCESS_RET;
                }
                else
                {
                    result = AMT_ERROR_RET;
                    AmtPrintf(AMT_INFO "%s: VIBRATOR_TEST_START fail.", __FUNCTION__);
                }

                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_VIBRATOR_START, result, NULL, 0);
                break;
            }
            
            case MSG_CMD_AMT_VIBRATOR_TEST_STOP_RSP:
            {
                int result = AMT_ERROR_RET;
				int* pAucDataBuf = (int*)stMsg.aucDataBuf;
                result =  *pAucDataBuf;
                if (result ==  0)
                {
                    result = AMT_SUCCESS_RET;
                }
                else
                {
                    result = AMT_ERROR_RET;
                    AmtPrintf(AMT_INFO "%s: VIBRATOR_TEST_STOP fail.", __FUNCTION__);
                }

                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_VIBRATOR_STOP, result, NULL, 0);
                break;
            }

            case MSG_CMD_AMT_CAMERA_TEST_START_RSP:
            {
                int result = AMT_ERROR_RET;
				int* pAucDataBuf = (int*)stMsg.aucDataBuf;
                result =  *pAucDataBuf;
                if (result ==  1)
                {
                    result = AMT_SUCCESS_RET;
                }
                else
                {
                    result = AMT_ERROR_RET;
                    AmtPrintf(AMT_INFO "%s: CAMERA_TEST_START fail.", __FUNCTION__);
                }

                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_CAMERA_BACK_START, result, NULL, 0);
                break;
            }
            
            case MSG_CMD_AMT_CAMERA_TEST_STOP_RSP:
            {
                int result = AMT_ERROR_RET;
				int* pAucDataBuf = (int*)stMsg.aucDataBuf;
                result =  *pAucDataBuf;
                if (result ==  0)
                {
                    result = AMT_SUCCESS_RET;
                }
                else
                {
                    result = AMT_ERROR_RET;
                    AmtPrintf(AMT_INFO "%s: CAMERA_TEST_STOP fail.", __FUNCTION__);
                }

                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_CAMERA_BACK_STOP, result, NULL, 0);
                break;
            }

            case MSG_CMD_AMT_SPEAKER_TEST_RSP:
            {
                AmtPrintf(AMT_INFO "%s: recv  MSG_CMD_AMT_SPEAKER_TEST_RSP.\n", __FUNCTION__);
                int result = AMT_ERROR_RET;
				int* pAucDataBuf = (int*)stMsg.aucDataBuf;
                result =  *pAucDataBuf;
                if (result ==  1)
                {
                    result = AMT_SUCCESS_RET;
                }
                else
                {
                    result = AMT_ERROR_RET;
                    AmtPrintf(AMT_INFO "%s: SPEAKER_TEST fail.", __FUNCTION__);
                }

                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_AUDIO_MIC_SPEAKER, result, NULL, 0);
                break;
            }

            case MSG_CMD_AMT_SPEAKER_TEST_STOP_RSP:
            {
                AmtPrintf(AMT_INFO "%s: recv  MSG_CMD_AMT_SPEAKER_TEST_STOP_RSP.\n", __FUNCTION__);
                int result = AMT_SUCCESS_RET;
                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_AUDIO_MIC_SPEAKER_STOP, result, NULL, 0);
                break;
            }
            
            case MSG_CMD_AMT_RECEIVER_TEST_RSP:
            {
                AmtPrintf(AMT_INFO "%s: recv  MSG_CMD_AMT_RECEIVER_TEST_RSP.\n", __FUNCTION__);
                int result = AMT_ERROR_RET;
				int* pAucDataBuf = (int*)stMsg.aucDataBuf;
                result =  *pAucDataBuf;
                if (result ==  1)
                {
                    result = AMT_SUCCESS_RET;
                }
                else
                {
                    result = AMT_ERROR_RET;
                    AmtPrintf(AMT_INFO "%s: RECEIVER_TEST fail.", __FUNCTION__);
                }

                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_AUDIO_MIC_RECEIVER, result, NULL, 0);
                break;
            }

            case MSG_CMD_AMT_RECEIVER_TEST_STOP_RSP:
            {
                AmtPrintf(AMT_INFO "%s: recv  MSG_CMD_AMT_RECEIVER_TEST_STOP_RSP.\n", __FUNCTION__);
                int result = AMT_SUCCESS_RET;
                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_AUDIO_MIC_RECEIVER_STOP, result, NULL, 0);
                break;
            }

            case MSG_CMD_AMT_TP_TEST_START_RSP:
            {
                int result = AMT_ERROR_RET;
				int* pAucDataBuf = (int*)stMsg.aucDataBuf;
                result =  *pAucDataBuf;
                if (result ==  1)
                {
                    result = AMT_SUCCESS_RET;
                }
                else
                {
                    result = AMT_ERROR_RET;
                    AmtPrintf(AMT_INFO "%s: TP_TEST_START fail.", __FUNCTION__);
                }

                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_TP_START, result, NULL, 0);
                break;
            }
            
            case MSG_CMD_AMT_TP_TEST_STOP_RSP:
            {
                int result = AMT_ERROR_RET;
				int* pAucDataBuf = (int*)stMsg.aucDataBuf;
                result =  *pAucDataBuf;
                if (result ==  0)
                {
                    result = AMT_SUCCESS_RET;
                }
                else
                {
                    result = AMT_ERROR_RET;
                    AmtPrintf(AMT_INFO "%s: TP_TEST_STOP fail.", __FUNCTION__);
                }

                Amt_DeviceTest_SendMsg(MSG_DEVICETEST_TP_STOP, result, NULL, 0);
                break;
            }

            case MSG_CMD_AMT_GSENSOR_TEST_START_RSP:
            {
                break;
            }
            
            case MSG_CMD_AMT_GSENSOR_TEST_STOP_RSP:
            {
                break;
            }
			
	        case MSG_CMD_AMT_WIFI_TEST_START_RSP:
			{
				int result = AMT_ERROR_RET;
				int* pAucDataBuf = (int*)stMsg.aucDataBuf;
				result =  *pAucDataBuf;
                if (result ==  1)
                {
                	result = AMT_SUCCESS_RET;
                }
				else
				{
					result = AMT_ERROR_RET;
					AmtPrintf(AMT_INFO "%s: Wifi test fail!", __FUNCTION__);
				}

				Amt_DeviceTest_SendMsg(MSG_DEVICETEST_WIFI, result, NULL, 0);
				break;
			}

			case MSG_CMD_AMT_FLASHLIGHT_START_RSP:
			{
				int result = AMT_ERROR_RET;
				int* pAucDataBuf = (int*)stMsg.aucDataBuf;
				result =  *pAucDataBuf;
                if (result ==  1)
                {
                	result = AMT_SUCCESS_RET;
                }
				else
				{
					result = AMT_ERROR_RET;
					AmtPrintf(AMT_INFO "%s: flashlight test fail!", __FUNCTION__);
				}

				Amt_DeviceTest_SendMsg(MSG_DEVICETEST_FLASHLIGHT_START, result, NULL, 0);
				break;
			}
			//gps²âÊÔÏûÏ¢»ØÓ¦
            case KWATCH_MSG_GPS_RSP:
            {
                Amt_Process_Gps_Rsp(&stMsg,FID_GPS_MODULE_TEST);
                break;
            }
            default:
                break;
        }
      }
    }
	return NULL;
}


/**
 * @brief ¼ÓÔØ°®¿Æ΢WIFI¹Ì¼þ
 * @param[in] args Ï̺߳¯Êý²ÎÊý
 * @return N/A
 * @note
 * @see 
 */
static void* LoadWifiFirmwareThread(void* args)
{
    int ret = -1;
    UNUSED(args);
	
	prctl(PR_SET_NAME, "LoadWifiFirmwareThread");

	#if (defined(__AIC_8800DW_CHIP__))
	ret = wifi_ioctl_handle(3); //¼ÓÔزâÊԹ̼þ
	if(ret < 0)
	{
		AmtPrintf(AMT_ERROR "%s: load AIC_8800DW firmware fail! ret=%d.\n", __FUNCTION__, ret);
	}
    else
	{
		AmtPrintf(AMT_INFO "%s: load AIC_8800DW firmware success! ret=%d.\n", __FUNCTION__, ret);
	}
	#endif
	
    return NULL;
}


/**
 * @brief AMTÏûÏ¢´ò°ü·¢¸øCP
 * @param[in] fd ÎļþÃèÊö·û
 * @param[in] msg_id FID
 * @param[in] buf ½ÓÊÕÊý¾Ýbuffer
 * @param[in] buf_len ½ÓÊÕÊý¾Ýbuffer³¤¶È
 * @return ³É¹¦·µ»Ø0
 * @note
 * @see 
 */
static int Amt_SendMessageToAmtagent(int fd, unsigned int msg_id, unsigned char* buf, unsigned int buf_len)
{
    // STX  TID  FID   Data  Check  ETX
    unsigned int CmdCount = 1 + 1 + 1 + buf_len + 1   + 1;
    unsigned char *pRsp = NULL;
    unsigned char *pSTX = NULL;
    unsigned char *pETX = NULL;
    unsigned char *pTID = NULL;
    unsigned char *pFID = NULL;
    unsigned char *pCheck = NULL;
    unsigned char *pData = NULL;
    unsigned char CheckSum = 0;
    unsigned int i = 0;

    pRsp = malloc(CmdCount);
	if(pRsp == NULL)
		return -1;
    memset(pRsp, 0, CmdCount);

    pSTX = &pRsp[0];
    pETX = &pRsp[1 + 1 + 1 + buf_len + 1];
    pTID = &pRsp[1];
    pFID = &pRsp[1 + 1];
    pCheck = &pRsp[1 + 1 + 1 + buf_len];
    pData = &pRsp[1 + 1 + 1];
	
    *pSTX = 0x02;
    *pETX = 0x02;
    *pTID = (msg_id & 0xFF00) >> 8;
    *pFID = (msg_id & 0xFF);

    if (buf != NULL && buf_len > 0)
    {
        memcpy(pData, buf, buf_len);
    }

    CheckSum = 0;

    for (i = 0; i < (1 + 1 + buf_len); i++)
        CheckSum ^= pRsp[1 + i];

    *pCheck = CheckSum;

    Amt_SendDataToAmtagent(fd, pRsp, CmdCount);

    free(pRsp);
    return 0;
}


/**
 * @brief AMTÏûÏ¢´ò°ü·¢¸øPC
 * @param[in] fd ÎļþÃèÊö·û
 * @param[in] msg_id FID
 * @param[in] buf ½ÓÊÕÊý¾Ýbuffer
 * @param[in] buf_len ½ÓÊÕÊý¾Ýbuffer³¤¶È
 * @return ³É¹¦·µ»Ø0
 * @note
 * @see 
 */
static int Amt_SendMessage(int fd, unsigned int msg_id, unsigned char* buf, unsigned int buf_len)
{
    // STX  TID  FID   Data  Check  ETX
    unsigned int CmdCount = 1 + 1 + 1 + buf_len + 1   + 1;
    unsigned char *pRsp = NULL;
    unsigned char *pSTX = NULL;
    unsigned char *pETX = NULL;
    unsigned char *pTID = NULL;
    unsigned char *pFID = NULL;
    unsigned char *pCheck = NULL;
    unsigned char *pData = NULL;
    unsigned char CheckSum = 0;
    unsigned int i = 0;

    pRsp = malloc(CmdCount);
	if(pRsp == NULL)
		return -1;
    memset(pRsp, 0, CmdCount);

    pSTX = &pRsp[0];
    pETX = &pRsp[1 + 1 + 1 + buf_len + 1];
    pTID = &pRsp[1];
    pFID = &pRsp[1 + 1];
    pCheck = &pRsp[1 + 1 + 1 + buf_len];
    pData = &pRsp[1 + 1 + 1];

    *pSTX = 0x02;
    *pETX = 0x02;
    *pTID = (msg_id & 0xFF00) >> 8;
    *pFID = (msg_id & 0xFF);

    if (buf != NULL && buf_len > 0)
    {
        memcpy(pData, buf, buf_len);
    }

    CheckSum = 0;

    for (i = 0; i < (1 + 1 + buf_len); i++)
        CheckSum ^= pRsp[1 + i];

    *pCheck = CheckSum;

    Amt_SendData(fd, pRsp, CmdCount);

    free(pRsp);
    return 0;
}

#ifdef USE_CAP_SUPPORT
/**
 * @brief AMTÏûÏ¢·¢ËÍ
 * @param[in] fd ÎļþÃèÊö·û
 * @param[in] buf ½ÓÊÕÊý¾Ýbuffer
 * @param[in] buf_len ½ÓÊÕÊý¾Ýbuffer³¤¶È
 * @return ·µ»Ø·¢Ë͵ÄÊý¾Ý³¤¶È
 * @note
 * @see 
 */
static int Amt_SendDataToCAP(int fd, unsigned char* buf, unsigned int buf_len)
{
    int write_len = PortSend(fd, (unsigned char*)&buf_len, sizeof(unsigned int), WAIT_ALL);

    if (write_len != sizeof(unsigned int))
    {
        AmtPrintf(AMT_ERROR "%s: Failed to send data_len to fd(%d)! write_len = %d.\n",
                  __FUNCTION__, fd, write_len);
        write_len = 0;
    }
    else
    {
        if (buf != NULL && buf_len > 0)
        {
            write_len = PortSend(fd, buf, buf_len, WAIT_ALL);

            if (write_len != (int)buf_len)
            {
                AmtPrintf(AMT_ERROR "%s: Failed to send data to fd(%d)! (write_len = %d) != (buf_len = %d).\n",
                          __FUNCTION__, fd, write_len, buf_len);
            }
        }
    }

    return write_len;
}


/**
 * @brief AMTÏûÏ¢´ò°ü·¢¸øCAP
 * @param[in] fd ÎļþÃèÊö·û
 * @param[in] msg_id FID
 * @param[in] buf ½ÓÊÕÊý¾Ýbuffer
 * @param[in] buf_len ½ÓÊÕÊý¾Ýbuffer³¤¶È
 * @return ³É¹¦·µ»Ø0
 * @note
 * @see 
 */
static int Amt_SendMessageToCAP(int fd, unsigned int msg_id, unsigned char* buf, unsigned int buf_len)
{
    // STX  TID  FID   Data  Check  ETX
    unsigned int CmdCount = 1 + 1 + 1 + buf_len + 1   + 1;
    unsigned char *pRsp = NULL;
    unsigned char *pSTX = NULL;
    unsigned char *pETX = NULL;
    unsigned char *pTID = NULL;
    unsigned char *pFID = NULL;
    unsigned char *pCheck = NULL;
    unsigned char *pData = NULL;
    unsigned char CheckSum = 0;
    unsigned int i = 0;

    pRsp = malloc(CmdCount);
	if(pRsp == NULL)
		return -1;
    memset(pRsp, 0, CmdCount);

    pSTX = &pRsp[0];
    pETX = &pRsp[1 + 1 + 1 + buf_len + 1];
    pTID = &pRsp[1];
    pFID = &pRsp[1 + 1];
    pCheck = &pRsp[1 + 1 + 1 + buf_len];
    pData = &pRsp[1 + 1 + 1];
	
    *pSTX = 0x02;
    *pETX = 0x02;
    *pTID = (msg_id & 0xFF00) >> 8;
    *pFID = (msg_id & 0xFF);

    if (buf != NULL && buf_len > 0)
    {
        memcpy(pData, buf, buf_len);
    }

    CheckSum = 0;

    for (i = 0; i < (1 + 1 + buf_len); i++)
        CheckSum ^= pRsp[1 + i];

    *pCheck = CheckSum;

    Amt_SendDataToCAP(fd, pRsp, CmdCount);

    free(pRsp);
    return 0;
}
#endif



/**
 * @brief AMTÏûÏ¢´¦Àíº¯Êý
 * @param[in] msg_id FID
 * @param[in] buf ½ÓÊÕÊý¾Ýbuffer
 * @param[in] buf_len ½ÓÊÕÊý¾Ýbuffer³¤¶È
 * @return ³É¹¦·µ»Ø0
 * @note
 * @see 
 */
static int Amt_ProcessMessage(unsigned int msg_id, unsigned char* buf, unsigned int buf_len)
{
    if (msg_id >= FID_WIFI_CMD_NORTN && msg_id <= FID_WIFI_CMD_END) // wifi test
    {
        Amt_Wifi_ProcessMsg(msg_id, buf, buf_len);
    }
    else if (msg_id == FID_GET_CHIP_PLATFORM)
    {
         //
	    if(is_amt_mode())
	    {
	    	AmtPrintf(AMT_ERROR "AMT MODE!\n");
	    }
	    else
	    {
	    	AmtPrintf(AMT_ERROR "Normal MODE!\n");
	    }
        unsigned char chipType = 0;
        AmtPrintf(AMT_INFO "%s: Get chip platform msg_id = %#04x, buf_len = %d.\n",
                  __FUNCTION__, msg_id, buf_len);
        chipType = 1; /*1:7520V3 2:7100*/

        if (Amt_CreateResponse(msg_id, &chipType, sizeof(unsigned char)) == -1)
        {
            AmtPrintf(AMT_ERROR "%s: Send data failure.\n", __FUNCTION__);
        }
        else
        {
            AmtPrintf(AMT_INFO "%s: Send data success.\n", __FUNCTION__);
        }
    }
    else if (msg_id >= FID_GPS_MODULE_TEST && msg_id <= FID_GPS_CMD_END) // gps test
    {
        Amt_Gps_ProcessMsg(msg_id, buf, buf_len);
    }
    else if (msg_id >= MSG_DEVICETEST_START && msg_id <= MSG_DEVICETEST_END)
    {
        Amt_DeviceTest_ProcessMsg(msg_id, buf, buf_len);
    }
	else if (msg_id == FID_AMT_END)
    {
		unsigned int status = CPNV_OK;//cpnv_ChangeFsPartitionAttr(FS_NVROFS, 1);
		/*
	       if(status != CPNV_OK)
		{
			AmtPrintf(AMT_ERROR "%s: cpnv_ChangeFsPartitionAttr RW nvrofs failed!\n", __FUNCTION__);
			return -1;
		}*/
		
        status = cpnv_FsGcWait(FS_NVROFS);
		if(status == CPNV_OK)
			AmtPrintf(AMT_INFO "%s: cpnv_FsGcWait ok.\n", __FUNCTION__);
		else
			AmtPrintf(AMT_INFO "%s: cpnv_FsGcWait fail, err = %d.\n", __FUNCTION__, status);

		if (Amt_CreateResponse(msg_id, (unsigned char*)&status, sizeof(unsigned int)) == -1)
        {
            AmtPrintf(AMT_ERROR "%s: Send data failure.\n", __FUNCTION__);
        }
        else
        {
            AmtPrintf(AMT_INFO "%s: Send data success.\n", __FUNCTION__);
        }
    }
	else if (msg_id == FID_AMT_EXIT)
	{
	    unsigned int status = 0;
		if (Amt_CreateResponse(msg_id, (unsigned char*)&status, sizeof(unsigned int)) == -1)
        {
            AmtPrintf(AMT_ERROR "%s: Send data failure.\n", __FUNCTION__);
        }
        else
        {
            AmtPrintf(AMT_INFO "%s: Send data success.\n", __FUNCTION__);
        }
	}
    else if (msg_id == FID_EX_COMMON_SETBOOTMODE)
    {
        // set normal mode
        unsigned char bootmode[] = {0xFF, 0xFF};        
		unsigned int dwRet = CPNV_OK;

        //struct timespec ts;
		//clock_gettime(CLOCK_MONOTONIC, &ts);
		//AmtPrintf(AMT_INFO "[%8d.%03d] %s: cpnv_FsGcWait start.\n", ts.tv_sec, ts.tv_nsec / 1000000,__FUNCTION__);
        unsigned char mode = 4;
		if(buf_len == sizeof(mode))
		{
		    memcpy(&mode, buf, sizeof(mode));
		}
		AmtPrintf(AMT_INFO "%s: boot mode=%d\n", __FUNCTION__,mode);
		switch(mode)
		{
		     case 0: //user mode
             {   
                 nv_set_item(NV_RO, "usb_modetype", "user", 1);
				 nv_commit(NV_RO);
				 bootmode[0] =0x54;
                 bootmode[1] =0x00;
                 break;
             }
             case 1://debug mode
             {
                 nv_set_item(NV_RO, "usb_modetype", "debug", 1);
				 nv_commit(NV_RO);
				 bootmode[0] =0x54;
                 bootmode[1] =0x01;
                 break;
             }
             case 2://factory mode
             {
                 nv_set_item(NV_RO, "usb_modetype", "factory", 1);
				 nv_commit(NV_RO);
				 bootmode[0] =0x54;
                 bootmode[1] =0x02;
                 break;
             }
             case 3://amt mode
             {
			 	 //nv_set_item(NV_RO, "usb_modetype", "amt", 1);
			 	 //nv_commit(NV_RO);
				 bootmode[0] =0x54;
                 bootmode[1] =0x4D;
                 break;
             }
             default:
             {
                 break;
             }
		}

        dwRet = amt_set_bootmode(bootmode);
        if (dwRet == CPNV_OK)
        {
            AmtPrintf(AMT_INFO "%s: set boot mode: sucess.\n", __FUNCTION__);
        }
        else
        {
            AmtPrintf(AMT_ERROR "%s: set boot mode: failed.\n", __FUNCTION__);
        }
		//clock_gettime(CLOCK_MONOTONIC, &ts);
		//AmtPrintf(AMT_INFO "[%8d.%03d] %s: cpnv_FsGcWait ok.\n", ts.tv_sec, ts.tv_nsec / 1000000, __FUNCTION__);
      
        if (Amt_CreateResponse(msg_id, (unsigned char*)&dwRet, sizeof(unsigned int)) == -1)
        {
            AmtPrintf(AMT_ERROR "%s: Send data failure.\n", __FUNCTION__);
        }
        else
        {
            AmtPrintf(AMT_INFO "%s: Send data success.\n", __FUNCTION__);
        }
    }
	else if(msg_id == FID_CHECK_SOFTDOG_CIPHER_TEXT)
    {
        UINT8 softdog_cipher_texts[OS_FLASH_AMT_COMM_RO_SOFTDOG_CIPHER_TEXT_SIZE] = {0};
    	if(!amt_read_nv_item(ABSOFTDOG_CIPHER_TEXT_NVPARAM,softdog_cipher_texts,sizeof(softdog_cipher_texts)))
    	{
        	if (Amt_CreateResponse(msg_id, softdog_cipher_texts, sizeof(softdog_cipher_texts)) == -1)
            {
           		AmtPrintf(AMT_ERROR "%s: Send data failure.\n", __FUNCTION__);
        	}
       		else
        	{
            	AmtPrintf(AMT_INFO "%s: Send data success.\n", __FUNCTION__);
       		}
    	}
	    else
	    {
			AmtPrintf(AMT_ERROR "%s: read softdog cipher text in address:0x%x failure.\n", __FUNCTION__,OS_FLASH_AMT_COMM_RO_SOFTDOG_CIPHER_TEXT_ADDRESS);
		}
    }
	else if(msg_id == FID_SET_BAT_DET_FLAG)
    {
        unsigned int  retCode = CPNV_ERROR;
        int bat_value = -1;
        memcpy(&bat_value, buf, sizeof(int));
		retCode =amt_set_batdet_flag(bat_value);   
    
        if (retCode == CPNV_OK)
        {
        	AmtPrintf(AMT_INFO "%s: amt_set_batdet_flag success.\n", __FUNCTION__);
		}
    	else
    	{
    		AmtPrintf(AMT_INFO "%s: amt_set_batdet_flag fail.\n", __FUNCTION__);  
    	}
		if (Amt_CreateResponse(msg_id, (unsigned char*)&retCode, sizeof(retCode)) == -1)
        {
        	AmtPrintf(AMT_ERROR "%s: Send data failure.\n", __FUNCTION__);
        }
       	else
        {
        	AmtPrintf(AMT_INFO "%s: Send data success.\n", __FUNCTION__);
       	}
    }
	else if(msg_id == FID_GET_BAT_DET_FLAG)
    {
        unsigned int  retCode = CPNV_ERROR;
        int bat_value = 0;
        retCode =amt_get_batdet_flag(&bat_value);   
    
        if (retCode == CPNV_OK)
        {
        	AmtPrintf(AMT_INFO "%s: amt_get_batdet_flag success.bat_value=%d\n", __FUNCTION__,bat_value);
			if (Amt_CreateResponse(msg_id, (unsigned char*)&bat_value, sizeof(bat_value)) == -1)
	        {
	        	AmtPrintf(AMT_ERROR "%s: Send data failure.\n", __FUNCTION__);
	        }
	       	else
	        {
	        	AmtPrintf(AMT_INFO "%s: Send data success.\n", __FUNCTION__);
	       	}
		}
    	else
    	{
    		AmtPrintf(AMT_INFO "%s: amt_get_batdet_flag fail.\n", __FUNCTION__);  
    	}
	}
	else if(msg_id == FID_RINISOFTVERSION)
    {
        unsigned int retCode = CPNV_ERROR;
	    char TmpSoftVersion[ZPS_REF_MSINFO_MAX_SOFTVERSION_INT_LEN+1]={0};

	    retCode = cpnv_NvItemRead(ZPS_REF_MSINFO_SOFTVERSION_INT_BASE_ADDR, (unsigned char*)TmpSoftVersion, ZPS_REF_MSINFO_MAX_SOFTVERSION_INT_LEN);
	    if (retCode == CPNV_OK)
        {
            TmpSoftVersion[ZPS_REF_MSINFO_MAX_SOFTVERSION_INT_LEN] = '\0';
            AmtPrintf(AMT_INFO "%s: inner version=%s\n", __FUNCTION__,TmpSoftVersion);
			if (Amt_CreateResponse(msg_id, (unsigned char*)TmpSoftVersion, sizeof(TmpSoftVersion)) == -1)
	        {
	        	AmtPrintf(AMT_ERROR "%s: Send data failure.\n", __FUNCTION__);
	        }
	       	else
	        {
	        	AmtPrintf(AMT_INFO "%s: Send data success.\n", __FUNCTION__);
	       	}
		}
    	else
    	{
    	    AmtPrintf(AMT_INFO "%s: get inner version fail!\n", __FUNCTION__);  
    	}	
    }
	else if(msg_id == FID_ROUTSOFTVERSION)
    {
        unsigned int retCode = CPNV_ERROR;
        char TmpExtcgmr[ZPS_REF_MSINFO_MAX_SOFTVERSION_EXT_LEN+1]={0};

	    retCode =cpnv_NvItemRead(ZPS_REF_MSINFO_SOFTVERSION_EXT_BASE_ADDR, (unsigned char *)TmpExtcgmr, ZPS_REF_MSINFO_MAX_SOFTVERSION_EXT_LEN);
	    if (retCode == CPNV_OK)
        {
            TmpExtcgmr[ZPS_REF_MSINFO_MAX_SOFTVERSION_EXT_LEN] = '\0';
            AmtPrintf(AMT_INFO "%s: outer version=%s\n", __FUNCTION__,TmpExtcgmr);
			if (Amt_CreateResponse(msg_id, (unsigned char*)TmpExtcgmr, sizeof(TmpExtcgmr)) == -1)
	        {
	        	AmtPrintf(AMT_ERROR "%s: Send data failure.\n", __FUNCTION__);
	        }
	       	else
	        {
	        	AmtPrintf(AMT_INFO "%s: Send data success.\n", __FUNCTION__);
	       	}
		}
    	else
    	{
            AmtPrintf(AMT_INFO "%s: get outer version fail!\n", __FUNCTION__);  
    	}		
    }
	else if((msg_id >= FID_FUN_TEST_START)&&(msg_id <= FID_FUN_TEST_END))
	{
		Amt_FuncTest_ProcessMsg(msg_id, buf, buf_len);
	}
	#ifdef USE_CAP_SUPPORT
	else if((msg_id >= FID_CAP_TEST_START)&&(msg_id <= FID_CAP_TEST_END))
	{
		 AmtPrintf(AMT_INFO "%s: receive cap msg.\n", __FUNCTION__);
        // Send message to CAP
        if (Amt_SendMessageToCAP(g_amt_fd_cap, msg_id, buf, buf_len) == -1)
        {
            AmtPrintf(AMT_ERROR "%s: Failed to send data to cap, msg_id = %#04x, buf_len = %d.\n",
                      __FUNCTION__, msg_id, buf_len);
        }
        else
        {
            AmtPrintf(AMT_INFO "%s: Send data to cap, msg_id = %#04x, buf_len = %d.\n",
                      __FUNCTION__, msg_id, buf_len);
        }
	}
	#endif
    else // CP message
    {
        AmtPrintf(AMT_INFO "%s: receive old cp msg.\n", __FUNCTION__);
        // Send message to CP
       if (Amt_SendMessageToAmtagent(g_amt_fd_cp, msg_id, buf, buf_len) == -1)
        {
            AmtPrintf(AMT_ERROR "%s: Failed to send data to cp, msg_id = %#04x, buf_len = %d.\n",
                      __FUNCTION__, msg_id, buf_len);
        }
        else
        {
            AmtPrintf(AMT_INFO "%s: Send data to cp, msg_id = %#04x, buf_len = %d.\n",
                      __FUNCTION__, msg_id, buf_len);
        }
    }

    return 0;
}


/**
 * @brief AMTÏûÏ¢½â°ü
 * @param[in] buf ½ÓÊÕÊý¾Ýbuffer
 * @param[in] buf_len ½ÓÊÕÊý¾Ýbuffer³¤¶È
 * @return N/A
 * @note
 * @see 
 */
static void Amt_ComposeAndProcess(unsigned char *buf, unsigned int buf_len)
{
    unsigned char *pSTX = NULL;
    unsigned char *pETX = NULL;
    unsigned char *pTID = NULL;
    unsigned char *pFID = NULL;
    unsigned char *pCheck = NULL;
    unsigned char *pData = NULL;
    unsigned char CheckSum = 0;
    unsigned int msg_id;
    unsigned int i = 0;
    pTID = pTID;
    pCheck = pCheck;
    pData = pData;

    pSTX = &buf[0];
    pETX = &buf[buf_len - 1];
    pTID = &buf[1];
    pFID = &buf[1 + 1];
    pCheck = &buf[buf_len - 2];
    pData = &buf[1 + 1 + 1];

    if (!((0x02 == *pSTX) && (0x02 == *pETX)))
    {
        return;
    }

    CheckSum = 0;

    for (i = 0; i < (buf_len - 2); i++)
        CheckSum ^= buf[1 + i];

    if (CheckSum != 0)
    {
        return;
    }

    // TIDÓëFID×éºÏʹÓÃÒÑÀ©Õ¹¹¦ÄܺÅ
    msg_id = (*pTID << 8) | *pFID;

    AmtPrintf(AMT_INFO "%s: msg_id = %#04x, buf_len = %d.\n", __FUNCTION__, msg_id, buf_len);
    Amt_ProcessMessage(msg_id, pFID + 1, (buf_len - 1 - 1 - 1 - 1 - 1));
}


/**
 * @brief AMTÏûÏ¢·´À¡
 * @param[in] msg_id FID
 * @param[in] buf ½ÓÊÕÊý¾Ýbuffer
 * @param[in] buf_len ½ÓÊÕÊý¾Ýbuffer³¤¶È
 * @return ³É¹¦·µ»Ø0, ʧ°Ü·µ»Ø-1
 * @note
 * @see 
 */
int Amt_CreateResponse(unsigned int msg_id, unsigned char* buf, unsigned int buf_len)
{
    if (g_amt_fd_current && *g_amt_fd_current >= 0)
    {
        return Amt_SendMessage(*g_amt_fd_current, msg_id, buf, buf_len);
    }
    else
    {
        AmtPrintf(AMT_ERROR "%s: Current fd is wrong.\n", __FUNCTION__);
        return -1;
    }
}

int wfsystem(const char * cmd)
{
	pid_t ret  =  0 ;
	ret = soft_system(cmd);
	AmtPrintf (AMT_ERROR "[%s]ret = %d, WIFEXITED(ret)=%d, WEXITSTATUS(ret) =%d",cmd, ret , WIFEXITED (ret), WEXITSTATUS (ret));
	if (! (-1 != ret && WIFEXITED (ret) && 0 == WEXITSTATUS (ret))) {
		return -1;
	}
	return 0;
}

int check_wlan (void)
{
	int find_wlan = -1;
	int i = 0, sum = 0;

	while (-1 == find_wlan) {
		AmtPrintf (AMT_ERROR "finding wlan  i=%d, %d s...", i , sum);
		find_wlan = wfsystem ("ifconfig wlan0");
		if (-1==find_wlan) {
			if (sum >= 60)
				return  -1;
			sum += 2 * i;
			sleep (2 * i++);
		}
	}
	return 0;
}

int Amt_ExecuteCmd(char *pcmd, char *pbuffer, int len)
{
    FILE *pPipe;
	static int wifi_init = 0;
    AmtPrintf(AMT_INFO "%s: execute \"%s\"!\n", __FUNCTION__, pcmd);
    if(0 == wifi_init)
    {
		if(0 == strcmp(pcmd, "ifconfig wlan0 up")){
			check_wlan();
			wifi_init = 1;
		}
	}
	
    if ((pPipe = popen(pcmd, "r")) == NULL)
    {
        AmtPrintf(AMT_ERROR "popen \"%s\" failure.\n", pcmd);
        return -1;
    }

    int read_len = fread(pbuffer, 1, len, pPipe);
    //AmtPrintf(AMT_INFO "fread, read_len = %d, pbuffer = %s.\n", read_len, pbuffer);

    pclose(pPipe);
    return read_len;
}

static int init_cp_channel(void)
{
    int fd = open(AMT_CP_CHANNEL, O_RDWR);

    if (fd < 0)
    {
        AmtPrintf(AMT_ERROR "Failed to open \"%s\"!\n", AMT_CP_CHANNEL);
        return -1;
    }

    if(ioctl(fd, RPMSG_CREATE_CHANNEL, (8*1024))!= 0)   // ´´½¨Í¨µÀ´óС8K
    {
        AmtPrintf(AMT_ERROR "ioctrl:RPMSG_CREATE_CHANNEL fail!\n");
    }
    if(ioctl(fd, RPMSG_SET_INT_FLAG, NULL)!= 0)       // ·¢ËÍÏûϢʱ£¬´¥·¢ÖжÏ
    {
        AmtPrintf(AMT_ERROR "ioctrl:RPMSG_SET_INT_FLAG fail!\n");
    }
    if(ioctl(fd, RPMSG_CLEAR_POLL_FLAG, NULL)!= 0)      // ×èÈûµÄ·½Ê½¶Á
    {
        AmtPrintf(AMT_ERROR "ioctrl:RPMSG_CLEAR_POLL_FLAG fail!\n");
	}
    return fd;
}

static int init_usb_device(void)
{
    int fd = open(AMT_USB_DEV, O_RDWR);

    if (fd < 0)
    {
        AmtPrintf(AMT_ERROR "Failed to open \"%s\"!\n", AMT_USB_DEV);
        return -1;
    }

    PortSet(fd);
    return fd;
}

static int init_hotplug_nl(void)
{
    struct sockaddr_nl snl;
    bzero(&snl, sizeof(snl));
    snl.nl_family = AF_NETLINK;
    snl.nl_pid = getpid();
    snl.nl_groups = 1;

    int s = socket(PF_NETLINK, SOCK_DGRAM, NETLINK_KOBJECT_UEVENT);
    if (s == -1)
    {
        AmtPrintf(AMT_ERROR "Can't create hotplug socket!\n");
        return -1;
    }

    if (bind(s, (struct sockaddr *)&snl, sizeof(snl)) < 0)
    {
        AmtPrintf(AMT_ERROR "Can't bind hotplug socket!\n");
		close(s);
        return -1;
    }

    return s;
}

static int init_socket(int port)
{
    struct sockaddr_in seraddr;
    int sockfd = -1;

    AmtPrintf(AMT_INFO "port = %d.\n", port);

    sockfd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP);
    if (sockfd == -1)
    {
        AmtPrintf(AMT_ERROR "Can't create socket!\n");
        return -1;
    }

    memset(&seraddr,0,sizeof(seraddr));
    seraddr.sin_family = AF_INET;
    seraddr.sin_addr.s_addr = 0;
    seraddr.sin_port = htons(port);

    if (bind(sockfd, (struct sockaddr*)(&seraddr), sizeof(seraddr)) < 0)
    {
        AmtPrintf(AMT_ERROR "Can't bind port %d!\n", port);
		close(sockfd);
        return -1;
    }

    if (listen(sockfd, 1) == -1)
    {
        AmtPrintf(AMT_ERROR "Socket listen failed!\n");
		close(sockfd);
        return -1;
    }

    return sockfd;
}

#ifdef USE_CAP_SUPPORT
static int init_cap_channel(void)
{
    int fd = open(AMT_CAP_DEV, O_RDWR);

    if (fd < 0)
    {
        AmtPrintf(AMT_ERROR "Failed to open \"%s\"!\n", AMT_CAP_DEV);
        return -1;
    }

    if(ioctl(fd, RPMSG_CREATE_CHANNEL, (4*1024))!= 0)   // ´´½¨Í¨µÀ´óС4K
    {
        AmtPrintf(AMT_ERROR "ioctrl:RPMSG_CREATE_CHANNEL fail!\n");
    }
    if(ioctl(fd, RPMSG_SET_INT_FLAG, NULL)!= 0)       // ·¢ËÍÏûϢʱ£¬´¥·¢ÖжÏ
    {
        AmtPrintf(AMT_ERROR "ioctrl:RPMSG_SET_INT_FLAG fail!\n");
    }
    if(ioctl(fd, RPMSG_CLEAR_POLL_FLAG, NULL)!= 0)      // ×èÈûµÄ·½Ê½¶Á
    {
        AmtPrintf(AMT_ERROR "ioctrl:RPMSG_CLEAR_POLL_FLAG fail!\n");
	}
    return fd;
}
#endif


static void set_fd(int fd)
{
    FD_SET(fd, &g_amt_fdsread);
    if (fd >= g_amt_fd_max)
    {
        g_amt_fd_max = fd + 1;
    }
}

static void clr_fd(int fd)
{
    FD_CLR(fd, &g_amt_fdsread);
}

static int CreateSendPacket(unsigned     short fid, unsigned char *data_buf, int data_len, unsigned char*packet_buf)
{
    int bRet = 0;
    BYTE *pSTX = NULL;
    BYTE *pETX = NULL;
	//FIDµÄ¸ß×Ö½Ú
    BYTE *pHFID = NULL;
	//FIDµÄµÍ×Ö½Ú
    BYTE *pLFID = NULL;
    BYTE *pCheck = NULL;
    BYTE *pData = NULL;
    BYTE CheckSum = 0;
	int i = 0;

    //            STX FID  Data Check  ETX
    int CmdCount = 1 + 2 + data_len + 1   + 1;

    if ((data_len != 0) && (NULL == data_buf))
    {
        return bRet;
    }

    pSTX = &packet_buf[0];
    pETX = &packet_buf[1 + 2 + data_len + 1];
    pHFID = &packet_buf[1];
    pLFID = &packet_buf[1+1];
    pCheck = &packet_buf[1 + 2 + data_len];
    pData = &packet_buf[1 + 2];

    *pSTX = 0x02;
    *pETX = 0x02;
    *pHFID = (fid>>8)&0x00FF;
    *pLFID = fid&0x00FF;
    memcpy(pData, data_buf, data_len);
    CheckSum = 0;
	//CheckSumÊÇFIDºÍDATA×ֶεÄУÑé
    for (i = 0; i < (2 + data_len); i++)
        CheckSum ^= packet_buf[1 + i];
    *pCheck = CheckSum;
    bRet = 1;
    return bRet;
}

static void send_enter_amt_mode_packet()
{
    u32 enter_amt_req[5] = {0};
	enter_amt_req[0] = 0x0100;
	enter_amt_req[1] = 1;
	enter_amt_req[2] = 1;
	enter_amt_req[3] = 0;
	enter_amt_req[4] = 0;

	unsigned char enter_amt_packet[25] = {0};
	unsigned short fid = 0x005f;
	CreateSendPacket(fid,(unsigned char*)enter_amt_req,sizeof(enter_amt_req),enter_amt_packet);
	Amt_ComposeAndProcess(enter_amt_packet, sizeof(enter_amt_packet));
}

static void send_exit_amt_mode_packet()
{
	u32 exit_amt_req[5] = {0};
	exit_amt_req[0] = 0x0100;
	exit_amt_req[1] = 0;
	exit_amt_req[2] = 1;
	exit_amt_req[3] = 0;
	exit_amt_req[4] = 0;

	unsigned char exit_amt_packet[25] = {0};
	unsigned short fid = 0x005f;
	CreateSendPacket(fid,(unsigned char*)exit_amt_req,sizeof(exit_amt_req),exit_amt_packet);
	Amt_ComposeAndProcess(exit_amt_packet, sizeof(exit_amt_packet));

}


static void send_tx_start_packet(unsigned int band,unsigned int channel,short int_power,short dec_power)
{
    typedef struct
    {
        UINT32  MsgId;
    	UINT32  wBandNum;       // Ƶ¶Î
    	UINT32  dwEarfcn;   
    	UINT32  wFreq;          // ÖÐÐÄƵµã£¬100kHzΪµ¥Î»
    	UINT32  wBandWidth;     // ´ø¿í£¬100kHzΪµ¥Î»
    	UINT32  wAntennaPort;   // ÌìÏß¶Ë¿Ú  £¿£¿£¿
    	UINT32  wModulation;    // µ÷ÖÆ·½Ê½£¬0£ºQPSK£¬1£º16QAM£¬2£º64QAM
    	UINT32  wRBNum;         // RB¸öÊý
    	UINT32  wRBStartPosition;  // RBÆðʼƫÒÆ
    	UINT32  wSingleWave;    // ÊÇ·ñΪµ¥Ôز¨
    	SINT16 swRfIntPower; 	//¹¦ÂÊÕûÊý
    	SINT16 swRfDecPower;	//¹¦ÂÊСÊý,[-2 -1 0 1 2 ]´ú±í[-0.5 -0.25 0 0.25 0.5]
	}T_zAMT_LTEA_SetTxInit_Req; 

	T_zAMT_LTEA_SetTxInit_Req stTxInitReq = {0};
	stTxInitReq.MsgId = 0x0700;
	stTxInitReq.wBandNum = band;
	stTxInitReq.dwEarfcn = channel;
	stTxInitReq.wFreq = 0;
	stTxInitReq.wBandWidth = 9;
	stTxInitReq.wAntennaPort = 0;
	stTxInitReq.wModulation = 0;
	stTxInitReq.wRBNum = 50;
	stTxInitReq.wRBStartPosition = 0;
	stTxInitReq.wSingleWave = 0;
	stTxInitReq.swRfIntPower = int_power;
	stTxInitReq.swRfDecPower = dec_power;

	unsigned char tx_start_packet[sizeof(stTxInitReq)+5] = {0};
	unsigned short fid = 0x005f;
	CreateSendPacket(fid,(unsigned char*)&stTxInitReq,sizeof(stTxInitReq),tx_start_packet);
	Amt_ComposeAndProcess(tx_start_packet, sizeof(tx_start_packet));
	
}

static void send_tx_stop_packet()
{
    u32 tx_close_req[1] = {0};
	tx_close_req[0] = 0x0201;
	unsigned char tx_stop_packet[1*4+5] = {0};
	unsigned short fid = 0x005f;
	CreateSendPacket(fid,(unsigned char*)tx_close_req,sizeof(tx_close_req),tx_stop_packet);
	Amt_ComposeAndProcess(tx_stop_packet, sizeof(tx_stop_packet));

}

static void send_switch_to_user_mode_packet()
{
    unsigned char bootmode[] = {0x54, 0x00};
	unsigned char atmode[] = {0xFF, 0xFF};
	nv_set_item(NV_RO, "usb_modetype", "user", 1);
	nv_commit(NV_RO);
	amt_set_amt_atmode(bootmode,atmode);
}

static void send_ok(int fd)
{
    char rep_ok[] = "OK\r\n";
	PortSend(fd, (unsigned char*)rep_ok, strlen(rep_ok), WAIT_ALL);
}

/**
 * @brief ATÃüÁî½ÓÊÕ
 * @param[in] fd ÎļþÃèÊö·û
 * @param[in] buf ½ÓÊÕÊý¾Ýbuffer
 * @param[in] buf_len ½ÓÊÕÊý¾Ýbuffer³¤¶È
 * @return ·µ»Ø½ÓÊÕµ½µÄÊý¾Ý³¤¶È
 * @note
 * @see 
 */
static int At_ReceiveData(int fd, char* buf, unsigned int buf_len)
{
    int read_len = 0;
	int i = 0;
	read_len = PortRecv(fd, buf, 100, NO_WAIT);
    AmtPrintf(AMT_INFO "%s: read_len=%d.\n", __FUNCTION__, read_len);
    if (read_len > 0)
    {
        buf[read_len] = '\0';
        AmtPrintf(AMT_INFO "%s: receive [%s]\n", __FUNCTION__, buf);
		//ת»»ÎªÐ¡Ð´
		for(i = 0; i < read_len; i++)
		{
		    char at = tolower(buf[i]);
			buf[i] = at;
		}
		AmtPrintf(AMT_INFO "%s: after tolower [%s]\n", __FUNCTION__, buf);
        //at+txstart=band,channel,power
		if(strstr(buf,"at+txstart") != NULL)
		{
		    AmtPrintf(AMT_INFO "%s: receive at+txstart\n", __FUNCTION__);
			double data[3] = {0.0};
			unsigned int band = 0;
			unsigned int channel = 0;
			short int_power = 0;
			short idec_power = 0;
			double dec_power = 0.0;
			//»ñÈ¡²ÎÊý
			buf = buf + strlen("at+txstart=");
			if(buf != NULL)
			{
			    str_to_double(data,buf);
				band = data[0];
				channel = data[1];
				int_power = data[2];
				dec_power = data[2] - int_power;
				idec_power = dec_power*4;
				AmtPrintf(AMT_INFO "%s: band=%d,channel=%d,int_power=%d,dec_power=%f,idec_power=%d\n", __FUNCTION__, band,channel,int_power,dec_power,idec_power);
				if(band == 0)
				{
				   AmtPrintf(AMT_ERROR "%s: invalid band!\n", __FUNCTION__);
				   return read_len;
				   	
				}
				if(channel == 0 )
				{
				   AmtPrintf(AMT_ERROR "%s: invalid channel!\n", __FUNCTION__);
				   return read_len;
				}
			}
			//ת»¯Îª½øÈëamtģʽºÍtxinitÁ½ÌõAMTÖ¸Áî
			send_enter_amt_mode_packet();
			sleep(1);
			send_tx_start_packet(band,channel,int_power,idec_power);
			send_ok(fd); //Ö±½Ó¸øATÃüÁî·¢ËÍÕ߻ظ´ok
			
		}
		else if(strstr(buf,"at+txstop") != NULL)
		{
		    //ת»¯Îª¹Ø±Õ·¢Éä»úºÍÍ˳öamtģʽÁ½ÌõAMTÖ¸Áî
			send_tx_stop_packet();
		    sleep(1);
			send_exit_amt_mode_packet();
			send_ok(fd);
		}
		else if(strstr(buf,"at+zversiontype=3") != NULL)
		{
			send_switch_to_user_mode_packet();
			send_ok(fd);
		}
		else
		{
		    AmtPrintf(AMT_ERROR "%s: unknown at %s.\n", __FUNCTION__, buf);
		}
    }
    else
    {
        AmtPrintf(AMT_ERROR "%s: PortRecv from device(fd = %d): read_len(%d) is wrong.\n", __FUNCTION__, fd, read_len);
    }

    return read_len;
}

/**
 * Main Function
 */
int main (int argc, char *argv[])
{
    extern char *optarg;
    extern int optind;
    int c;
	int socket_port = -1;

    /********************** Get arguments ********************/
    while ((c = getopt(argc,argv,"p:r:")) != EOF)
    {
        switch (c)
        {
            case 'p':
                socket_port = atoi(optarg);
                break;
            case '?':
                AmtPrintf(AMT_INFO "Usage: zte_amt [options]\n");
                AmtPrintf(AMT_INFO "-p ipport - Set IP port number to listen on\n");
                exit(1);
        }
    }

    AmtPrintf(AMT_INFO "start AMT!\n");

    FD_ZERO(&g_amt_fdsread);

    /********************** Init AP-CP channel ********************/
    g_amt_fd_cp = init_cp_channel();
    if (g_amt_fd_cp < 0)
    {
        return -1;
    }
    else
    {
        AmtPrintf(AMT_INFO "g_amt_fd_cp = %d.\n", g_amt_fd_cp);
    }

    /********************** Init USB device ***********************/
    g_amt_fd_usb = init_usb_device();
    if (g_amt_fd_usb >= 0)
    {
        AmtPrintf(AMT_INFO "g_amt_fd_usb = %d.\n", g_amt_fd_usb);
        set_fd(g_amt_fd_usb);

        //Init hotplug netlink
        g_amt_fd_usb_hotplug = init_hotplug_nl();
        if (g_amt_fd_usb_hotplug >= 0)
        {
            AmtPrintf(AMT_INFO "g_amt_fd_usb_hotplug = %d.\n", g_amt_fd_usb_hotplug);
            set_fd(g_amt_fd_usb_hotplug);
        }
    }
	
    /*********************** Create socket ***********************/
    if (socket_port > 0)
    {
        g_amt_fd_socket_server = init_socket(socket_port);
        if (g_amt_fd_socket_server >= 0)
        {
            AmtPrintf(AMT_INFO "g_amt_fd_socket_server = %d.\n", g_amt_fd_socket_server);
            set_fd(g_amt_fd_socket_server);
        }
    }
	
    #ifdef USE_CAP_SUPPORT
	/********************** Init AP-CAP channel ********************/
	g_amt_fd_cap = init_cap_channel();
    if (g_amt_fd_cap < 0)
    {
        return -1;
    }
    else
    {
        AmtPrintf(AMT_INFO "g_amt_fd_cap = %d.\n", g_amt_fd_cap);
    }

	 // Create CAP read thread
    pthread_t cap_read_thread;
    if (pthread_create(&cap_read_thread, NULL, ReadFromCAPThread, NULL) != 0)
    {
        AmtPrintf(AMT_ERROR "Failed to create CAP read thread!\n");
        return -1;
    }
	#endif

    // Create CP read thread
    pthread_t cp_read_thread;
    if (pthread_create(&cp_read_thread, NULL, ReadFromCPThread, NULL) != 0)
    {
        AmtPrintf(AMT_ERROR "Failed to create CP read thread!\n");
        return -1;
    }

    // Wifi init
    Amt_Wifi_Init();
    g_amt_iMsgHandle = msgget(MODULE_ID_AMT, IPC_CREAT|0600);
    if(-1 == g_amt_iMsgHandle) 
    {
   	    AmtPrintf(AMT_ERROR "%s: can not create msg queue for AMT!\n", __FUNCTION__);
	    return -1;
    }

    pthread_t msg_recv_thread;
    if (pthread_create(&msg_recv_thread, NULL, RecvMsgFromAppThread, NULL) != 0)
    {
   	 AmtPrintf(AMT_ERROR "Failed to create RecvMsgFromAppThread thread!\n");
         return -1;
    }
    // malloc receive buffer
    char *receive_buffer = malloc(MAX_PACKET_LENGTH);
    if (receive_buffer == NULL)
    {
        return -1;
    }

    int ret = -1;
    int read_len = 0;
    fd_set tmpfds;

	ret = cpnv_ChangeFsPartitionAttr(FS_NVROFS, 1);
	if(ret != CPNV_OK)
	{
		AmtPrintf(AMT_ERROR "%s: cpnv_ChangeFsPartitionAttr RW nvrofs failed!\n", __FUNCTION__);
		free(receive_buffer);
		return -1;
	}
	else
	{
	    AmtPrintf(AMT_INFO"%s: cpnv_ChangeFsPartitionAttr RW nvrofs ok!\n", __FUNCTION__);
	}

	//¼ÓÔØaic8800¹Ì¼þ
    // Create load wifi firmware thread
    pthread_t load_wifi_firmware_thread;
    if (pthread_create(&load_wifi_firmware_thread, NULL, LoadWifiFirmwareThread, NULL) != 0)
    {
        AmtPrintf(AMT_ERROR "Failed to create load wifi firmware thread!\n");
		free(receive_buffer);
        return -1;
    }

	#if 0
	#if (defined(__AIC_8800DW_CHIP__))
	ret = wifi_ioctl_handle(3); //¼ÓÔزâÊԹ̼þ
	if(ret < 0)
	{
		AmtPrintf(AMT_ERROR "%s: load AIC_8800DW firmware fail! ret=%d.\n", __FUNCTION__, ret);
	}
    else
	{
		AmtPrintf(AMT_INFO "%s: load AIC_8800DW firmware success! ret=%d.\n", __FUNCTION__, ret);
	}
	#endif
	#endif

	g_amt_at_mode = is_amt_atmode();
	AmtPrintf(AMT_INFO"%s: g_amt_at_mode=%d\n", __FUNCTION__,g_amt_at_mode);

    while (1)
    {
        tmpfds = g_amt_fdsread;
        ret = select(g_amt_fd_max, &tmpfds, NULL, NULL, NULL);
        if (ret <= 0)
        {
            AmtPrintf(AMT_ERROR "select error: %s!\n", strerror(errno));
            continue;
        }

        if (g_amt_fd_usb_hotplug >= 0 && FD_ISSET(g_amt_fd_usb_hotplug, &tmpfds))
        {
            read_len = PortRecv(g_amt_fd_usb_hotplug, (unsigned char *)receive_buffer, MAX_PACKET_LENGTH - 1, NO_WAIT);
			if(read_len >= 0)
				receive_buffer[read_len] = '\0';

			// Ç¿ÖÆÔö¼Ó½áÊø·û, read_len < MAX_PACKET_LENGTH
			receive_buffer[MAX_PACKET_LENGTH - 1] = '\0';

            if (strstr(receive_buffer, AMT_DETECT_USB_HOTREMOVE))
            {
                AmtPrintf(AMT_INFO "USB remove!\n");
                system("poweroff");
                break;
            }

            if (strstr(receive_buffer, AMT_DETECT_USB_OFFLINE))
            {
                AmtPrintf(AMT_INFO "USB offline!\n");

                if (g_amt_fd_usb >= 0)
                {
                    close(g_amt_fd_usb);
                    clr_fd(g_amt_fd_usb);
                    g_amt_fd_usb = -1;
                }
            }

            if (strstr(receive_buffer, AMT_DETECT_USB_ONLINE))
            {
                AmtPrintf(AMT_INFO "USB online!\n");

                if (g_amt_fd_usb >= 0)
                {
                    AmtPrintf(AMT_INFO "amt already open usb,do nothing\n");
                    //close(g_amt_fd_usb);
                    //clr_fd(g_amt_fd_usb);
                    //g_amt_fd_usb = -1;
                }
                else
                {
	                g_amt_fd_usb = init_usb_device();
	                if (g_amt_fd_usb >= 0)
	                {
	                    AmtPrintf(AMT_INFO "g_amt_fd_usb = %d.\n", g_amt_fd_usb);
	                    set_fd(g_amt_fd_usb);
	                }
                }
            }
        }

        if (g_amt_fd_socket_server >= 0 && FD_ISSET(g_amt_fd_socket_server, &tmpfds))
        {
            struct sockaddr_in cliaddr;
            int addrlen = sizeof(cliaddr);

            if (g_amt_fd_socket_client >= 0)
            {
                close(g_amt_fd_socket_client);
                clr_fd(g_amt_fd_socket_client);
                g_amt_fd_socket_client = -1;
            }

            if ((g_amt_fd_socket_client = accept(g_amt_fd_socket_server, (struct sockaddr*)&cliaddr, (socklen_t *)&addrlen)) == -1)
            {
                AmtPrintf(AMT_ERROR "Accept failed!\n");
            }
            else
            {
                unsigned long ip = ntohl(cliaddr.sin_addr.s_addr);
                AmtPrintf(AMT_INFO "Connect from %lu.%lu.%lu.%lu\n", (ip>>24)&0xff, (ip>>16)&0xff, (ip>>8)&0xff, (ip>>0)&0xff);
                set_fd(g_amt_fd_socket_client);
            }
        }

        if (g_amt_fd_usb >= 0 && FD_ISSET(g_amt_fd_usb, &tmpfds))
        {
            g_amt_fd_current = &g_amt_fd_usb;
        }
        else if (g_amt_fd_socket_client >= 0 && FD_ISSET(g_amt_fd_socket_client, &tmpfds))
        {
            g_amt_fd_current = &g_amt_fd_socket_client;
        }
        else
        {
            continue;
        }

		//¶ÁNVÅжÏÊÇ·ñÊǽâÎöATÃüÁʽ
		if(g_amt_at_mode == 1)
		{
		   //½âÎö²¢´¦ÀíATÃüÁî
		   At_ReceiveData(*g_amt_fd_current, receive_buffer, MAX_PACKET_LENGTH);
		   continue;
		}

        read_len = Amt_ReceiveData(*g_amt_fd_current, (unsigned char *)receive_buffer, MAX_PACKET_LENGTH);

        if (read_len > 0)
        {
            Amt_ComposeAndProcess((unsigned char *)receive_buffer, read_len);
        }
        else if (read_len == 0)
        {
            AmtPrintf(AMT_ERROR "%s: read_len = 0, close fd(%d)\n", __FUNCTION__, *g_amt_fd_current);
            close(*g_amt_fd_current);
            clr_fd(*g_amt_fd_current);
            *g_amt_fd_current = -1;
            g_amt_fd_current = NULL;
        }


        //struct timespec ts;
		//clock_gettime(CLOCK_MONOTONIC, &ts);
		//AmtPrintf(AMT_INFO "[%8d.%03d] %s: cpnv_FsGcWait start.\n", ts.tv_sec, ts.tv_nsec / 1000000,__FUNCTION__);
        //unsigned int status = cpnv_FsGcWait(FS_NVROFS);
		//if(status != CPNV_OK)
		//	AmtPrintf(AMT_INFO "%s: cpnv_FsGcWait fail, err = %d.\n", __FUNCTION__, status);
        //else
        //{
		//	clock_gettime(CLOCK_MONOTONIC, &ts);
		//	AmtPrintf(AMT_INFO "[%8d.%03d] %s: cpnv_FsGcWait ok.\n", ts.tv_sec, ts.tv_nsec / 1000000, __FUNCTION__);
		//}
		
    }

    free(receive_buffer);
    pthread_join(cp_read_thread, NULL);
#if 1
    cpnv_FsGcWait(FS_NVROFS);
	AmtPrintf(AMT_INFO "%s: cpnv_FsGcWait return.\n", __FUNCTION__);

	ret = cpnv_ChangeFsPartitionAttr(FS_NVROFS, 0);
	if(ret != CPNV_OK)
	{
		AmtPrintf(AMT_ERROR "%s: cpnv_ChangeFsPartitionAttr RO nvrofs failed!\n", __FUNCTION__);
		return -1;
	}
#endif
    close(g_amt_fd_cp);

    if (g_amt_fd_usb >= 0)
    {
        close(g_amt_fd_usb);
    }

    //if (g_amt_fd_usb_hotplug >= 0)
    {
        close(g_amt_fd_usb_hotplug);
    }

    if (g_amt_fd_socket_client >= 0)
    {
        close(g_amt_fd_socket_client);
    }

    if (g_amt_fd_socket_server >= 0)
    {
        close(g_amt_fd_socket_server);
    }

	#ifdef USE_CAP_SUPPORT
	close(g_amt_fd_cap);
	#endif

    AmtPrintf(AMT_INFO "AMT exit!\n");
    return 0;
}