source: src/router/libutils/wl.c @ 10769

/*
 * Wireless network adapter utilities
 *
 * Copyright 2001-2003, Broadcom Corporation
 * All Rights Reserved.
 *
 * THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY
 * KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM
 * SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS
 * FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE.
 *
 * $Id: wl.c,v 1.3 2005/11/11 09:26:19 seg Exp $
 */
#include <string.h>
#include <unistd.h>

#include <typedefs.h>
#include <bcmutils.h>
#include <wlutils.h>
#include <shutils.h>
#include <utils.h>
#include <bcmnvram.h>

struct nvram_tuple router_defaults[] = {
    {0, 0, 0}
};

/*
 * DD-WRT addition (loaned from radauth) 
 */

#ifndef HAVE_MADWIFI

#ifdef HAVE_RT2880
char *getRADev(char *prefix)
{
char *ifname=NULL;
        if (!strcmp(prefix,"wl0"))ifname="ra0";
        if (!strcmp(prefix,"wl0.1"))ifname="ra1";
        if (!strcmp(prefix,"wl0.2"))ifname="ra2";
        if (!strcmp(prefix,"wl0.3"))ifname="ra3";
        if (!strcmp(prefix,"wl0.4"))ifname="ra4";
        if (!strcmp(prefix,"wl0.5"))ifname="ra5";
        if (!strcmp(prefix,"wl0.6"))ifname="ra6";
        if (!strcmp(prefix,"wl0.7"))ifname="ra7";
if (ifname)
    return ifname;
else 
    return prefix;
}

int getchannels( unsigned int *list, char *ifname )
{
list[0]=1;
list[1]=2;
list[2]=3;
list[3]=4;
list[4]=5;
list[5]=6;
list[6]=7;
list[7]=8;
list[8]=9;
list[9]=10;
list[10]=11;
list[11]=12;
list[12]=13;
return 13;
}

#include <sys/types.h>
#include <sys/file.h>
#include <sys/ioctl.h>
#include <sys/socket.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <stdint.h>
#include <ctype.h>
#include <getopt.h>
#include <err.h>
#include <linux/socket.h>
#include <linux/if.h>

#include "wireless.h"

int getsocket( void )
{
    static int s = -1;

    if( s < 0 )
    {
        s = socket( AF_INET, SOCK_DGRAM, 0 );
        if( s < 0 )
            err( 1, "socket(SOCK_DGRAM)" );
    }
    return s;
}


u_int ieee80211_mhz2ieee( u_int freq )
{
    if( freq == 2484)
        return 14;
    if( freq < 2484)
        return ( freq - ( 2407) ) / 5;
    if( freq < 4990 && freq > 4940 )
        return ( ( freq * 10 ) + ( ( ( freq % 5 ) == 2 ) ? 5 : 0 ) -
                 49400 ) / 5;
    if( freq < 5000 )
        return 15 + ( ( freq - ( 2512) ) / 20 );

    return ( freq - ( 5000 ) ) / 5;
}


unsigned int ieee80211_ieee2mhz(unsigned int chan)
{
                if (chan == 14)
                        return 2484;
                if (chan < 14)
                        return ((2407) + chan * 5);
                else {
                        if (chan > 236 && chan < 256) {
                                //recalculate offset
                                int newchan = chan - 256;
                                int newfreq = (2407) + (newchan * 5);
                                return newfreq;
                        } else
                                return ((2512) + ((chan - 15) * 20));
                }
}

int wifi_getchannel( char *ifname )
{
    struct iwreq wrq;
    float freq;
    int channel;

    strncpy( wrq.ifr_name, ifname, IFNAMSIZ );
    ioctl( getsocket(  ), SIOCGIWFREQ, &wrq );

    int i;

    freq = ( float )wrq.u.freq.m;
    if (freq<1000.0f)
        {
        return (int)freq;
        }
    for( i = 0; i < wrq.u.freq.e; i++ )
        freq *= 10;
    freq /= 1000000;
    cprintf( "wifi channel %f\n", freq );
    channel = ieee80211_mhz2ieee( freq );

    return channel;
}

int wifi_getfreq( char *ifname )
{
    struct iwreq wrq;
    float freq;

    strncpy( wrq.ifr_name, ifname, IFNAMSIZ );
    ioctl( getsocket(  ), SIOCGIWFREQ, &wrq );

    int i;

    freq = ( float )wrq.u.freq.m;
    if (freq<1000.0f)
        {
        return ieee80211_ieee2mhz((unsigned int)freq);
        }
    for( i = 0; i < wrq.u.freq.e; i++ )
        freq *= 10;
    freq /= 1000000;
    cprintf( "wifi channel %f\n", freq );
    return freq;
}

float wifi_getrate( char *ifname )
{
    struct iwreq wrq;

    strncpy( wrq.ifr_name, ifname, IFNAMSIZ );
    ioctl( getsocket(  ), SIOCGIWRATE, &wrq );
    return wrq.u.bitrate.value;
}

int get_radiostate( char *ifname )
{
    char mode[32];

    sprintf( mode, "%s_net_mode", ifname );
    if( nvram_match( mode, "disabled" ) )
        return 0;
    struct ifreq ifr;
    int skfd = getsocket(  );

    strncpy( ifr.ifr_name, "ra0", sizeof( ifr.ifr_name ) );
    if( ioctl( skfd, SIOCGIFFLAGS, &ifr ) < 0 )
    {
        return -1;
    }
    if( ( ifr.ifr_flags & IFF_UP ) )
    {
        return 1;
    }
    return 0;
}

static const char *ieee80211_ntoa( const uint8_t mac[6] )
{
    static char a[18];
    int i;

    i = snprintf( a, sizeof( a ), "%02x:%02x:%02x:%02x:%02x:%02x",
                  mac[0], mac[1], mac[2], mac[3], mac[4], mac[5] );
    return ( i < 17 ? NULL : a );
}
typedef union _MACHTTRANSMIT_SETTING {
        struct  {
                unsigned short  MCS:7;  // MCS
                unsigned short  BW:1;   //channel bandwidth 20MHz or 40 MHz
                unsigned short  ShortGI:1;
                unsigned short  STBC:2; //SPACE
                unsigned short  rsv:3;
                unsigned short  MODE:2; // Use definition MODE_xxx.
        } field;
        unsigned short      word;
} MACHTTRANSMIT_SETTING;

