//=============================================================================
// Copyright (c) 2006 Realtek Semiconductor Corporation.	All Rights Reserved.
//
//	Title:
//		UDPserver.c
//	Desc:
//		UDP server : accepts MP commands from the client
//=============================================================================

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/socket.h>
#include <netinet/in.h>
#include <arpa/inet.h>
#include <sys/ioctl.h>
#include <linux/if.h>
#include <linux/wireless.h>
#include <fcntl.h>
#include <unistd.h>
#include "rtk_arch.h"

#ifndef WIN32
#define __PACK__			__attribute__ ((packed))
#else
#define __PACK__
#endif

#define	TP_MAX_STR_LEN	500
#define MYPORT 9034                    // the port users will be connecting to
#define BUFLEN 1024                      // length of the buffer
#define MP_TX_PACKET 0x8B71
#define MP_BRX_PACKET 0x8B73
#define MP_QUERY_STATS 	0x8B6D
#define RTL8190_IOCTL_WRITE_REG				0x89f3
#define RTL8190_IOCTL_READ_REG				0x89f4
#define MP_CONTIOUS_TX	0x8B66
#define MP_TXPWR_TRACK	0x8B6E
#define MP_QUERY_TSSI	0x8B6F
#define MP_QUERY_THER 0x8B77

#define FLASH_DEVICE_NAME		("/dev/mtd")
#define FLASH_DEVICE_NAME1		("/dev/mtdblock1")
#define HW_SETTING_HEADER_TAG		((char *)"hs")
#define HW_SETTING_OFFSET		0x6000
#define DEFAULT_SETTING_OFFSET		0x8000
#define CURRENT_SETTING_OFFSET		0xc000

#if 1
#define TAG_LEN					2
#define SIGNATURE_LEN			4
#define HW_SETTING_VER			3	// hw setting version
/* Config file header */
typedef struct param_header {
	unsigned char signature[SIGNATURE_LEN];  // Tag + version
	unsigned short len __PACK__;
} __PACK__ PARAM_HEADER_T, *PARAM_HEADER_Tp;
PARAM_HEADER_T hsHeader;
#endif
#if 0
/* Do checksum and verification for configuration data */
#ifndef WIN32
static inline unsigned char CHECKSUM(unsigned char *data, int len)
#else
__inline unsigned char CHECKSUM(unsigned char *data, int len)
#endif
{
	int i;
	unsigned char sum=0;

	for (i=0; i<len; i++)
		sum += data[i];

	sum = ~sum + 1;
	return sum;
}
#ifndef WIN32
static inline int CHECKSUM_OK(unsigned char *data, int len)
#else
__inline int CHECKSUM_OK(unsigned char *data, int len)
#endif
{
	int i;
	unsigned char sum=0;

	for (i=0; i<len; i++)
		sum += data[i];

	if (sum == 0)
		return 1;
	else
		return 0;
}
/////////////////////////////////////////////////////////////////////////////////
static int flash_read(char *buf, int offset, int len)
{
	int fh;
	int ok=1;

	fh = open(FLASH_DEVICE_NAME, O_RDWR);
	if ( fh == -1 )
		return 0;

	lseek(fh, offset, SEEK_SET);

	if ( read(fh, buf, len) != len)
		ok = 0;

	close(fh);

	return ok;
}


////////////////////////////////////////////////////////////////////////////////
static int flash_write(char *buf, int offset, int len)
{
	int fh;
	int ok=1;

	fh = open(FLASH_DEVICE_NAME, O_RDWR);

	if ( fh == -1 )
		return 0;

	lseek(fh, offset, SEEK_SET);

	if ( write(fh, buf, len) != len)
		ok = 0;

	close(fh);
	sync();

	return ok;
}

