768 lines
21 KiB
C
Executable File
768 lines
21 KiB
C
Executable File
//=============================================================================
|
||
// 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<6F><72>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;
|
||
}
|