typedef struct _RT_802_11_MAC_ENTRY {
        unsigned char            Addr[6];
        unsigned char            Aid;
        unsigned char            Psm;     // 0:PWR_ACTIVE, 1:PWR_SAVE
        unsigned char            MimoPs;  // 0:MMPS_STATIC, 1:MMPS_DYNAMIC, 3:MMPS_Enabled
        char                     AvgRssi0;
        char                     AvgRssi1;
        char                     AvgRssi2;
        unsigned int             ConnectedTime;
        MACHTTRANSMIT_SETTING    TxRate;
} RT_802_11_MAC_ENTRY;

typedef struct _RT_802_11_MAC_TABLE {
        unsigned long            Num;
        RT_802_11_MAC_ENTRY      Entry[32]; //MAX_LEN_OF_MAC_TABLE = 32
} RT_802_11_MAC_TABLE;

#define RTPRIV_IOCTL_GET_MAC_TABLE              (SIOCIWFIRSTPRIV + 0x0F)

int getassoclist( char *ifname, unsigned char *list )
{
    struct iwreq iwr;
    char type[32];
    char netmode[32];
    unsigned int *count = ( unsigned int * )list;

    RT_802_11_MAC_TABLE table = {0};
    int s, i;

    sprintf( type, "%s_mode", ifname );
    sprintf( netmode, "%s_net_mode", ifname );
    if( nvram_match( netmode, "disabled" ) )
    {
        return 0;
    }

    if( !ifexists( ifname ) )
    {
        printf( "IOCTL_STA_INFO ifresolv %s failed!\n", ifname );
        return 0;
    }
    int state = get_radiostate( ifname );

    if( state == 0 || state == -1 )
    {
        printf( "IOCTL_STA_INFO radio %s not enabled!\n", ifname );
        return 0;
    }
    s = socket( AF_INET, SOCK_DGRAM, 0 );
    if( s < 0 )
    {
        fprintf( stderr, "socket(SOCK_DRAGM)\n" );
        return 0;
    }
    ( void )memset( &iwr, 0, sizeof( struct iwreq ) );
    ( void )strncpy( iwr.ifr_name, ifname, sizeof( iwr.ifr_name ) );

    iwr.u.data.pointer = (caddr_t) &table;
    if( ioctl( s, RTPRIV_IOCTL_GET_MAC_TABLE, &iwr ) < 0 )
    {
        fprintf( stderr, "IOCTL_STA_INFO for %s failed!\n", ifname );
        close( s );
        return 0;
    }


    unsigned char *l = ( unsigned char * )list;

    count[0] = 0;
    l += 4;
    for (i=0;i<table.Num;i++)
    {
        memcpy( l, &table.Entry[i].Addr, 6 );
        if( l[0] == 0 && l[1] == 0 && l[2] == 0 && l[3] == 0 && l[4] == 0
            && l[5] == 0 )
            break;
        l += 6;
        count[0]++;
    }
    close( s );

    return count[0];
}





#else
int getchannels( unsigned int *list, char *ifname )
{
    // int ret, num;
    // num = (sizeof (*list) - 4) / 6; /* Maximum number of entries in the
    // buffer */
    // memcpy (list, &num, 4); /* First 4 bytes are the number of ent. */

    // ret = wl_ioctl (name, WLC_GET_VALID_CHANNELS, list, 128);
    // fprintf(stderr,"get channels\n");
    char exec[64];

    sprintf( exec, "wl -i %s channels", ifname );
    FILE *in = popen( exec, "r" );

#ifndef HAVE_MSSID
    while( fgetc( in ) != ':' );
#endif
    int chan;
    int count = 0;

    while( !feof( in ) && fscanf( in, "%d", &chan ) == 1 )
    {
        list[count++] = chan;
    }
    pclose( in );
#ifdef BUFFALO_JP
    return count - 1;
#else
    return count;
#endif
}
int wl_getbssid( char *wl, char *mac )
{
    int ret;
    struct ether_addr ea;

    wl_ioctl( wl, WLC_GET_BSSID, &ea, ETHER_ADDR_LEN );
    ether_etoa( &ea, mac );
    return 0;
}

int getassoclist( char *name, unsigned char *list )
{
    // int ap;
    // if ((wl_ioctl(name, WLC_GET_AP, &ap, sizeof(ap)) < 0) || ap) 
    // {
    int ret;
    unsigned int num;

    num = ( sizeof( *list ) - 4 ) / 6;  /* Maximum number of entries in the
                                         * buffer */
    memcpy( list, &num, 4 );    /* First 4 bytes are the number of ent. */

    ret = wl_ioctl( name, WLC_GET_ASSOCLIST, list, 8192 );
    unsigned int *count = ( unsigned int * )list;

    // }else
    // {
    // char buf[WLC_IOCTL_MAXLEN];
    /*
     * wl_bss_info_t *bss_info = (wl_bss_info_t *) buf;
     * memset(buf,0,WLC_IOCTL_MAXLEN); if (wl_ioctl(name, WLC_GET_BSS_INFO,
     * bss_info, WLC_IOCTL_MAXLEN)<0)return 0; struct maclist *l = (struct
     * maclist*)list; 
     */
    /*
     * sta_info_t *sta_info = (sta_info_t *) buf;
     * memset(buf,0,WLC_IOCTL_MAXLEN); if (wl_ioctl(name, WLC_GET_VAR,
     * sta_info, WLC_IOCTL_MAXLEN)<0)return 0;
     * 
     * struct maclist *l = (struct maclist*)list; l->count=1;
     * memcpy(&l->ea,&sta_info->ea,6);
     */
    if( ret < 0 )
        return -1;
    return count[0];
}
#endif

int getwdslist( char *name, unsigned char *list )
{
    int ret, num;

    num = ( sizeof( *list ) - 4 ) / 6;  /* Maximum number of entries in the
                                         * buffer */
    memcpy( list, &num, 4 );    /* First 4 bytes are the number of ent. */

    ret = wl_ioctl( name, WLC_GET_WDSLIST, list, 8192 );

    return ( ret );
}

int getNoise( char *ifname, unsigned char *macname )
{
    unsigned int noise;

    // rssi = 0;
    // char buf[WLC_IOCTL_MAXLEN];
    wl_ioctl( ifname, WLC_GET_PHY_NOISE, &noise, sizeof( noise ) );

    /*
     * wl_bss_info_t *bss_info = (wl_bss_info_t *) buf;
     * memset(buf,0,WLC_IOCTL_MAXLEN);
     * 
     * wl_ioctl(name, WLC_GET_BSS_INFO, bss_info, WLC_IOCTL_MAXLEN); if
     * ((wl_ioctl(name, WLC_GET_AP, &ap, sizeof(ap)) < 0) || ap) { if
     * (wl_ioctl(name, WLC_GET_PHY_NOISE, &noise, sizeof(noise)) < 0) noise = 
     * 0; } else { // somehow the structure doesn't fit here rssi = buf[82];
     * noise = buf[84]; } 
     */
    return noise;
}