int ReadSinguture(void)
{
	int ver;
	char *buff;
	// Read hw setting
	if ( flash_read((char *)&hsHeader, HW_SETTING_OFFSET, sizeof(hsHeader))==0 ) {
		printf("Read hw setting header failed!\n");
		return NULL;
	}

	if ( sscanf(&hsHeader.signature[TAG_LEN], "%02d", &ver) != 1)
		ver = -1;

	if ( memcmp(hsHeader.signature, HW_SETTING_HEADER_TAG, TAG_LEN) || // invalid signatur
		(ver != HW_SETTING_VER)  ) { // length is less than current
		printf("Invalid hw setting signature or version number [sig=%c%c, ver=%d, len=%d]!\n", hsHeader.signature[0],
			hsHeader.signature[1], ver, hsHeader.len);
		return NULL;
	}
	//printf("hw setting signature or version number [sig=%c%c, ver=%d, len=%d]!\n", hsHeader.signature[0],	hsHeader.signature[1], ver, hsHeader.len);
	buff = calloc(1, hsHeader.len);
	if ( buff == 0 ) {
		printf("Allocate buffer failed!\n");
		return NULL;
	}
	if ( flash_read(buff, HW_SETTING_OFFSET+sizeof(hsHeader), hsHeader.len)==0 ) {
		printf("Read hw setting failed!\n");
		free(buff);
		return NULL;
	}
	if ( !CHECKSUM_OK(buff, hsHeader.len) ) {
		printf("Invalid checksum of hw setting!\n");
		free(buff);
		return NULL;
	}
	//printf("CS=%x\n",buff[hsHeader.len-1]);
}
#endif
/*
 * Wrapper to extract some Wireless Parameter out of the driver
 */
static inline int iw_get_ext(int skfd,    /* Socket to the kernel */
           			char *ifname,        	/* Device name */
           			int request,        		/* WE ID */
           			struct iwreq *pwrq)    /* Fixed part of the request */
{
  	strncpy(pwrq->ifr_name, ifname, IFNAMSIZ);	/* Set device name */
  	return(ioctl(skfd, request, pwrq));			/* Do the request */
}

static char *get_str_token(char *data, char *token, char split)
{
        char *ptr=data;
        int len=0, idx=0;

        while (*ptr && *ptr != '\n' ) {
                if (*ptr == split) {
                        if (len <= 1)
                           return NULL;
                        memcpy(token, data, len);
                        /* delete ending space */
                        for (idx=len-1; idx>=0; idx--) {
                                if (token[idx] !=  ' ')
                                        break;
                        }
                        token[idx+1] = '\0';

                        return ptr+1;
                }
                len++;
                ptr++;
        }
        return NULL;
}

static int get_str_value(char *data, char *value)
{
        char *ptr=data;
        int len=0, idx, i;

        while (*ptr && *ptr != '\n' && *ptr != '\r') {
                len++;
                ptr++;
        }

        /* delete leading space */
        idx = 0;
        while (len-idx > 0) {
                if (data[idx] != ' ')
                        break;
                idx++;
        }
        len -= idx;

        /* delete bracing '"' */
        if (data[idx] == '"') {
                for (i=idx+len-1; i>idx; i--) {
                        if (data[i] == '"') {
                                idx++;
                                len = i - idx;
                        }
                        break;
                }
        }

        if (len > 0) {
                memcpy(value, &data[idx], len);
                value[len] = '\0';
        }
        return len;
}

char* deblank(char* input)
{
    char *output = input;
    int i, j;

    for (i=0, j=0; i < strlen(input); i++, j++)
    {
        if (input[i] != ' ')
            output[j] = input[i];
        else
            j--;
    }

    output[j]='\0';

    return output;
}

int MP_get_ext(char *ifname, char *buf, unsigned int ext_num)
{
    	int skfd;
    	struct iwreq wrq;

    	skfd = socket(AF_INET, SOCK_DGRAM, 0);
    	wrq.u.data.pointer = (caddr_t)buf;
    	wrq.u.data.length = strlen(buf);

    	if (iw_get_ext(skfd, ifname, ext_num, &wrq) < 0) {
    		printf("MP_get_ext failed\n");
		return -1;
    	}
	
    	close(skfd);
    	return 0;
}

enum content_type {
	  EFUSE_TYPE,
	  FLASH_TYPE,
	  MIB_TYPE,
	  NONE_TYPE
}; 

