X-Git-Url: https://git.rohieb.name/openwrt.git/blobdiff_plain/8103e50607015a0bc0a927b723c96a36a0c60f39..f4b339ecbe74ada12f4376f5fefcff16b21dce5f:/package/openwrt/wlcompat.c?ds=sidebyside diff --git a/package/openwrt/wlcompat.c b/package/openwrt/wlcompat.c index eb85a9e68..74dcdf223 100644 --- a/package/openwrt/wlcompat.c +++ b/package/openwrt/wlcompat.c @@ -1,5 +1,26 @@ -// insert header here -// mbm. gpl. +/* + * wlcompat.c + * + * Copyright (C) 2005 Mike Baker, + * Felix Fietkau + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License + * as published by the Free Software Foundation; either version 2 + * of the License, or (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. + * + * $Id$ + */ + #include #include @@ -11,8 +32,6 @@ #include #include -#define DEBUG - static struct net_device *dev; char buf[WLC_IOCTL_MAXLEN]; @@ -23,6 +42,11 @@ const long channel_frequency[] = { }; #define NUM_CHANNELS ( sizeof(channel_frequency) / sizeof(channel_frequency[0]) ) +static int wlcompat_private_ioctl(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, + char *extra); + static int wl_ioctl(struct net_device *dev, int cmd, void *buf, int len) { mm_segment_t old_fs = get_fs(); @@ -40,6 +64,43 @@ static int wl_ioctl(struct net_device *dev, int cmd, void *buf, int len) return ret; } +static int wl_set_val(struct net_device *dev, char *var, void *val, int len) +{ + char buf[128]; + int buf_len; + + /* check for overflow */ + if ((buf_len = strlen(var)) + 1 + len > sizeof(buf)) + return -1; + + strcpy(buf, var); + buf_len += 1; + + /* append int value onto the end of the name string */ + memcpy(&buf[buf_len], val, len); + buf_len += len; + + return wl_ioctl(dev, WLC_SET_VAR, buf, buf_len); +} + +static int wl_get_val(struct net_device *dev, char *var, void *val, int len) +{ + char buf[128]; + int ret; + + /* check for overflow */ + if (strlen(var) + 1 > sizeof(buf) || len > sizeof(buf)) + return -1; + + strcpy(buf, var); + if ((ret = wl_ioctl(dev, WLC_GET_VAR, buf, sizeof(buf)))) + return ret; + + memcpy(val, buf, len); + return 0; +} + + static int wlcompat_ioctl_getiwrange(struct net_device *dev, char *extra) { @@ -137,7 +198,7 @@ static int wlcompat_get_scan(struct net_device *dev, char *current_val; char *end_buf = extra + IW_SCAN_MAX_DATA; struct iw_event iwe; - int i; + int i, j; if (wl_ioctl(dev, WLC_SCAN_RESULTS, buf, WLC_IOCTL_MAXLEN) < 0) return -EAGAIN; @@ -178,8 +239,8 @@ static int wlcompat_get_scan(struct net_device *dev, current_val = current_ev + IW_EV_LCP_LEN; iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0; - for(i = 0 ; i < bss_info->rateset.count ; i++) { - iwe.u.bitrate.value = ((bss_info->rateset.rates[i] & 0x7f) * 500000); + for(j = 0 ; j < bss_info->rateset.count ; j++) { + iwe.u.bitrate.value = ((bss_info->rateset.rates[j] & 0x7f) * 500000); current_val = iwe_stream_add_value(current_ev, current_val, end_buf, &iwe, IW_EV_PARAM_LEN); } if((current_val - current_ev) > IW_EV_LCP_LEN) @@ -241,6 +302,16 @@ static int wlcompat_ioctl(struct net_device *dev, } break; } + case SIOCSIWAP: + { + if (wrqu->ap_addr.sa_family != ARPHRD_ETHER) + return -EINVAL; + + if (wl_ioctl(dev,WLC_SET_BSSID,wrqu->ap_addr.sa_data,6) < 0) + return -EINVAL; + + break; + } case SIOCGIWAP: { wrqu->ap_addr.sa_family = ARPHRD_ETHER; @@ -298,9 +369,11 @@ static int wlcompat_ioctl(struct net_device *dev, } case SIOCGIWTXPOW: { - wrqu->txpower.value = 0; - if (wl_ioctl(dev,WLC_GET_TXPWR, &(wrqu->txpower.value), sizeof(int)) < 0) + if (wl_get_val(dev, "qtxpower", &(wrqu->txpower.value), sizeof(int)) < 0) return -EINVAL; + + wrqu->txpower.value &= ~WL_TXPWR_OVERRIDE; + wrqu->txpower.fixed = 0; wrqu->txpower.disabled = 0; wrqu->txpower.flags = IW_TXPOW_MWATT; @@ -308,15 +381,33 @@ static int wlcompat_ioctl(struct net_device *dev, } case SIOCSIWTXPOW: { + int override; + + if (wl_get_val(dev, "qtxpower", &override, sizeof(int)) < 0) + return -EINVAL; + + wrqu->txpower.value |= override & WL_TXPWR_OVERRIDE; + if (wrqu->txpower.flags != IW_TXPOW_MWATT) return -EINVAL; - if (wl_ioctl(dev, WLC_SET_TXPWR, &wrqu->txpower.value, sizeof(int)) < 0) + if (wl_set_val(dev, "qtxpower", &wrqu->txpower.value, sizeof(int)) < 0) return -EINVAL; } case SIOCGIWENCODE: { - wrqu->data.flags = IW_ENCODE_DISABLED; + int val = 0; + if (wl_ioctl(dev, WLC_GET_WEP, &val, sizeof(val)) < 0) + return -EINVAL; + + if (val > 0) { + wrqu->data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY; + } else { + wrqu->data.flags = IW_ENCODE_DISABLED; + } + + + break; } case SIOCGIWRANGE: @@ -401,6 +492,9 @@ static int wlcompat_ioctl(struct net_device *dev, } default: { + if (info->cmd >= SIOCIWFIRSTPRIV) + return wlcompat_private_ioctl(dev, info, wrqu, extra); + return -EINVAL; } } @@ -429,7 +523,7 @@ static const iw_handler wlcompat_handler[] = { iw_handler_get_spy, /* SIOCGIWSPY */ iw_handler_set_thrspy, /* SIOCSIWTHRSPY */ iw_handler_get_thrspy, /* SIOCGIWTHRSPY */ - NULL, /* SIOCSIWAP */ + wlcompat_ioctl, /* SIOCSIWAP */ wlcompat_ioctl, /* SIOCGIWAP */ NULL, /* -- hole -- */ NULL, /* SIOCGIWAPLIST */ @@ -455,31 +549,145 @@ static const iw_handler wlcompat_handler[] = { wlcompat_ioctl, /* SIOCGIWENCODE */ }; +#define PRIV_SET_MONITOR SIOCIWFIRSTPRIV + 0 +#define PRIV_GET_MONITOR SIOCIWFIRSTPRIV + 1 +#define PRIV_SET_TXPWR_LIMIT SIOCIWFIRSTPRIV + 2 +#define PRIV_GET_TXPWR_LIMIT SIOCIWFIRSTPRIV + 3 + +static const struct iw_priv_args wlcompat_private_args[] = +{ + { PRIV_SET_MONITOR, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, + 0, + "set_monitor" + }, + { PRIV_GET_MONITOR, + 0, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, + "get_monitor" + }, + { PRIV_SET_TXPWR_LIMIT, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, + 0, + "set_txpwr_force" + }, + { PRIV_GET_TXPWR_LIMIT, + 0, + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, + "get_txpwr_force" + } +}; + +static int wlcompat_private_ioctl(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, + char *extra) +{ + int *value = (int *) wrqu->name; + + switch (info->cmd) { + case PRIV_SET_MONITOR: + { + if (wl_ioctl(dev, WLC_SET_MONITOR, value, sizeof(int)) < 0) + return -EINVAL; + + break; + } + case PRIV_GET_MONITOR: + { + if (wl_ioctl(dev, WLC_GET_MONITOR, extra, sizeof(int)) < 0) + return -EINVAL; + + break; + } + case PRIV_SET_TXPWR_LIMIT: + { + int val; + + + if (wl_get_val(dev, "qtxpower", &val, sizeof(int)) < 0) + return -EINVAL; + + if (*extra > 0) + val |= WL_TXPWR_OVERRIDE; + else + val &= ~WL_TXPWR_OVERRIDE; + + if (wl_set_val(dev, "qtxpower", &val, sizeof(int)) < 0) + return -EINVAL; + + break; + } + case PRIV_GET_TXPWR_LIMIT: + { + if (wl_get_val(dev, "qtxpower", value, sizeof(int)) < 0) + return -EINVAL; + + *value = ((*value & WL_TXPWR_OVERRIDE) == WL_TXPWR_OVERRIDE ? 1 : 0); + + break; + } + default: + { + return -EINVAL; + } + + } + return 0; +} + + +static const iw_handler wlcompat_private[] = +{ + wlcompat_private_ioctl, + wlcompat_private_ioctl, + wlcompat_private_ioctl, + wlcompat_private_ioctl +}; + + static const struct iw_handler_def wlcompat_handler_def = { .standard = (iw_handler *) wlcompat_handler, .num_standard = sizeof(wlcompat_handler)/sizeof(iw_handler), - .private = NULL, - .num_private = 0, - .private_args = NULL, - .num_private_args = 0, + .private = wlcompat_private, + .num_private = sizeof(wlcompat_private)/sizeof(iw_handler), + .private_args = wlcompat_private_args, + .num_private_args = sizeof(wlcompat_private_args)/sizeof(struct iw_priv_args), }; + #ifdef DEBUG static int (*old_ioctl)(struct net_device *dev, struct ifreq *ifr, int cmd); +void print_buffer(int len, unsigned char *buf) { + int x; + if (buf != NULL) { + for (x=0;xname,cmd); if (cmd==SIOCDEVPRIVATE) { - int x; wl_ioctl_t *ioc = (wl_ioctl_t *)ifr->ifr_data; unsigned char *buf = ioc->buf; printk(" cmd: %d buf: 0x%08x len: %d\n",ioc->cmd,&(ioc->buf),ioc->len); - printk(" ->"); - for (x=0;xlen && x<128 ;x++) { - printk("%02X",buf[x]); - } - printk("\n"); + printk(" send: ->"); + print_buffer(ioc->len, buf); + ret = old_ioctl(dev,ifr,cmd); + printk(" recv: ->"); + print_buffer(ioc->len, buf); + printk(" ret: %d\n", ret); + } else { + ret = old_ioctl(dev,ifr,cmd); } return ret; } @@ -487,7 +695,23 @@ static int new_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) { static int __init wlcompat_init() { - dev = dev_get_by_name("eth1"); + int found = 0, i; + char *devname = "eth0"; + + while (!found && devname[3] < '3') { + devname[3]++; + + dev = dev_get_by_name(devname); + if ((wl_ioctl(dev, WLC_GET_MAGIC, &i, sizeof(i)) == 0) && i == WLC_IOCTL_MAGIC) + found = 1; + } + + if (!found) { + printk("No Broadcom devices found.\n"); + return -ENODEV; + } + + #ifdef DEBUG old_ioctl = dev->do_ioctl; dev->do_ioctl = new_ioctl;