/*
 * struct iw_statistics *wlcompat_get_wireless_stats(struct net_device *dev)
 * { wl_bss_info_t *bss_info = (wl_bss_info_t *) buf; get_pktcnt_t pkt;
 * unsigned int rssi, noise, ap;
 * 
 * memset(&wstats, 0, sizeof(wstats)); memset(&pkt, 0, sizeof(pkt));
 * memset(buf, 0, sizeof(buf)); bss_info->version = 0x2000; wl_ioctl(dev,
 * WLC_GET_BSS_INFO, bss_info, WLC_IOCTL_MAXLEN); wl_ioctl(dev,
 * WLC_GET_PKTCNTS, &pkt, sizeof(pkt));
 * 
 * rssi = 0; if ((wl_ioctl(dev, WLC_GET_AP, &ap, sizeof(ap)) < 0) || ap) { if 
 * (wl_ioctl(dev, WLC_GET_PHY_NOISE, &noise, sizeof(noise)) < 0) noise = 0; } 
 * else { // somehow the structure doesn't fit here rssi = buf[82]; noise =
 * buf[84]; } rssi = (rssi == 0 ? 1 : rssi); wstats.qual.updated = 0x10; if
 * (rssi <= 1) wstats.qual.updated |= 0x20; if (noise <= 1)
 * wstats.qual.updated |= 0x40;
 * 
 * if ((wstats.qual.updated & 0x60) == 0x60) return NULL;
 * 
 * wstats.qual.level = rssi; wstats.qual.noise = noise; wstats.discard.misc = 
 * pkt.rx_bad_pkt; wstats.discard.retries = pkt.tx_bad_pkt;
 * 
 * return &wstats; }
 */
#else
#include <sys/types.h>
#include <sys/file.h>
#include <sys/ioctl.h>
#include <sys/socket.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <stdint.h>
#include <ctype.h>
#include <getopt.h>
#include <err.h>

#include "wireless.h"
#undef WPA_OUI
#undef WME_OUI
#include "net80211/ieee80211.h"
#include "net80211/ieee80211_crypto.h"
#include "net80211/ieee80211_ioctl.h"



int getsocket( void )
{
    static int s = -1;

    if( s < 0 )
    {
        s = socket( AF_INET, SOCK_DGRAM, 0 );
        if( s < 0 )
            err( 1, "socket(SOCK_DGRAM)" );
    }
    return s;
}


/*
 * Atheros 
 */


#define IOCTL_ERR(x) [x - SIOCIWFIRSTPRIV] "ioctl[" #x "]"
static int
set80211priv( struct iwreq *iwr, const char *ifname, int op, void *data,
              size_t len )
{
#define N(a)    (sizeof(a)/sizeof(a[0]))

    memset( iwr, 0, sizeof( struct iwreq ) );
    strncpy( iwr->ifr_name, ifname, IFNAMSIZ );
    if( len < IFNAMSIZ )
    {
        /*
         * Argument data fits inline; put it there.
         */
        memcpy( iwr->u.name, data, len );
    }
    else
    {
        /*
         * Argument data too big for inline transfer; setup a
         * parameter block instead; the kernel will transfer
         * the data for the driver.
         */
        iwr->u.data.pointer = data;
        iwr->u.data.length = len;
    }

    if( ioctl( getsocket(  ), op, iwr ) < 0 )
    {
        static const char *opnames[] = {
            IOCTL_ERR( IEEE80211_IOCTL_SETPARAM ),
            IOCTL_ERR( IEEE80211_IOCTL_GETPARAM ),
            IOCTL_ERR( IEEE80211_IOCTL_SETMODE ),
            IOCTL_ERR( IEEE80211_IOCTL_GETMODE ),
            IOCTL_ERR( IEEE80211_IOCTL_SETWMMPARAMS ),
            IOCTL_ERR( IEEE80211_IOCTL_GETWMMPARAMS ),
            IOCTL_ERR( IEEE80211_IOCTL_SETCHANLIST ),
            IOCTL_ERR( IEEE80211_IOCTL_GETCHANLIST ),
            IOCTL_ERR( IEEE80211_IOCTL_CHANSWITCH ),
            IOCTL_ERR( IEEE80211_IOCTL_GETCHANINFO ),
            IOCTL_ERR( IEEE80211_IOCTL_SETOPTIE ),
            IOCTL_ERR( IEEE80211_IOCTL_GETOPTIE ),
            IOCTL_ERR( IEEE80211_IOCTL_SETMLME ),
            IOCTL_ERR( IEEE80211_IOCTL_SETKEY ),
            IOCTL_ERR( IEEE80211_IOCTL_DELKEY ),
            IOCTL_ERR( IEEE80211_IOCTL_ADDMAC ),
            IOCTL_ERR( IEEE80211_IOCTL_DELMAC ),
            IOCTL_ERR( IEEE80211_IOCTL_WDSADDMAC ),
#ifdef OLD_MADWIFI
            IOCTL_ERR( IEEE80211_IOCTL_WDSDELMAC ),
#else
            IOCTL_ERR( IEEE80211_IOCTL_WDSSETMAC ),
#endif
        };
        op -= SIOCIWFIRSTPRIV;
        if( 0 <= op && op < N( opnames ) )
            perror( opnames[op] );
        else
            perror( "ioctl[unknown???]" );
        return -1;
    }
    return 0;
#undef N
}

int do80211priv( const char *ifname, int op, void *data, size_t len )
{
    struct iwreq iwr;

    if( set80211priv( &iwr, ifname, op, data, len ) < 0 )
        return -1;
    if( len < IFNAMSIZ )
        memcpy( data, iwr.u.name, len );
    return iwr.u.data.length;
}

float wifi_getrate( char *ifname )
{
    struct iwreq wrq;

    strncpy( wrq.ifr_name, ifname, IFNAMSIZ );
    ioctl( getsocket(  ), SIOCGIWRATE, &wrq );
    return wrq.u.bitrate.value;
}

/*
 * For doing log10/exp10 without libm 
 */
#define LOG10_MAGIC     1.25892541179

int iw_mwatt2dbm( int in )
{
    /*
     * Version without libm : slower 
     */
    double fin = ( double )in;
    int res = 0;

    /*
     * Split integral and floating part to avoid accumulating rounding errors 
     */
    while( fin > 10.0 )
    {
        res += 10;
        fin /= 10.0;
    }
    while( fin > 1.000001 )     /* Eliminate rounding errors, take ceil */
    {
        res += 1;
        fin /= LOG10_MAGIC;
    }
    return ( res );
}