typedef struct map_def_s
{
    char name[30];
    char map_name[30];
    char type;
} map_def_t;

static const map_def_t cmd_mib_defs[] =
{
      {"11N_XCAP", "xcap", MIB_TYPE},
      {"11N_THER", "ther", MIB_TYPE},
      {"TX_POWER_CCK_A", "pwrlevelCCK_A",MIB_TYPE},
      {"TX_POWER_CCK_B", "pwrlevelCCK_B", MIB_TYPE},
      {"TX_POWER_HT40_1S_A", "pwrlevelHT40_1S_A", MIB_TYPE},
      {"TX_POWER_HT40_1S_B", "pwrlevelHT40_1S_B", MIB_TYPE},
      {"TX_POWER_DIFF_HT40_2S", "pwrdiffHT40_2S", MIB_TYPE},
      {"TX_POWER_DIFF_HT20", "pwrdiffHT20", MIB_TYPE},
      {"TX_POWER_DIFF_OFDM", "pwrdiffOFDM", MIB_TYPE},
      {"WLAN_ADDR", "hwaddr", MIB_TYPE},
      {"NIC1_ADDR", "hwaddr", MIB_TYPE},
      {"11N_TRSWPAE_C9", "trswitch", MIB_TYPE},
      {"11N_TRSWPAE_CC", "trswitch", MIB_TYPE},
      {"REG_DOMAIN", "dot11RegDomain", MIB_TYPE},
};

static const map_def_t cmd_efuse_defs[] =
{
      {"11N_XCAP", "HW_11N_XCAP", EFUSE_TYPE},
      {"11N_THER", "HW_11N_THER", EFUSE_TYPE},
      {"TX_POWER_CCK_A", "HW_TX_POWER_CCK_A", EFUSE_TYPE},
      {"TX_POWER_CCK_B", "HW_TX_POWER_CCK_B", EFUSE_TYPE},
      {"TX_POWER_HT40_1S_A", "HW_TX_POWER_HT40_1S_A", EFUSE_TYPE},
      {"TX_POWER_HT40_1S_B", "HW_TX_POWER_HT40_1S_B", EFUSE_TYPE},
      {"TX_POWER_DIFF_HT40_2S", "pwrdiffHT40_2S", EFUSE_TYPE},
      {"TX_POWER_DIFF_HT20", "HW_TX_POWER_DIFF_HT20_A", EFUSE_TYPE},
      {"TX_POWER_DIFF_OFDM", "HW_TX_POWER_DIFF_HT20_OFDM_A", EFUSE_TYPE},
      {"WLAN_ADDR", "hwaddr", FLASH_TYPE},
      {"NIC1_ADDR", "hwaddr", FLASH_TYPE},
      {"11N_TRSWPAE_C9", "trswitch", FLASH_TYPE},
      {"11N_TRSWPAE_CC", "trswitch", FLASH_TYPE},
      {"REG_DOMAIN", "dot11RegDomain", FLASH_TYPE},
};

static void get_drv_mib_content(char *path, char *mib, char *mib_value)
{
        FILE *fp;
        char line[400], token[40], value[300], *ptr;

        fp = fopen(path, "r");
        if (fp == NULL) {
                printf("read config file [%s] failed!\n", path);
                return;
        }

        while ( fgets(line, 200, fp) ) {
                ptr = get_str_token(line, token, ':');
                if (ptr == NULL)
                    continue;

                if (get_str_value(ptr, value) == 0) {
                    continue;
                } else {
                    deblank(token);

                    if ( strcmp(mib, token) == 0 )
                    {
                         printf("tok:[%s] mib:[%s] val:[%s]\n", token, mib, value);
                         strcpy(mib_value, value);
                         goto out;
                    }
               }
       }
out:
        fclose(fp);
}