int wifi_gettxpower( char *ifname )
{
    int poweroffset = 0;

#ifdef HAVE_ALPHA
    poweroffset = 10;
#elif HAVE_EAP3660
    poweroffset = 7;
#else
    int vendor;
    int devcount;
    char readid[64];

    strcpy( readid, ifname );
    sscanf( readid, "ath%d", &devcount );
    sprintf( readid, "/proc/sys/dev/wifi%d/vendor", devcount );
    FILE *in = fopen( readid, "rb" );

    vendor = 0;
    if( in )
    {
        vendor = atoi( fgets( readid, sizeof( readid ), in ) );
        fclose( in );
    }
    switch ( vendor )
    {
        case 1:         // ubnt xr5
        case 2:         // ubnt xr2
        case 3:         // ubnt sr2
        case 13:                // ubnt xr3
        case 14:                // ubnt xr4
        case 1328:              // ubnt xr3
        case 1336:              // ubnt xr3
        case 71:                // ubnt sr71a
        case 7:         // ubnt xr7
        case 9:         // ubnt xr9
            poweroffset = 10;
            break;
        case 4:         // ubnt sr9
            poweroffset = 12;
            break;
        case 5:         // ubnt sr5
            poweroffset = 7;
        case 24:                // ubnt sr4
            poweroffset = 7;
            break;
        case 25:                // ubnt ns5
            poweroffset = 5;
            break;
        case 26:                // senao eoc2610
            poweroffset = 7;
            break;
        default:
            poweroffset = 0;
            break;
    }
#endif
    struct iwreq wrq;

    strncpy( wrq.ifr_name, ifname, IFNAMSIZ );
    ioctl( getsocket(  ), SIOCGIWTXPOW, &wrq );
    struct iw_param *txpower = &wrq.u.txpower;

    if( txpower->disabled )
    {
        return 0;
    }
    else
    {
        /*
         * Check for relative values 
         */
        if( txpower->flags & IW_TXPOW_RELATIVE )
        {
            return txpower->value + poweroffset;
        }
        else
        {
            int dbm = 0;

            /*
             * Convert everything to dBm 
             */
            if( txpower->flags & IW_TXPOW_MWATT )
                dbm = iw_mwatt2dbm( txpower->value );
            else
                dbm = txpower->value;
            return dbm + poweroffset;
        }
    }
}

int wifi_gettxpoweroffset( char *ifname )
{
    int poweroffset = 0;

#ifdef HAVE_ALPHA
    poweroffset = 10;
#elif HAVE_EAP3660
    poweroffset = 7;
#else
    int vendor;
    int devcount;
    char readid[64];

    strcpy( readid, ifname );
    sscanf( readid, "ath%d", &devcount );
    sprintf( readid, "/proc/sys/dev/wifi%d/vendor", devcount );
    FILE *in = fopen( readid, "rb" );

    vendor = 0;
    if( in )
    {
        vendor = atoi( fgets( readid, sizeof( readid ), in ) );
        fclose( in );
    }
    switch ( vendor )
    {
        case 1:         // ubnt xr5
        case 2:         // ubnt xr2
        case 3:         // ubnt sr2
        case 13:                // ubnt xr3
        case 14:                // ubnt xr4
        case 1328:              // ubnt xr3
        case 1336:              // ubnt xr3
        case 71:                // ubnt sr71a
        case 7:         // ubnt xr7
            poweroffset = 10;
            break;
        case 9:         // ubnt xr9
            poweroffset = 12;
        case 4:         // ubnt sr9
            poweroffset = 12;
            break;
        case 5:         // ubnt sr5
            poweroffset = 7;
        case 24:                // ubnt sr4
            poweroffset = 7;
            break;
        case 25:                // ubnt ns5
            poweroffset = 5;
            break;
        case 26:                // senao eoc2610
            poweroffset = 7;
            break;
        default:
            poweroffset = 0;
            break;
    }
#endif
    return poweroffset;
}

int get_wifioffset( char *ifname )
{
    int vendor;
    int devcount;
    char readid[64];

    strcpy( readid, ifname );
    sscanf( readid, "ath%d", &devcount );
    sprintf( readid, "/proc/sys/dev/wifi%d/vendor", devcount );
    FILE *in = fopen( readid, "rb" );

    vendor = 0;
    if( in )
    {
        vendor = atoi( fgets( readid, sizeof( readid ), in ) );
        fclose( in );
    }
    switch ( vendor )
    {
        case 9:         // ubnt xr9
        case 4:         // ubnt sr9
            return -( 2427 - 907 );
        case 13:
            return -( 5540 - 3540 );    // xr3 general 3,5 ghz
        case 1328:
            return -( 5540 - 2840 );    // xr3 special 2.8 ghz
        case 1336:
            return -( 5540 - 3340 );    // xr3 special 3.3 ghz
        case 7:
            return -( 2427 - 763 );     // xr7 
        case 14:
            return -( 5540 - 4516 );    // xr4 
            // case 24:
            // return -(5540-4540); //sr4 
        default:
            return 0;
            break;
    }
    return 0;
}

#ifdef WILLAM
#define OFFSET 0
#else
#define OFFSET 0
#endif
u_int ieee80211_mhz2ieee( u_int freq )
{
    if( freq == 2484 + OFFSET )
        return 14;
    if( freq < 2484 + OFFSET )
        return ( freq - ( 2407 + OFFSET ) ) / 5;
    if( freq < 4990 && freq > 4940 )
        return ( ( freq * 10 ) + ( ( ( freq % 5 ) == 2 ) ? 5 : 0 ) -
                 49400 ) / 5;
    if( freq < 5000 )
        return 15 + ( ( freq - ( 2512 + OFFSET ) ) / 20 );

    return ( freq - ( 5000 + OFFSET ) ) / 5;
}

int wifi_getchannel( char *ifname )
{
    struct iwreq wrq;
    float freq;
    int channel;

    strncpy( wrq.ifr_name, ifname, IFNAMSIZ );
    ioctl( getsocket(  ), SIOCGIWFREQ, &wrq );

    int i;

    freq = ( float )wrq.u.freq.m;
    for( i = 0; i < wrq.u.freq.e; i++ )
        freq *= 10;
    freq /= 1000000;
    cprintf( "wifi channel %f\n", freq );
    channel = ieee80211_mhz2ieee( freq );

    return channel;
}

int wifi_getfreq( char *ifname )
{
    struct iwreq wrq;
    float freq;

    strncpy( wrq.ifr_name, ifname, IFNAMSIZ );
    ioctl( getsocket(  ), SIOCGIWFREQ, &wrq );

    int i;

    freq = ( float )wrq.u.freq.m;
    for( i = 0; i < wrq.u.freq.e; i++ )
        freq *= 10;
    freq /= 1000000;
    cprintf( "wifi channel %f\n", freq );
    return freq;
}

int get_radiostate( char *ifname )
{
    char mode[32];

    sprintf( mode, "%s_net_mode", ifname );
    if( nvram_match( mode, "disabled" ) )
        return 0;
    struct ifreq ifr;
    int skfd = getsocket(  );

    strncpy( ifr.ifr_name, ifname, sizeof( ifr.ifr_name ) );
    if( ioctl( skfd, SIOCGIFFLAGS, &ifr ) < 0 )
    {
        return -1;
    }
    if( ( ifr.ifr_flags & IFF_UP ) )
    {
        return 1;
    }
    return 0;
}


struct wifi_channels
{
    int channel;
    int freq;
    int noise;
};

static inline int iw_get_ext( int skfd, /* Socket to the kernel */
                              const char *ifname,       /* Device name */
                              int request,      /* WE ID */
                              struct iwreq *pwrq )      /* Fixed part of the
                                                         * request */
{
    /*
     * Set device name 
     */
    strncpy( pwrq->ifr_name, ifname, IFNAMSIZ );
    /*
     * Do the request 
     */
    return ( ioctl( skfd, request, pwrq ) );
}

int isAssociated( char *ifname )
{
    struct iwreq wrq;
    int i;

    if( iw_get_ext( getsocket(  ), ifname, SIOCGIWAP, &wrq ) >= 0 )
    {
        for( i = 0; i < 6; i++ )
            if( wrq.u.ap_addr.sa_data[i] != 0 )
                return 1;
    }
    return 0;
}

int getAssocMAC( char *ifname, char *mac )
{
    struct iwreq wrq;
    int i;
    int ret = -1;

    if( iw_get_ext( getsocket(  ), ifname, SIOCGIWAP, &wrq ) >= 0 )
    {
        for( i = 0; i < 6; i++ )
            if( wrq.u.ap_addr.sa_data[i] != 0 )
                ret = 0;
    }
    if( !ret )
    {
        for( i = 0; i < 6; i++ )
            mac[i] = wrq.u.ap_addr.sa_data[i];

    }
    return ret;
}

int is_ar5008( int devnum )
{
    char sys[64];

    sprintf( sys, "/proc/sys/dev/wifi%d/mimo", devnum );
    FILE *tmp = fopen( sys, "rb" );

    if( tmp == NULL )
        return 0;
    fclose( tmp );
    return 1;
}

int is_wifar5008( char *dev )
{
    char sys[64];

    sprintf( sys, "/proc/sys/dev/%s/mimo", dev );
    FILE *tmp = fopen( sys, "rb" );

    if( tmp == NULL )
        return 0;
    fclose( tmp );
    return 1;
}

static struct wifi_channels *list_channelsext( const char *ifname,
                                               int allchans )
{
    struct ieee80211req_chaninfo chans;
    struct ieee80211req_chaninfo achans;
    const struct ieee80211_channel *c;
    int i;

    // fprintf (stderr, "list channels for %s\n", ifname);
    if( do80211priv
        ( ifname, IEEE80211_IOCTL_GETCHANINFO, &chans, sizeof( chans ) ) < 0 )
    {
        fprintf( stderr, "unable to get channel information\n" );
        return NULL;
    }
    if( !allchans )
    {
        uint8_t active[64];

        if( do80211priv
            ( ifname, IEEE80211_IOCTL_GETCHANLIST, &active,
              sizeof( active ) ) < 0 )
        {
            fprintf( stderr, "unable to get active channel list\n" );
            return NULL;
        }
        memset( &achans, 0, sizeof( achans ) );
        for( i = 0; i < chans.ic_nchans; i++ )
        {
            c = &chans.ic_chans[i];
            if( isset( active, c->ic_ieee ) || allchans )
                achans.ic_chans[achans.ic_nchans++] = *c;
        }
    }
    else
        achans = chans;

    // fprintf(stderr,"channel number %d\n", achans.ic_nchans);
    struct wifi_channels *list =
        ( struct wifi_channels * )malloc( sizeof( struct wifi_channels ) *
                                          ( achans.ic_nchans + 1 ) );

    char wl_mode[16];
    char wl_turbo[16];

    sprintf( wl_mode, "%s_net_mode", ifname );
    sprintf( wl_turbo, "%s_channelbw", ifname );
    int l = 0;

    for( i = 0; i < achans.ic_nchans; i++ )
    {
        // fprintf(stderr,"channel number %d of %d\n", i,achans.ic_nchans);

        // filter out A channels if mode isnt A-Only or mixed
        if( IEEE80211_IS_CHAN_A( &achans.ic_chans[i] ) )
        {
#ifdef HAVE_WHRAG108
            if( !strcmp( ifname, "ath1" ) )
                continue;
#endif
#ifdef HAVE_TW6600
            if( !strcmp( ifname, "ath1" ) )
                continue;
#endif
            if( nvram_invmatch( wl_mode, "a-only" )
                && nvram_invmatch( wl_mode, "mixed" ) )
                continue;
        }
#ifdef GIBTSNICHT
        if( IEEE80211_IS_CHAN_11NA( &achans.ic_chans[i] ) )
        {
            if( nvram_invmatch( wl_mode, "na-only" )
                && nvram_invmatch( wl_mode, "mixed" ) )
                continue;
        }
        if( IEEE80211_IS_CHAN_11NG( &achans.ic_chans[i] ) )
        {
            if( nvram_invmatch( wl_mode, "ng-only" )
                && nvram_invmatch( wl_mode, "mixed" ) )
                continue;
        }
#endif
        // filter out B/G channels if mode isnt g-only, b-only or mixed
        if( IEEE80211_IS_CHAN_ANYG( &achans.ic_chans[i] )
            || IEEE80211_IS_CHAN_B( &achans.ic_chans[i] ) )
        {
#ifdef HAVE_WHRAG108
            if( !strcmp( ifname, "ath0" ) )
                continue;
#endif
#ifdef HAVE_TW6600
            if( !strcmp( ifname, "ath0" ) )
                continue;
#endif
            if( nvram_invmatch( wl_mode, "g-only" )
                && nvram_invmatch( wl_mode, "mixed" )
                && nvram_invmatch( wl_mode, "b-only" )
                && nvram_invmatch( wl_mode, "bg-mixed" ) )
                continue;
        }

        // filter out channels which are not supporting turbo mode if turbo
        // is enabled
        if( !IEEE80211_IS_CHAN_STURBO( &achans.ic_chans[i] )
            && !IEEE80211_IS_CHAN_DTURBO( &achans.ic_chans[i] ) )
        {
            if( nvram_match( wl_turbo, "40" ) )
                continue;
        }
        // filter out turbo channels if turbo mode is disabled
        /*
         * if (IEEE80211_IS_CHAN_STURBO (&achans.ic_chans[i]) ||
         * IEEE80211_IS_CHAN_DTURBO (&achans.ic_chans[i])) { if (nvram_match
         * (wl_turbo, "0")) continue; }
         */
        if( IEEE80211_IS_CHAN_STURBO( &achans.ic_chans[i] ) )
        {
            if( !nvram_match( wl_turbo, "40" ) )
                continue;
        }

        list[l].channel = achans.ic_chans[i].ic_ieee;
        list[l].freq = achans.ic_chans[i].ic_freq;
        list[l].noise = -95;    // achans.ic_chans[i].ic_noise;
        l++;
    }

    list[l].freq = -1;
    return list;
}