static int convert_str_map(char *str, char *id, map_def_t cmd_map_ptr[], int sz)
{
        int i; //, sz = sizeof(cmd_map_ptr) / sizeof(struct map_def_s);
                        
        for (i = 0; i < sz; i++) {
             if( strstr(str, cmd_map_ptr[i].name) != NULL ) {
        	        // printf("convert [%s] to [%s]\n", str, cmd_map_ptr[i].name);
                  strcpy(id, cmd_map_ptr[i].map_name);
                  return cmd_map_ptr[i].type;
             }
        }

        strcpy(id, "unsupported");
        return NONE_TYPE;
}

static void read_mib_content_from_drv(char *str, char *mib_value)
{
        char file_name[40];
        char full_path[100];
        char mib[64];

        char wlan_idx=0;

        sscanf(str, "HW_WLAN%d", &wlan_idx);

        printf("get wlan idx:%d str:%s\n", wlan_idx, str);

        sprintf(full_path, "%s%d/%s", "/proc/wlan", wlan_idx, "mib_all");

        convert_str_map( str, mib, cmd_mib_defs, sizeof(cmd_mib_defs) / sizeof(struct map_def_s));

        get_drv_mib_content(full_path, mib, mib_value);
}

static void write_mib_content_to_drv(char *str, char *run_cmd)
{
       char efuse[64];
       char token[40], value[300], *ptr;                	
       char wlan_idx=0;
       char type;

       sscanf(str, "HW_WLAN%d", &wlan_idx);

       // printf("get wlan idx:%d str:%s\n", wlan_idx, str);

       ptr = get_str_token(str, token, ' ');
       if (ptr == NULL)
            return;

       if (get_str_value(ptr, value) == 0) 
            return;
              
       type = convert_str_map( (token + strlen("HW_WLAN0_")), efuse, cmd_efuse_defs, sizeof(cmd_efuse_defs) / sizeof(struct map_def_s));

       deblank(value);
       
       // printf("get flash:[%s] val:[%s] mib:[%s]\n", token, value, efuse);

       if (FLASH_TYPE == type) {
             sprintf(run_cmd, "echo flash wlan%d write %s=%s", wlan_idx, efuse, value);
       } else if (EFUSE_TYPE == type) {
             sprintf(run_cmd, "echo iwpriv wlan%d efuse_set %s=%s", wlan_idx, efuse, value);
       }
              
       return;	   
       // get_drv_mib_content(full_path, mib, mib_value);
}