struct wifi_channels *list_channels( char *devnr )
{
    return list_channelsext( devnr, 1 );
    /*
     * char csign[64]; char channel[64]; char ppp[64]; char freq[64]; char
     * dum1[64]; char dum2[64]; char dum3[64]; char dum4[64];
     * 
     * char cmd[64]; sprintf (cmd, "iwlist %s chan>/tmp/.channels", devnr);
     * system (cmd); FILE *in = fopen ("/tmp/.channels", "rb"); if (in ==
     * NULL) return NULL; fscanf (in, "%s %s %s %s %s %s %s %s", csign,
     * channel, ppp, freq, dum1, dum2, dum3, dum4); int ch = atoi (channel);
     * int i; struct wifi_channels *list = (struct wifi_channels *) malloc
     * (sizeof (struct wifi_channels) * (ch+1) ); for (i = 0; i < ch; i++) {
     * fscanf (in, "%s %s %s %s %s", csign, channel, ppp, freq, dum1); if
     * (!strcmp (csign, "Current")) break; list[i].channel = atoi (channel);
     * list[i].freq = strdup (freq); channelcount++; } fclose (in); return
     * list; 
     */
}

int getdevicecount( void )
{
    int count = getifcount( "wifi" );

    if( count < 7 && count > 0 )
        return count;
    return 0;
}


int getRssi( char *ifname, unsigned char *mac )
{
    unsigned char *buf = malloc( 24 * 1024 );

    memset( buf, 0, 1024 * 24 );
    unsigned char *cp;
    int len;
    struct iwreq iwr;
    int s;

    s = socket( AF_INET, SOCK_DGRAM, 0 );
    if( s < 0 )
    {
        fprintf( stderr, "socket(SOCK_DRAGM)\n" );
        free( buf );
        return 0;
    }
    ( void )memset( &iwr, 0, sizeof( iwr ) );
    ( void )strncpy( iwr.ifr_name, ifname, sizeof( iwr.ifr_name ) );
    iwr.u.data.pointer = ( void * )buf;
    iwr.u.data.length = 1024 * 24;
    if( ioctl( s, IEEE80211_IOCTL_STA_INFO, &iwr ) < 0 )
    {
        close( s );
        free( buf );
        fprintf( stderr, "stainfo error\n" );
        return 0;
    }
    len = iwr.u.data.length;
    if( len < sizeof( struct ieee80211req_sta_info ) )
        return 0;

    cp = buf;
    char maccmp[6];

    memset( maccmp, 0, 6 );
    do
    {
        struct ieee80211req_sta_info *si;

        si = ( struct ieee80211req_sta_info * )cp;
        if( !memcmp( &si->isi_macaddr[0], mac, 6 ) )
        {
            close( s );
            int rssi = si->isi_noise + si->isi_rssi;

            free( buf );
            return rssi;
        }
        if( !memcmp( &si->isi_macaddr[0], mac, 6 ) )
            break;
        cp += si->isi_len;
        len -= si->isi_len;
    }
    while( len >= sizeof( struct ieee80211req_sta_info ) );
    close( s );
    free( buf );
    return 0;
}

int getNoise( char *ifname, unsigned char *mac )
{
    unsigned char *buf = malloc( 24 * 1024 );

    memset( buf, 0, 24 * 1024 );
    unsigned char *cp;
    int len;
    struct iwreq iwr;
    int s;

    s = socket( AF_INET, SOCK_DGRAM, 0 );
    if( s < 0 )
    {
        fprintf( stderr, "socket(SOCK_DRAGM)\n" );
        free( buf );
        return 0;
    }
    ( void )memset( &iwr, 0, sizeof( iwr ) );
    ( void )strncpy( iwr.ifr_name, ifname, sizeof( iwr.ifr_name ) );
    iwr.u.data.pointer = ( void * )buf;
    iwr.u.data.length = 24 * 1024;
    if( ioctl( s, IEEE80211_IOCTL_STA_INFO, &iwr ) < 0 )
    {
        close( s );
        free( buf );
        return 0;
    }
    len = iwr.u.data.length;
    if( len < sizeof( struct ieee80211req_sta_info ) )
        return -1;

    cp = buf;
    char maccmp[6];

    memset( maccmp, 0, 6 );
    do
    {
        struct ieee80211req_sta_info *si;

        si = ( struct ieee80211req_sta_info * )cp;
        if( !memcmp( &si->isi_macaddr[0], mac, 6 ) )
        {
            close( s );
            int noise = si->isi_noise;

            free( buf );
            return noise;
        }
        if( !memcmp( &si->isi_macaddr[0], mac, 6 ) )
            break;
        cp += si->isi_len;
        len -= si->isi_len;
    }
    while( len >= sizeof( struct ieee80211req_sta_info ) );
    close( s );
    free( buf );
    return 0;
}

int getassoclist( char *ifname, unsigned char *list )
{
    unsigned char *buf;

    buf = malloc( 24 * 1024 );
    memset( buf, 0, 1024 * 24 );
    unsigned char *cp;
    int len;
    struct iwreq iwr;
    int s;
    char type[32];
    char netmode[32];
    unsigned int *count = ( unsigned int * )list;

    sprintf( type, "%s_mode", ifname );
    sprintf( netmode, "%s_net_mode", ifname );
    if( nvram_match( netmode, "disabled" ) )
    {
        free( buf );
        return 0;
    }
    int mincount = 0;

    if( nvram_match( type, "wdssta" ) || nvram_match( type, "sta" )
        || nvram_match( type, "wet" ) )
    {
        int assoc = isAssociated( ifname );

        if( !assoc )
        {
            free( buf );
            return 0;
        }
        char mac[6];

        getAssocMAC( ifname, mac );
        memcpy( &list[4], mac, 6 );
        count[0] = 1;
        mincount = 1;
    }
    s = socket( AF_INET, SOCK_DGRAM, 0 );
    if( s < 0 )
    {
        fprintf( stderr, "socket(SOCK_DRAGM)\n" );
        free( buf );
        mincount = 1;
        return mincount;
    }
    ( void )memset( &iwr, 0, sizeof( iwr ) );
    ( void )strncpy( iwr.ifr_name, ifname, sizeof( iwr.ifr_name ) );
    iwr.u.data.pointer = ( void * )buf;
    iwr.u.data.length = 1024 * 24;
    if( ioctl( s, IEEE80211_IOCTL_STA_INFO, &iwr ) < 0 )
    {
        close( s );
        free( buf );
        return mincount;
    }
    len = iwr.u.data.length;
    if( len < sizeof( struct ieee80211req_sta_info ) )
    {
        close( s );
        free( buf );
        return mincount;
    }

    cp = buf;
    unsigned char *l = ( unsigned char * )list;

    count[0] = 0;
    l += 4;
    do
    {
        struct ieee80211req_sta_info *si;

        si = ( struct ieee80211req_sta_info * )cp;
        memcpy( l, &si->isi_macaddr[0], 6 );
        if( l[0] == 0 && l[1] == 0 && l[2] == 0 && l[3] == 0 && l[4] == 0
            && l[5] == 0 )
            break;
        l += 6;
        count[0]++;
        cp += si->isi_len;
        len -= si->isi_len;
    }
    while( len >= sizeof( struct ieee80211req_sta_info ) );
    close( s );
    free( buf );

    return mincount > count[0] ? mincount : count[0];
}

#endif



#ifdef HAVE_RT2880
char *get_wl_instance_name( int instance )
{
    return "ra0";
}
int get_wl_instances( void )
{
    return 1;
}

int get_wl_instance( char *name )
{
    return 1;
}



#else
char *get_wl_instance_name( int instance )
{
    if( get_wl_instance( "eth1" ) == instance )
        return "eth1";
    if( get_wl_instance( "eth2" ) == instance )
        return "eth2";
    if( get_wl_instance( "eth0" ) == instance )
        return "eth0";
    if( get_wl_instance( "eth3" ) == instance )
        return "eth3";
    fprintf( stderr, "get_wl_instance doesnt return the right value %d\n",
             instance );
    return "eth1";              // dirty for debugging
}

int get_wl_instances( void )
{
    if( get_wl_instance( "eth1" ) == 1 )
        return 2;
    if( get_wl_instance( "eth2" ) == 1 )
        return 2;
    if( get_wl_instance( "eth3" ) == 1 )
        return 2;
    return 1;
}

int get_wl_instance( char *name )
{
    int unit;
    int ret;

    if( !ifexists( name ) )
        return -1;
    if( wl_probe( name ) )
        return -1;
    ret = wl_ioctl( name, WLC_GET_INSTANCE, &unit, sizeof( unit ) );
    if( ret == 0 )
        return unit;
    return ret;
}
#endif
    /*
     * return wireless interface 
     */
char *get_wdev( void )
{
#ifdef HAVE_MADWIFI
    if( nvram_match( "wifi_bonding", "1" ) )
        return "bond0";
    else
    {
        return "ath0";
    }
#elif HAVE_RT2880
    return "ra0";
#else
    if( !wl_probe( "eth1" ) )
        return "eth1";
    if( !wl_probe( "eth2" ) )
        return "eth2";
    if( !wl_probe( "eth0" ) )
        return "eth0";
    return nvram_safe_get( "wl0_ifname" );
#endif
}

int wl_probe( char *name )
{
    int ret, val;

    if( isListed( "probe_blacklist", name ) )
        return -1;

#if defined(linux)
    char buf[DEV_TYPE_LEN];

    if( ( ret = wl_get_dev_type( name, buf, DEV_TYPE_LEN ) ) < 0 )
    {
        addList( "probe_blacklist", name );
        return ret;
    }
    /*
     * Check interface 
     */
    if( strncmp( buf, "wl", 2 ) )
    {
        addList( "probe_blacklist", name );
        return -1;
    }
#else
    /*
     * Check interface 
     */
    if( ( ret = wl_ioctl( name, WLC_GET_MAGIC, &val, sizeof( val ) ) ) )
    {
        addList( "probe_blacklist", name );
        return ret;
    }
#endif
    if( ( ret = wl_ioctl( name, WLC_GET_VERSION, &val, sizeof( val ) ) ) )
    {
        addList( "probe_blacklist", name );
        return ret;
    }
    if( val > WLC_IOCTL_VERSION )
    {
        addList( "probe_blacklist", name );
        return -1;
    }
    return ret;
}

/*
 * int wl_probe (char *name) { int ret, val;
 * 
 * if ((ret = wl_ioctl (name, WLC_GET_MAGIC, &val, sizeof (val)))) return
 * ret; if (val != WLC_IOCTL_MAGIC) return -1; if ((ret = wl_ioctl (name,
 * WLC_GET_VERSION, &val, sizeof (val)))) return ret; if (val >
 * WLC_IOCTL_VERSION) return -1;
 * 
 * return ret; } 
 */
// #ifndef HAVE_MSSID
int wl_set_val( char *name, 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( name, WLC_SET_VAR, buf, buf_len );
}

int wl_get_val( char *name, 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( name, WLC_GET_VAR, buf, sizeof( buf ) ) ) )
        return ret;

    memcpy( val, buf, len );
    return 0;
}

int wl_set_int( char *name, char *var, int val )
{
    return wl_set_val( name, var, &val, sizeof( val ) );
}

int wl_get_int( char *name, char *var, int *val )
{
    return wl_get_val( name, var, val, sizeof( *val ) );
}

// #else
int
wl_iovar_getbuf( char *ifname, char *iovar, void *param, int paramlen,
                 void *bufptr, int buflen )
{
    int err;
    uint namelen;
    uint iolen;

    namelen = strlen( iovar ) + 1;      /* length of iovar name plus null */
    iolen = namelen + paramlen;

    /*
     * check for overflow 
     */
    if( iolen > buflen )
        return ( BCME_BUFTOOSHORT );

    memcpy( bufptr, iovar, namelen );   /* copy iovar name including null */
    memcpy( ( int8 * ) bufptr + namelen, param, paramlen );

    err = wl_ioctl( ifname, WLC_GET_VAR, bufptr, buflen );

    return ( err );
}