int main(void) {
	int sockfd;                     				// socket descriptors
	struct sockaddr_in my_addr;     		// my address information
	struct sockaddr_in their_addr;  			// connectorˇ¦s address information
	socklen_t addr_len;
	int numbytes;
	FILE *fp;
	char buf[BUFLEN], buf_tmp[BUFLEN],*pbuf,
	pre_result[BUFLEN];				// buffer that stores message
	static char cmdWrap[TP_MAX_STR_LEN];
	static int rwHW=0;
	static int is_run=1;

	// create a socket
	if ((sockfd = socket(AF_INET, SOCK_DGRAM, 0)) == -1) {
		perror("socket");
		exit(1);
	}

	my_addr.sin_family = AF_INET;         		// host byte order
	my_addr.sin_port = htons(MYPORT);     	// short, network byte order
	my_addr.sin_addr.s_addr = INADDR_ANY; 	// automatically fill with my IP
	memset(&(my_addr.sin_zero), '\0', 8); 	// zero the rest of the struct

	// bind the socket with the address
	if (bind(sockfd, (struct sockaddr *)&my_addr,
		sizeof(struct sockaddr)) == -1) {
		perror("bind");
		close(sockfd);
		exit(1);
	}

	addr_len = sizeof(struct sockaddr);

	printf("MP AUTOMATION daemon (ver 1.2)\n");
	//Self reading flash!!!
	#if 	0
	if(!ReadSinguture())
	{
		printf("HW Settting Error!!\n");
	}
	#endif	
	// main loop : wait for the client
	while (1) {
		//receive the command from the client
		memset(buf, 0, BUFLEN);
		memset(cmdWrap, 0, TP_MAX_STR_LEN);
		rwHW = 0;
		is_run = 1;
		
		if ((numbytes = recvfrom(sockfd, buf, BUFLEN, 0,
			(struct sockaddr *)&their_addr, &addr_len)) == -1) {
			fprintf(stderr,"Receive failed!!!\n");
			close(sockfd);
			exit(1);
		}
		
		printf("received command 1 (%s) from IP:%s\n", buf, inet_ntoa(their_addr.sin_addr));

		if(!memcmp(buf, "orf", 3)){
                        strncat(buf, " > " WIFI_MP_TMP_FILE,BUFLEN);
                        system(buf);
		}
		if(!memcmp(buf, "irf", 3)){
                        strncat(buf, " > " WIFI_MP_TMP_FILE,BUFLEN);
                        system(buf);
		}	
		if (!memcmp(buf, "ther", 4)) {
                        strcpy(buf, pre_result);
		}
		if (!memcmp(buf, "tssi", 4)) {
			strcpy(buf, pre_result);
		}
		if (!memcmp(buf, "query", 5)) {

			strcpy(buf, pre_result);
		}
		if(!memcmp(buf, "cat", 3)){
			
			if(NULL != (pbuf=strstr(buf, ".//proc//")))
			{
				pbuf[0]=' ';
			}

			strncat(buf, " > " WIFI_MP_TMP_FILE,BUFLEN);
			system(buf);		
		}
	#if 1	//wlan0
		if (!memcmp(buf, "iwpriv wlan0 mp_tssi", 20)) {
			strcpy(buf, pre_result);
			MP_get_ext("wlan0", buf_tmp, MP_QUERY_TSSI);
			strcpy(buf, buf_tmp);
			printf("buf= %s\n",buf);
			usleep(1000);
		}
		else if (!memcmp(buf, "iwpriv wlan0 mp_ther", 20)) {
			strcpy(buf, pre_result);
			MP_get_ext("wlan0", buf_tmp, MP_QUERY_THER);
			strcpy(buf, buf_tmp);
			printf("buf= %s\n",buf);
			usleep(1000);
		}
		else if (!memcmp(buf, "iwpriv wlan0 mp_query", 21)) {
			strcpy(buf, pre_result);
			MP_get_ext("wlan0", buf_tmp, MP_QUERY_STATS);
			strcpy(buf, buf_tmp);
			usleep(1000);
			printf("w0 2b= %s\n",buf);
		}
	#endif
	#if 1	//wlan1 
		else if (!memcmp(buf, "iwpriv wlan1 mp_tssi", 20)) {
			strcpy(buf, pre_result);
			MP_get_ext("wlan1", buf_tmp, MP_QUERY_TSSI);
			strcpy(buf, buf_tmp);
			printf("buf= %s\n",buf);
			usleep(1000);
		}
		else if (!memcmp(buf, "iwpriv wlan1 mp_ther", 20)) {
			strcpy(buf, pre_result);
			MP_get_ext("wlan1", buf_tmp, MP_QUERY_THER);
			strcpy(buf, buf_tmp);
			printf("buf= %s\n",buf);
			usleep(1000);
		}
		else if (!memcmp(buf, "iwpriv wlan1 mp_query", 21)) {
			strcpy(buf, pre_result);
			MP_get_ext("wlan1", buf_tmp, MP_QUERY_STATS);
			strcpy(buf, buf_tmp);
			usleep(1000);
			printf("w1 2b= %s\n",buf);
		}
	#endif	
		else 
		{
			if ( (!memcmp(buf, "flash read", 10)) ) {
				is_run = 0;
				if ((fp = fopen(WIFI_MP_TMP_FILE, "r")) == NULL)
					fprintf(stderr, "opening " WIFI_MP_TMP_FILE " failed !\n");
	
				if (fp) {
					fgets(buf, BUFLEN, fp);
					buf[BUFLEN-1] = '\0';
					fclose(fp);
				}	
				snprintf(pre_result,BUFLEN, "data:%s", buf);
			}
			//ack to the client
			else if (!memcmp(buf, "flash get", 9))
				snprintf(pre_result,BUFLEN, "%s > " WIFI_MP_TMP_FILE " ok", buf);
			else {
				snprintf(pre_result,BUFLEN, "%s ok", buf);
			}
			
			if (!memcmp(buf, "iwpriv wlan0 mp_brx stop", 24)) {
				strcpy(buf, "stop");
				MP_get_ext("wlan0", buf, MP_BRX_PACKET);
			}
			else if (!memcmp(buf, "iwpriv wlan0 mp_tx", 18) && buf[18] == ' ') {
				memcpy(buf_tmp, buf+19, strlen(buf)-19);
				MP_get_ext("wlan0", buf_tmp, MP_TX_PACKET);
				strcpy(buf, buf_tmp);
			}
			else if (!memcmp(buf, "iwpriv wlan0 mp_ctx", 19) && buf[19] == ' ') {
				memcpy(buf_tmp, buf+20, strlen(buf)-20);
				MP_get_ext("wlan0", buf_tmp, MP_CONTIOUS_TX);
				strcpy(buf, buf_tmp);;
			}
			else if(!memcmp(buf, "iwpriv wlan0 read_reg", 21)){
				strncat(buf, " > " WIFI_MP_TMP_FILE, BUFLEN);
				system(buf);
			}
			else if(!memcmp(buf, "iwpriv wlan0 read_rf", 20)){
				strncat(buf, " > " WIFI_MP_TMP_FILE, BUFLEN);
				system(buf);
			}
			else if(!memcmp(buf, "iwpriv wlan0 mp_psd", 19)){
				strncat(buf, " > " WIFI_MP_TMP_FILE, BUFLEN);
				system(buf);
				system("cat /tmp/MP.txt");
			}
			else if(!memcmp(buf, "iwpriv wlan0 efuse_get", 22)){
				strncat(buf, " > " WIFI_MP_TMP_FILE, BUFLEN);
				system(buf);
			}
			else if(!memcmp(buf, "iwpriv wlan0 efuse_set", 22)){
				strncat(buf, " > " WIFI_MP_TMP_FILE, BUFLEN);
				system(buf);
			}
			else if(!memcmp(buf, "iwpriv wlan0 efuse_sync", 23)){
				strncat(buf, " > " WIFI_MP_TMP_FILE, BUFLEN);
				system(buf);
			}
			else if(!memcmp(buf, "iwpriv wlan0 get_mib use_efuse", 30)) {
				strncat(buf, " > " WIFI_MP_TMP_FILE, BUFLEN);
				system(buf);
			}
#if 1  //wlan 1
			else if (!memcmp(buf, "iwpriv wlan1 mp_brx stop", 24)) {
				strcpy(buf, "stop");
				MP_get_ext("wlan1", buf, MP_BRX_PACKET);
			}
			else if (!memcmp(buf, "iwpriv wlan1 mp_tx", 18) && buf[18] == ' ') {
				memcpy(buf_tmp, buf+19, strlen(buf)-19);
				MP_get_ext("wlan1", buf_tmp, MP_TX_PACKET);
				strcpy(buf, buf_tmp);
			}
			else if (!memcmp(buf, "iwpriv wlan1 mp_ctx", 19) && buf[19] == ' ') {
				memcpy(buf_tmp, buf+20, strlen(buf)-20);
				MP_get_ext("wlan1", buf_tmp, MP_CONTIOUS_TX);
				strcpy(buf, buf_tmp);;
			}
			else if(!memcmp(buf, "iwpriv wlan1 read_reg", 21)){
				strncat(buf, " > " WIFI_MP_TMP_FILE, BUFLEN);
				system(buf);
			}
			else if(!memcmp(buf, "iwpriv wlan1 read_rf", 20)){
				strncat(buf, " > " WIFI_MP_TMP_FILE, BUFLEN);
				system(buf);
			}
			else if(!memcmp(buf, "iwpriv wlan1 mp_psd", 19)){
				strncat(buf, " > " WIFI_MP_TMP_FILE, BUFLEN);
				system(buf);
				system("cat /tmp/MP.txt");
			}
			else if(!memcmp(buf, "iwpriv wlan1 efuse_get", 22)){
				strncat(buf, " > " WIFI_MP_TMP_FILE, BUFLEN);
				system(buf);
			}
			else if(!memcmp(buf, "iwpriv wlan1 efuse_set", 22)){
				strncat(buf, " > " WIFI_MP_TMP_FILE, BUFLEN);
				system(buf);
			}
			else if(!memcmp(buf, "iwpriv wlan1 efuse_sync", 23)){
				strncat(buf, " > " WIFI_MP_TMP_FILE, BUFLEN);
				system(buf);
			}
#endif            
			else if (!memcmp(buf, "probe", 5))
				strcpy(buf, "ack");
			else if (!memcmp(buf, "verify_flw", 10)) {
				if ((fp = fopen(WIFI_MP_TMP_FILE, "r")) == NULL)
					fprintf(stderr, "opening " WIFI_MP_TMP_FILE " failed !\n");
	
				if (fp) {
					fgets(buf, BUFLEN, fp);
					buf[BUFLEN-1] = '\0';
					fclose(fp);
				}
			}
			else 
			{

#if 0
				if (!memcmp(buf, "flash get", 9))
					strncat(buf, " > " WIFI_MP_TMP_FILE, BUFLEN);
#endif
				if (!memcmp(buf, "flash get", 9))
				{
					char mib_val[64];
          
					read_mib_content_from_drv(buf+10, mib_val);
					// sprintf(cmdWrap, "flash gethw %s", buf+10);
					snprintf(cmdWrap, TP_MAX_STR_LEN, "echo %s=%s", buf+10, mib_val); 
					rwHW = 1;
					////strcat(buf, " > " WIFI_MP_TMP_FILE);
					strncat(cmdWrap, " > " WIFI_MP_TMP_FILE, TP_MAX_STR_LEN);
				}

				if (!memcmp(buf, "flash set", 9)) 
				{
					// sprintf(cmdWrap, "flash sethw %s", buf+10);
					write_mib_content_to_drv(buf+10, cmdWrap);

					// sprintf(cmdWrap, "echo %s", buf+10); 
					
					rwHW = 1;
					//printf("1 sent command (%s) to IP:%s\n", pre_result, inet_ntoa(their_addr.sin_addr));
					if ((numbytes = sendto(sockfd, pre_result, strlen(pre_result), 0,
						(struct sockaddr *)&their_addr, sizeof(struct sockaddr))) == -1) {
						fprintf(stderr, "send failed\n");
						close(sockfd);
						exit(1);
					}
					//printf("2 sent command (%s) to IP:%s\n", pre_result, inet_ntoa(their_addr.sin_addr));
				}
				
				if(rwHW == 1)
				{
					//printf("UDP Server cmdWrap=%s\n",cmdWrap);
					system(cmdWrap);
				}
				else
				{
					// printf("UDP Server buf=%s\n",buf);
					if ( is_run )
					    system(buf);
				}
				
				//delay
				//open(/tmp/abc.txt)
			}
			
			strcpy(buf_tmp, pre_result);
			strcpy(pre_result, buf);
			strcpy(buf, buf_tmp);
			
			//printf("UDP Server buf=%s pre_result=%s\n",buf,pre_result);
		}

		if (memcmp(buf, "flash set", 9) != 0) {
			//printf("1 sent command (%s) to IP:%s\n", buf, inet_ntoa(their_addr.sin_addr));
			
			//printf("UDP Server_5 buf=%s\n",buf);
			
			if ((numbytes = sendto(sockfd, buf, strlen(buf), 0,
				(struct sockaddr *)&their_addr, sizeof(struct sockaddr))) == -1) {
				fprintf(stderr, "send failed\n");
				//printf("UDP Server_5_1\n");
				close(sockfd);
				exit(1);
			}
			//printf("UDP Server_6\n");
			//printf("2 sent command (%s) to IP:%s\n", buf, inet_ntoa(their_addr.sin_addr));
		}
		
		//printf("UDP Server_7\n");
	}

	return 0;
}