int
wl_iovar_setbuf( char *ifname, char *iovar, void *param, int paramlen,
                 void *bufptr, int buflen )
{
    uint namelen;
    uint iolen;

    namelen = strlen( iovar ) + 1;      /* length of iovar name plus null */
    iolen = namelen + paramlen;

    /*
     * check for overflow 
     */
    if( iolen > buflen )
        return ( BCME_BUFTOOSHORT );

    memcpy( bufptr, iovar, namelen );   /* copy iovar name including null */
    memcpy( ( int8 * ) bufptr + namelen, param, paramlen );

    return wl_ioctl( ifname, WLC_SET_VAR, bufptr, iolen );
}

int wl_iovar_set( char *ifname, char *iovar, void *param, int paramlen )
{
    char smbuf[WLC_IOCTL_SMLEN];

    return wl_iovar_setbuf( ifname, iovar, param, paramlen, smbuf,
                            sizeof( smbuf ) );
}

int wl_iovar_get( char *ifname, char *iovar, void *bufptr, int buflen )
{
    char smbuf[WLC_IOCTL_SMLEN];
    int ret;

    /*
     * use the return buffer if it is bigger than what we have on the stack 
     */
    if( buflen > sizeof( smbuf ) )
    {
        ret = wl_iovar_getbuf( ifname, iovar, NULL, 0, bufptr, buflen );
    }
    else
    {
        ret =
            wl_iovar_getbuf( ifname, iovar, NULL, 0, smbuf, sizeof( smbuf ) );
        if( ret == 0 )
            memcpy( bufptr, smbuf, buflen );
    }

    return ret;
}

/*
 * set named driver variable to int value
 * calling example: wl_iovar_setint(ifname, "arate", rate) 
 */
int wl_iovar_setint( char *ifname, char *iovar, int val )
{
    return wl_iovar_set( ifname, iovar, &val, sizeof( val ) );
}

/*
 * get named driver variable to int value and return error indication 
 * calling example: wl_iovar_getint(ifname, "arate", &rate) 
 */
int wl_iovar_getint( char *ifname, char *iovar, int *val )
{
    return wl_iovar_get( ifname, iovar, val, sizeof( int ) );
}

/*
 * format a bsscfg indexed iovar buffer
 */
static int
wl_bssiovar_mkbuf( char *iovar, int bssidx, void *param, int paramlen,
                   void *bufptr, int buflen, unsigned int *plen )
{
    char *prefix = "bsscfg:";
    int8 *p;
    uint prefixlen;
    uint namelen;
    uint iolen;

    prefixlen = strlen( prefix );       /* length of bsscfg prefix */
    namelen = strlen( iovar ) + 1;      /* length of iovar name + null */
    iolen = prefixlen + namelen + sizeof( int ) + paramlen;

    /*
     * check for overflow 
     */
    if( buflen < 0 || iolen > ( uint ) buflen )
    {
        *plen = 0;
        return BCME_BUFTOOSHORT;
    }

    p = ( int8 * ) bufptr;

    /*
     * copy prefix, no null 
     */
    memcpy( p, prefix, prefixlen );
    p += prefixlen;

    /*
     * copy iovar name including null 
     */
    memcpy( p, iovar, namelen );
    p += namelen;

    /*
     * bss config index as first param 
     */
    memcpy( p, &bssidx, sizeof( int32 ) );
    p += sizeof( int32 );

    /*
     * parameter buffer follows 
     */
    if( paramlen )
        memcpy( p, param, paramlen );

    *plen = iolen;
    return 0;
}

/*
 * set named & bss indexed driver variable to buffer value
 */
int
wl_bssiovar_setbuf( char *ifname, char *iovar, int bssidx, void *param,
                    int paramlen, void *bufptr, int buflen )
{
    int err;
    uint iolen;

    err =
        wl_bssiovar_mkbuf( iovar, bssidx, param, paramlen, bufptr, buflen,
                           &iolen );
    if( err )
        return err;

    return wl_ioctl( ifname, WLC_SET_VAR, bufptr, iolen );
}

/*
 * get named & bss indexed driver variable buffer value
 */
int
wl_bssiovar_getbuf( char *ifname, char *iovar, int bssidx, void *param,
                    int paramlen, void *bufptr, int buflen )
{
    int err;
    uint iolen;

    err =
        wl_bssiovar_mkbuf( iovar, bssidx, param, paramlen, bufptr, buflen,
                           &iolen );
    if( err )
        return err;

    return wl_ioctl( ifname, WLC_GET_VAR, bufptr, buflen );
}

/*
 * set named & bss indexed driver variable to buffer value
 */
int
wl_bssiovar_set( char *ifname, char *iovar, int bssidx, void *param,
                 int paramlen )
{
    char smbuf[WLC_IOCTL_SMLEN];

    return wl_bssiovar_setbuf( ifname, iovar, bssidx, param, paramlen, smbuf,
                               sizeof( smbuf ) );
}

/*
 * get named & bss indexed driver variable buffer value
 */
int
wl_bssiovar_get( char *ifname, char *iovar, int bssidx, void *outbuf,
                 int len )
{
    char smbuf[WLC_IOCTL_SMLEN];
    int err;

    /*
     * use the return buffer if it is bigger than what we have on the stack 
     */
    if( len > ( int )sizeof( smbuf ) )
    {
        err =
            wl_bssiovar_getbuf( ifname, iovar, bssidx, NULL, 0, outbuf, len );
    }
    else
    {
        memset( smbuf, 0, sizeof( smbuf ) );
        err =
            wl_bssiovar_getbuf( ifname, iovar, bssidx, NULL, 0, smbuf,
                                sizeof( smbuf ) );
        if( err == 0 )
            memcpy( outbuf, smbuf, len );
    }

    return err;
}

/*
 * set named & bss indexed driver variable to int value
 */
int wl_bssiovar_setint( char *ifname, char *iovar, int bssidx, int val )
{
    return wl_bssiovar_set( ifname, iovar, bssidx, &val, sizeof( int ) );
}

/*
 * void wl_printlasterror(char *name) { char err_buf[WLC_IOCTL_SMLEN];
 * strcpy(err_buf, "bcmerrstr");
 * 
 * fprintf(stderr, "Error: "); if ( wl_ioctl(name, WLC_GET_VAR, err_buf,
 * sizeof (err_buf)) != 0) fprintf(stderr, "Error getting the Errorstring
 * from driver\n"); else fprintf(stderr, err_buf); } 
 */

// #endif