iwctl.c

Go to the documentation of this file.

/*
 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
 * All rights reserved.
 *
 * 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.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
 *
 * File: iwctl.c
 *
 * Purpose:  wireless ext & ioctl functions
 *
 * Author: Lyndon Chen
 *
 * Date: July 5, 2006
 *
 * Functions:
 *
 * Revision History:
 *
 */

#include "device.h"
#include "ioctl.h"
#include "iocmd.h"
#include "mac.h"
#include "card.h"
#include "hostap.h"
#include "power.h"
#include "rf.h"

#ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
#include "iowpa.h"
#include "wpactl.h"
#endif

#include <net/iw_handler.h>

#ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
#define SUPPORTED_WIRELESS_EXT 18
#else
#define SUPPORTED_WIRELESS_EXT 17
#endif

static const long frequency_list[] = {
    2412, 2417, 2422, 2427, 2432, 2437, 2442, 2447, 2452, 2457, 2462, 2467, 2472, 2484,
    4915, 4920, 4925, 4935, 4940, 4945, 4960, 4980,
    5035, 5040, 5045, 5055, 5060, 5080, 5170, 5180, 5190, 5200, 5210, 5220, 5230, 5240,
    5260, 5280, 5300, 5320, 5500, 5520, 5540, 5560, 5580, 5600, 5620, 5640, 5660, 5680,
    5700, 5745, 5765, 5785, 5805, 5825
};

static int msglevel = MSG_LEVEL_INFO;

struct iw_statistics *iwctl_get_wireless_stats(struct net_device *dev)
{
    PSDevice pDevice = netdev_priv(dev);
    long ldBm;

    pDevice->wstats.status = pDevice->eOPMode;
    if (pDevice->scStatistic.LinkQuality > 100)
        pDevice->scStatistic.LinkQuality = 100;
    pDevice->wstats.qual.qual =(BYTE)pDevice->scStatistic.LinkQuality;
    RFvRSSITodBm(pDevice, (BYTE)(pDevice->uCurrRSSI), &ldBm);
    pDevice->wstats.qual.level = ldBm;
    pDevice->wstats.qual.noise = 0;
    pDevice->wstats.qual.updated = 1;
    pDevice->wstats.discard.nwid = 0;
    pDevice->wstats.discard.code = 0;
    pDevice->wstats.discard.fragment = 0;
    pDevice->wstats.discard.retries = pDevice->scStatistic.dwTsrErr;
    pDevice->wstats.discard.misc = 0;
    pDevice->wstats.miss.beacon = 0;
    return &pDevice->wstats;
}

/*
 * Wireless Handler: get protocol name
 */
int iwctl_giwname(struct net_device *dev, struct iw_request_info *info,
        char *wrq, char *extra)
{
    strcpy(wrq, "802.11-a/b/g");
    return 0;
}

/*
 * Wireless Handler: set scan
 */
int iwctl_siwscan(struct net_device *dev, struct iw_request_info *info,
        struct iw_point *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
    struct iw_scan_req *req = (struct iw_scan_req *)extra;
    BYTE abyScanSSID[WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1];
    PWLAN_IE_SSID pItemSSID = NULL;

    if (!(pDevice->flags & DEVICE_FLAGS_OPENED))
        return -EINVAL;

    PRINT_K(" SIOCSIWSCAN \n");

    if (pMgmt->eScanState ==  WMAC_IS_SCANNING) {
        // In scanning..
        PRINT_K("SIOCSIWSCAN(overlap??)-->In scanning...\n");
        return -EAGAIN;
    }

    if (pDevice->byReAssocCount > 0) { // reject scan when re-associating!
        // send scan event to wpa_Supplicant
        union iwreq_data wrqu;
        PRINT_K("wireless_send_event--->SIOCGIWSCAN(scan done)\n");
        memset(&wrqu, 0, sizeof(wrqu));
        wireless_send_event(pDevice->dev, SIOCGIWSCAN, &wrqu, NULL);
        return 0;
    }

    spin_lock_irq(&pDevice->lock);

    BSSvClearBSSList((void *)pDevice, pDevice->bLinkPass);

    // mike add: active scan OR passive scan OR desire_ssid scan
    if (wrq->length == sizeof(struct iw_scan_req)) {
        if (wrq->flags & IW_SCAN_THIS_ESSID) { // desire_ssid scan
            memset(abyScanSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
            pItemSSID = (PWLAN_IE_SSID)abyScanSSID;
            pItemSSID->byElementID = WLAN_EID_SSID;
            memcpy(pItemSSID->abySSID, req->essid, (int)req->essid_len);
            if (pItemSSID->abySSID[req->essid_len - 1] == '\0') {
                if (req->essid_len > 0)
                    pItemSSID->len = req->essid_len - 1;
            } else {
                pItemSSID->len = req->essid_len;
            }
            pMgmt->eScanType = WMAC_SCAN_PASSIVE;
            PRINT_K("SIOCSIWSCAN:[desired_ssid=%s,len=%d]\n", ((PWLAN_IE_SSID)abyScanSSID)->abySSID,
                ((PWLAN_IE_SSID)abyScanSSID)->len);
            bScheduleCommand((void *)pDevice, WLAN_CMD_BSSID_SCAN, abyScanSSID);
            spin_unlock_irq(&pDevice->lock);

            return 0;
        } else if (req->scan_type == IW_SCAN_TYPE_PASSIVE) { // passive scan
            pMgmt->eScanType = WMAC_SCAN_PASSIVE;
        }
    } else { // active scan
        pMgmt->eScanType = WMAC_SCAN_ACTIVE;
    }

    pMgmt->eScanType = WMAC_SCAN_PASSIVE;
    bScheduleCommand((void *)pDevice, WLAN_CMD_BSSID_SCAN, NULL);
    spin_unlock_irq(&pDevice->lock);

    return 0;
}

/*
 * Wireless Handler : get scan results
 */
int iwctl_giwscan(struct net_device *dev, struct iw_request_info *info,
        struct iw_point *wrq, char *extra)
{
    int ii;
    int jj;
    int kk;
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
    PKnownBSS pBSS;
    PWLAN_IE_SSID pItemSSID;
    PWLAN_IE_SUPP_RATES pSuppRates;
    PWLAN_IE_SUPP_RATES pExtSuppRates;
    char *current_ev = extra;
    char *end_buf = extra + IW_SCAN_MAX_DATA;
    char *current_val = NULL;
    struct iw_event iwe;
    long ldBm;
    char buf[MAX_WPA_IE_LEN * 2 + 30];

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWSCAN\n");

    if (pMgmt->eScanState ==  WMAC_IS_SCANNING) {
        // In scanning..
        return -EAGAIN;
    }
    pBSS = &(pMgmt->sBSSList[0]);
    for (ii = 0, jj = 0; jj < MAX_BSS_NUM ; jj++) {
        if (current_ev >= end_buf)
            break;
        pBSS = &(pMgmt->sBSSList[jj]);
        if (pBSS->bActive) {
            // ADD mac address
            memset(&iwe, 0, sizeof(iwe));
            iwe.cmd = SIOCGIWAP;
            iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
            memcpy(iwe.u.ap_addr.sa_data, pBSS->abyBSSID, WLAN_BSSID_LEN);
            current_ev = iwe_stream_add_event(info, current_ev, end_buf, &iwe, IW_EV_ADDR_LEN);
            // ADD ssid
            memset(&iwe, 0, sizeof(iwe));
            iwe.cmd = SIOCGIWESSID;
            pItemSSID = (PWLAN_IE_SSID)pBSS->abySSID;
            iwe.u.data.length = pItemSSID->len;
            iwe.u.data.flags = 1;
            current_ev = iwe_stream_add_point(info, current_ev, end_buf, &iwe, pItemSSID->abySSID);
            // ADD mode
            memset(&iwe, 0, sizeof(iwe));
            iwe.cmd = SIOCGIWMODE;
            if (WLAN_GET_CAP_INFO_ESS(pBSS->wCapInfo))
                iwe.u.mode = IW_MODE_INFRA;
            else
                iwe.u.mode = IW_MODE_ADHOC;
            iwe.len = IW_EV_UINT_LEN;
            current_ev = iwe_stream_add_event(info, current_ev, end_buf, &iwe, IW_EV_UINT_LEN);
            // ADD frequency
            pSuppRates = (PWLAN_IE_SUPP_RATES)pBSS->abySuppRates;
            pExtSuppRates = (PWLAN_IE_SUPP_RATES)pBSS->abyExtSuppRates;
            memset(&iwe, 0, sizeof(iwe));
            iwe.cmd = SIOCGIWFREQ;
            iwe.u.freq.m = pBSS->uChannel;
            iwe.u.freq.e = 0;
            iwe.u.freq.i = 0;
            current_ev = iwe_stream_add_event(info, current_ev,end_buf, &iwe, IW_EV_FREQ_LEN);
            {
                int f = (int)pBSS->uChannel - 1;
                if (f < 0)
                    f = 0;
                iwe.u.freq.m = frequency_list[f] * 100000;
                iwe.u.freq.e = 1;
            }
            current_ev = iwe_stream_add_event(info, current_ev, end_buf, &iwe, IW_EV_FREQ_LEN);
            // ADD quality
            memset(&iwe, 0, sizeof(iwe));
            iwe.cmd = IWEVQUAL;
            RFvRSSITodBm(pDevice, (BYTE)(pBSS->uRSSI), &ldBm);
            iwe.u.qual.level = ldBm;
            iwe.u.qual.noise = 0;

            if (-ldBm < 50)
                iwe.u.qual.qual = 100;
            else  if (-ldBm > 90)
                iwe.u.qual.qual = 0;
            else
                iwe.u.qual.qual = (40 - (-ldBm - 50)) * 100 / 40;
            iwe.u.qual.updated = 7;

            current_ev = iwe_stream_add_event(info, current_ev, end_buf, &iwe, IW_EV_QUAL_LEN);
            // ADD encryption
            memset(&iwe, 0, sizeof(iwe));
            iwe.cmd = SIOCGIWENCODE;
            iwe.u.data.length = 0;
            if (WLAN_GET_CAP_INFO_PRIVACY(pBSS->wCapInfo))
                iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
            else
                iwe.u.data.flags = IW_ENCODE_DISABLED;
            current_ev = iwe_stream_add_point(info, current_ev, end_buf, &iwe, pItemSSID->abySSID);

            memset(&iwe, 0, sizeof(iwe));
            iwe.cmd = SIOCGIWRATE;
            iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
            current_val = current_ev + IW_EV_LCP_LEN;

            for (kk = 0; kk < 12; kk++) {
                if (pSuppRates->abyRates[kk] == 0)
                    break;
                // Bit rate given in 500 kb/s units (+ 0x80)
                iwe.u.bitrate.value = ((pSuppRates->abyRates[kk] & 0x7f) * 500000);
                current_val = iwe_stream_add_value(info, current_ev, current_val, end_buf, &iwe, IW_EV_PARAM_LEN);
            }
            for (kk = 0; kk < 8; kk++) {
                if (pExtSuppRates->abyRates[kk] == 0)
                    break;
                // Bit rate given in 500 kb/s units (+ 0x80)
                iwe.u.bitrate.value = ((pExtSuppRates->abyRates[kk] & 0x7f) * 500000);
                current_val = iwe_stream_add_value(info, current_ev, current_val, end_buf, &iwe, IW_EV_PARAM_LEN);
            }

            if ((current_val - current_ev) > IW_EV_LCP_LEN)
                current_ev = current_val;

            memset(&iwe, 0, sizeof(iwe));
            iwe.cmd = IWEVCUSTOM;
            sprintf(buf, "bcn_int=%d", pBSS->wBeaconInterval);
            iwe.u.data.length = strlen(buf);
            current_ev = iwe_stream_add_point(info, current_ev, end_buf, &iwe, buf);

            if ((pBSS->wWPALen > 0) && (pBSS->wWPALen <= MAX_WPA_IE_LEN)) {
                memset(&iwe, 0, sizeof(iwe));
                iwe.cmd = IWEVGENIE;
                iwe.u.data.length = pBSS->wWPALen;
                current_ev = iwe_stream_add_point(info, current_ev, end_buf, &iwe, pBSS->byWPAIE);
            }

            if ((pBSS->wRSNLen > 0) && (pBSS->wRSNLen <= MAX_WPA_IE_LEN)) {
                memset(&iwe, 0, sizeof(iwe));
                iwe.cmd = IWEVGENIE;
                iwe.u.data.length = pBSS->wRSNLen;
                current_ev = iwe_stream_add_point(info, current_ev, end_buf, &iwe, pBSS->byRSNIE);
            }
        }
    } // for
    wrq->length = current_ev - extra;
    return 0;
}

/*
 * Wireless Handler: set frequence or channel
 */
int iwctl_siwfreq(struct net_device *dev, struct iw_request_info *info,
        struct iw_freq *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    int rc = 0;

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWFREQ \n");

    // If setting by frequency, convert to a channel
    if ((wrq->e == 1) && (wrq->m >= (int)2.412e8) &&
        (wrq->m <= (int)2.487e8)) {
        int f = wrq->m / 100000;
        int c = 0;
        while ((c < 14) && (f != frequency_list[c]))
            c++;
        wrq->e = 0;
        wrq->m = c + 1;
    }
    // Setting by channel number
    if ((wrq->m > 14) || (wrq->e > 0)) {
        rc = -EOPNOTSUPP;
    } else {
        int channel = wrq->m;
        if ((channel < 1) || (channel > 14)) {
            DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%s: New channel value of %d is invalid!\n", dev->name, wrq->m);
            rc = -EINVAL;
        } else {
            // Yes ! We can set it !!!
            DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " Set to channel = %d\n", channel);
            pDevice->uChannel = channel;
        }
    }
    return rc;
}

/*
 * Wireless Handler: get frequence or channel
 */
int iwctl_giwfreq(struct net_device *dev, struct iw_request_info *info,
        struct iw_freq *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWFREQ \n");

#ifdef WEXT_USECHANNELS
    wrq->m = (int)pMgmt->uCurrChannel;
    wrq->e = 0;
#else
    {
        int f = (int)pMgmt->uCurrChannel - 1;
        if (f < 0)
            f = 0;
        wrq->m = frequency_list[f] * 100000;
        wrq->e = 1;
    }
#endif
    return 0;
}

/*
 * Wireless Handler: set operation mode
 */
int iwctl_siwmode(struct net_device *dev, struct iw_request_info *info,
        __u32 *wmode, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
    int rc = 0;

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWMODE \n");

    if (pMgmt->eCurrMode == WMAC_MODE_ESS_AP && pDevice->bEnableHostapd) {
        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Can't set operation mode, hostapd is running \n");
        return rc;
    }

    switch (*wmode) {
    case IW_MODE_ADHOC:
        if (pMgmt->eConfigMode != WMAC_CONFIG_IBSS_STA) {
            pMgmt->eConfigMode = WMAC_CONFIG_IBSS_STA;
            if (pDevice->flags & DEVICE_FLAGS_OPENED)
                pDevice->bCommit = TRUE;
        }
        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "set mode to ad-hoc \n");
        break;
    case IW_MODE_AUTO:
    case IW_MODE_INFRA:
        if (pMgmt->eConfigMode != WMAC_CONFIG_ESS_STA) {
            pMgmt->eConfigMode = WMAC_CONFIG_ESS_STA;
            if (pDevice->flags & DEVICE_FLAGS_OPENED)
                pDevice->bCommit = TRUE;
        }
        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "set mode to infrastructure \n");
        break;
    case IW_MODE_MASTER:

        pMgmt->eConfigMode = WMAC_CONFIG_ESS_STA;
        rc = -EOPNOTSUPP;
        break;

        if (pMgmt->eConfigMode != WMAC_CONFIG_AP) {
            pMgmt->eConfigMode = WMAC_CONFIG_AP;
            if (pDevice->flags & DEVICE_FLAGS_OPENED)
                pDevice->bCommit = TRUE;
        }
        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "set mode to Access Point \n");
        break;

    case IW_MODE_REPEAT:
        pMgmt->eConfigMode = WMAC_CONFIG_ESS_STA;
        rc = -EOPNOTSUPP;
        break;
    default:
        rc = -EINVAL;
    }

    return rc;
}

/*
 * Wireless Handler: get operation mode
 */
void iwctl_giwmode(struct net_device *dev, struct iw_request_info *info,
        __u32 *wmode, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWMODE \n");
    // If not managed, assume it's ad-hoc
    switch (pMgmt->eConfigMode) {
    case WMAC_CONFIG_ESS_STA:
        *wmode = IW_MODE_INFRA;
        break;
    case WMAC_CONFIG_IBSS_STA:
        *wmode = IW_MODE_ADHOC;
        break;
    case WMAC_CONFIG_AUTO:
        *wmode = IW_MODE_INFRA;
        break;
    case WMAC_CONFIG_AP:
        *wmode = IW_MODE_MASTER;
        break;
    default:
        *wmode = IW_MODE_ADHOC;
    }
}

/*
 * Wireless Handler: get capability range
 */
void iwctl_giwrange(struct net_device *dev, struct iw_request_info *info,
        struct iw_point *wrq, char *extra)
{
    struct iw_range *range = (struct iw_range *)extra;
    int i;
    int k;
    BYTE abySupportedRates[13] = {
        0x02, 0x04, 0x0B, 0x16, 0x0c, 0x12, 0x18, 0x24, 0x30, 0x48,
        0x60, 0x6C, 0x90
    };

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWRANGE\n");
    if (wrq->pointer) {
        wrq->length = sizeof(struct iw_range);
        memset(range, 0, sizeof(struct iw_range));
        range->min_nwid = 0x0000;
        range->max_nwid = 0x0000;
        range->num_channels = 14;
        // Should be based on cap_rid.country to give only
        // what the current card support
        k = 0;
        for (i = 0; i < 14; i++) {
            range->freq[k].i = i + 1; // List index
            range->freq[k].m = frequency_list[i] * 100000;
            range->freq[k++].e = 1; // Values in table in MHz -> * 10^5 * 10
        }
        range->num_frequency = k;
        // Hum... Should put the right values there
        range->max_qual.qual = 100;
        range->max_qual.level = 0;
        range->max_qual.noise = 0;
        range->sensitivity = 255;

        for (i = 0; i < 13; i++) {
            range->bitrate[i] = abySupportedRates[i] * 500000;
            if (range->bitrate[i] == 0)
                break;
        }
        range->num_bitrates = i;

        // Set an indication of the max TCP throughput
        // in bit/s that we can expect using this interface.
        //  May be use for QoS stuff... Jean II
        if (i > 2)
            range->throughput = 5 * 1000 * 1000;
        else
            range->throughput = 1.5 * 1000 * 1000;

        range->min_rts = 0;
        range->max_rts = 2312;
        range->min_frag = 256;
        range->max_frag = 2312;

        // the encoding capabilities
        range->num_encoding_sizes = 3;
        // 64(40) bits WEP
        range->encoding_size[0] = 5;
        // 128(104) bits WEP
        range->encoding_size[1] = 13;
        // 256 bits for WPA-PSK
        range->encoding_size[2] = 32;
        // 4 keys are allowed
        range->max_encoding_tokens = 4;

        range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
            IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;

        range->min_pmp = 0;
        range->max_pmp = 1000000; // 1 secs
        range->min_pmt = 0;
        range->max_pmt = 1000000; // 1 secs
        range->pmp_flags = IW_POWER_PERIOD;
        range->pmt_flags = IW_POWER_TIMEOUT;
        range->pm_capa = IW_POWER_PERIOD | IW_POWER_TIMEOUT | IW_POWER_ALL_R;

        // Transmit Power - values are in mW
        range->txpower[0] = 100;
        range->num_txpower = 1;
        range->txpower_capa = IW_TXPOW_MWATT;
        range->we_version_source = SUPPORTED_WIRELESS_EXT;
        range->we_version_compiled = WIRELESS_EXT;
        range->retry_capa = IW_RETRY_LIMIT | IW_RETRY_LIFETIME;
        range->retry_flags = IW_RETRY_LIMIT;
        range->r_time_flags = IW_RETRY_LIFETIME;
        range->min_retry = 1;
        range->max_retry = 65535;
        range->min_r_time = 1024;
        range->max_r_time = 65535 * 1024;
        // Experimental measurements - boundary 11/5.5 Mb/s
        // Note : with or without the (local->rssi), results
        //  are somewhat different. - Jean II
        range->avg_qual.qual = 6;
        range->avg_qual.level = 176; // -80 dBm
        range->avg_qual.noise = 0;
    }
}

/*
 * Wireless Handler : set ap mac address
 */
int iwctl_siwap(struct net_device *dev, struct iw_request_info *info,
        struct sockaddr *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
    int rc = 0;
    BYTE ZeroBSSID[WLAN_BSSID_LEN] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };

    PRINT_K(" SIOCSIWAP \n");

    if (wrq->sa_family != ARPHRD_ETHER) {
        rc = -EINVAL;
    } else {
        memcpy(pMgmt->abyDesireBSSID, wrq->sa_data, 6);
        // mike: add
        if ((is_broadcast_ether_addr(pMgmt->abyDesireBSSID)) ||
            (memcmp(pMgmt->abyDesireBSSID, ZeroBSSID, 6) == 0)) {
            PRINT_K("SIOCSIWAP:invalid desired BSSID return!\n");
            return rc;
        }
        // mike add: if desired AP is hidden ssid(there are
        // two same BSSID in list), then ignore,because you
        // don't known which one to be connect with??
        {
            unsigned ii;
            unsigned uSameBssidNum = 0;
            for (ii = 0; ii < MAX_BSS_NUM; ii++) {
                if (pMgmt->sBSSList[ii].bActive &&
                    !compare_ether_addr(pMgmt->sBSSList[ii].abyBSSID,
                            pMgmt->abyDesireBSSID)) {
                    uSameBssidNum++;
                }
            }
            if (uSameBssidNum >= 2) {  //hit: desired AP is in hidden ssid mode!!!
                PRINT_K("SIOCSIWAP:ignore for desired AP in hidden mode\n");
                return rc;
            }
        }

        if (pDevice->flags & DEVICE_FLAGS_OPENED)
            pDevice->bCommit = TRUE;
    }
    return rc;
}

/*
 * Wireless Handler: get ap mac address
 */
int iwctl_giwap(struct net_device *dev, struct iw_request_info *info,
        struct sockaddr *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWAP \n");

    memcpy(wrq->sa_data, pMgmt->abyCurrBSSID, 6);

    if ((pDevice->bLinkPass == FALSE) && (pMgmt->eCurrMode != WMAC_MODE_ESS_AP))
        memset(wrq->sa_data, 0, 6);

    if (pMgmt->eCurrMode == WMAC_MODE_ESS_AP)
        memcpy(wrq->sa_data, pMgmt->abyCurrBSSID, 6);

    wrq->sa_family = ARPHRD_ETHER;
    return 0;
}

/*
 * Wireless Handler: get ap list
 */
int iwctl_giwaplist(struct net_device *dev, struct iw_request_info *info,
        struct iw_point *wrq, char *extra)
{
    int ii;
    int jj;
    int rc = 0;
    struct sockaddr sock[IW_MAX_AP];
    struct iw_quality qual[IW_MAX_AP];
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWAPLIST \n");
    // Only super-user can see AP list

    if (!capable(CAP_NET_ADMIN)) {
        rc = -EPERM;
        return rc;
    }

    if (wrq->pointer) {
        PKnownBSS pBSS = &(pMgmt->sBSSList[0]);

        for (ii = 0, jj= 0; ii < MAX_BSS_NUM; ii++) {
            pBSS = &(pMgmt->sBSSList[ii]);
            if (!pBSS->bActive)
                continue;
            if (jj >= IW_MAX_AP)
                break;
            memcpy(sock[jj].sa_data, pBSS->abyBSSID, 6);
            sock[jj].sa_family = ARPHRD_ETHER;
            qual[jj].level = pBSS->uRSSI;
            qual[jj].qual = qual[jj].noise = 0;
            qual[jj].updated = 2;
            jj++;
        }

        wrq->flags = 1; // Should be defined
        wrq->length = jj;
        memcpy(extra, sock, sizeof(struct sockaddr) * jj);
        memcpy(extra + sizeof(struct sockaddr) * jj, qual, sizeof(struct iw_quality) * jj);
    }
    return rc;
}

/*
 * Wireless Handler: set essid
 */
int iwctl_siwessid(struct net_device *dev, struct iw_request_info *info,
        struct iw_point *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
    PWLAN_IE_SSID pItemSSID;

    if (!(pDevice->flags & DEVICE_FLAGS_OPENED))
        return -EINVAL;

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWESSID :\n");

    pDevice->fWPA_Authened = FALSE;
    // Check if we asked for `any'
    if (wrq->flags == 0) {
        // Just send an empty SSID list
        memset(pMgmt->abyDesireSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
        memset(pMgmt->abyDesireBSSID, 0xFF,6);
        PRINT_K("set essid to 'any' \n");
#ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
        // Unknown desired AP, so here need not associate??
        return 0;
#endif
    } else {
        // Set the SSID
        memset(pMgmt->abyDesireSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
        pItemSSID = (PWLAN_IE_SSID)pMgmt->abyDesireSSID;
        pItemSSID->byElementID = WLAN_EID_SSID;

        memcpy(pItemSSID->abySSID, extra, wrq->length);
        if (pItemSSID->abySSID[wrq->length - 1] == '\0') {
            if (wrq->length>0)
                pItemSSID->len = wrq->length - 1;
        } else {
            pItemSSID->len = wrq->length;
        }
        PRINT_K("set essid to %s \n", pItemSSID->abySSID);

        // mike: need clear desiredBSSID
        if (pItemSSID->len==0) {
            memset(pMgmt->abyDesireBSSID, 0xFF, 6);
            return 0;
        }

#ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
        // Wext wil order another command of siwap to link
        // with desired AP, so here need not associate??
        if (pDevice->bWPASuppWextEnabled == TRUE)  {
            /*******search if  in hidden ssid mode ****/
            PKnownBSS pCurr = NULL;
            BYTE abyTmpDesireSSID[WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1];
            unsigned ii;
            unsigned uSameBssidNum = 0;

            memcpy(abyTmpDesireSSID, pMgmt->abyDesireSSID, sizeof(abyTmpDesireSSID));
            pCurr = BSSpSearchBSSList(pDevice, NULL,
                        abyTmpDesireSSID,
                        pDevice->eConfigPHYMode);

            if (pCurr == NULL) {
                PRINT_K("SIOCSIWESSID:hidden ssid site survey before associate.......\n");
                vResetCommandTimer((void *)pDevice);
                pMgmt->eScanType = WMAC_SCAN_ACTIVE;
                bScheduleCommand((void *)pDevice,
                        WLAN_CMD_BSSID_SCAN,
                        pMgmt->abyDesireSSID);
                bScheduleCommand((void *)pDevice,
                        WLAN_CMD_SSID,
                        pMgmt->abyDesireSSID);
            } else {  // mike: to find out if that desired SSID is a
                // hidden-ssid AP, by means of judging if there
                // are two same BSSID exist in list ?
                for (ii = 0; ii < MAX_BSS_NUM; ii++) {
                    if (pMgmt->sBSSList[ii].bActive &&
                        !compare_ether_addr(pMgmt->sBSSList[ii].abyBSSID,
                                pCurr->abyBSSID)) {
                        uSameBssidNum++;
                    }
                }
                if (uSameBssidNum >= 2) { // hit: desired AP is in hidden ssid mode!!!
                    PRINT_K("SIOCSIWESSID:hidden ssid directly associate.......\n");
                    vResetCommandTimer((void *)pDevice);
                    pMgmt->eScanType = WMAC_SCAN_PASSIVE; // this scan type, you'll submit scan result!
                    bScheduleCommand((void *)pDevice,
                            WLAN_CMD_BSSID_SCAN,
                            pMgmt->abyDesireSSID);
                    bScheduleCommand((void *)pDevice,
                            WLAN_CMD_SSID,
                            pMgmt->abyDesireSSID);
                }
            }
            return 0;
        }
#endif

        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "set essid = %s \n", pItemSSID->abySSID);
    }

    if (pDevice->flags & DEVICE_FLAGS_OPENED)
        pDevice->bCommit = TRUE;

    return 0;
}

/*
 * Wireless Handler: get essid
 */
void iwctl_giwessid(struct net_device *dev, struct iw_request_info *info,
        struct iw_point *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
    PWLAN_IE_SSID pItemSSID;

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWESSID \n");

    // Note: if wrq->u.data.flags != 0, we should get the relevant
    // SSID from the SSID list...

    // Get the current SSID
    pItemSSID = (PWLAN_IE_SSID)pMgmt->abyCurrSSID;
    memcpy(extra, pItemSSID->abySSID, pItemSSID->len);
    extra[pItemSSID->len] = '\0';

        wrq->length = pItemSSID->len;
    wrq->flags = 1; // active
}

/*
 * Wireless Handler: set data rate
 */
int iwctl_siwrate(struct net_device *dev, struct iw_request_info *info,
        struct iw_param *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    int rc = 0;
    u8 brate = 0;
    int i;
    BYTE abySupportedRates[13] = {
        0x02, 0x04, 0x0B, 0x16, 0x0c, 0x12, 0x18, 0x24, 0x30, 0x48,
        0x60, 0x6C, 0x90
    };

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWRATE \n");
    if (!(pDevice->flags & DEVICE_FLAGS_OPENED)) {
        rc = -EINVAL;
        return rc;
    }

    // First: get a valid bit rate value

    // Which type of value
    if ((wrq->value < 13) && (wrq->value >= 0)) {
        // Setting by rate index
        // Find value in the magic rate table
        brate = wrq->value;
    } else {
        // Setting by frequency value
        u8 normvalue = (u8)(wrq->value/500000);

        // Check if rate is valid
        for (i = 0; i < 13; i++) {
            if (normvalue == abySupportedRates[i]) {
                brate = i;
                break;
            }
        }
    }
    // -1 designed the max rate (mostly auto mode)
    if (wrq->value == -1) {
        // Get the highest available rate
        for (i = 0; i < 13; i++) {
            if (abySupportedRates[i] == 0)
                break;
        }
        if (i != 0)
            brate = i - 1;

    }
    // Check that it is valid
    // brate is index of abySupportedRates[]
    if (brate > 13 ) {
        rc = -EINVAL;
        return rc;
    }

    // Now, check if we want a fixed or auto value
    if (wrq->fixed != 0) {
        // Fixed mode
        // One rate, fixed
        pDevice->bFixRate = TRUE;
        if ((pDevice->byBBType == BB_TYPE_11B) && (brate > 3)) {
            pDevice->uConnectionRate = 3;
        } else {
            pDevice->uConnectionRate = brate;
            DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Fixed to Rate %d \n", pDevice->uConnectionRate);
        }
    } else {
        pDevice->bFixRate = FALSE;
        pDevice->uConnectionRate = 13;
    }

    return rc;
}

/*
 * Wireless Handler: get data rate
 */
void iwctl_giwrate(struct net_device *dev, struct iw_request_info *info,
        struct iw_param *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWRATE \n");
    {
        BYTE abySupportedRates[13] = {
            0x02, 0x04, 0x0B, 0x16, 0x0c, 0x12, 0x18, 0x24, 0x30,
            0x48, 0x60, 0x6C, 0x90
        };
        int brate = 0;

        if (pDevice->uConnectionRate < 13) {
            brate = abySupportedRates[pDevice->uConnectionRate];
        } else {
            if (pDevice->byBBType == BB_TYPE_11B)
                brate = 0x16;
            if (pDevice->byBBType == BB_TYPE_11G)
                brate = 0x6C;
            if (pDevice->byBBType == BB_TYPE_11A)
                brate = 0x6C;
        }
        if (pMgmt->eCurrMode == WMAC_MODE_ESS_AP) {
            if (pDevice->byBBType == BB_TYPE_11B)
                brate = 0x16;
            if (pDevice->byBBType == BB_TYPE_11G)
                brate = 0x6C;
            if (pDevice->byBBType == BB_TYPE_11A)
                brate = 0x6C;
        }
            if (pDevice->uConnectionRate == 13)
            brate = abySupportedRates[pDevice->wCurrentRate];
        wrq->value = brate * 500000;
        // If more than one rate, set auto
        if (pDevice->bFixRate == TRUE)
            wrq->fixed = TRUE;
    }
}

/*
 * Wireless Handler: set rts threshold
 */
int iwctl_siwrts(struct net_device *dev, struct iw_param *wrq)
{
    PSDevice pDevice = netdev_priv(dev);

    if ((wrq->value < 0 || wrq->value > 2312) && !wrq->disabled)
        return -EINVAL;

    else if (wrq->disabled)
        pDevice->wRTSThreshold = 2312;
    else
        pDevice->wRTSThreshold = wrq->value;

    return 0;
}

/*
 * Wireless Handler: get rts
 */
int iwctl_giwrts(struct net_device *dev, struct iw_request_info *info,
        struct iw_param *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWRTS \n");
    wrq->value = pDevice->wRTSThreshold;
    wrq->disabled = (wrq->value >= 2312);
    wrq->fixed = 1;
    return 0;
}

/*
 * Wireless Handler: set fragment threshold
 */
int iwctl_siwfrag(struct net_device *dev, struct iw_request_info *info,
        struct iw_param *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    int rc = 0;
    int fthr = wrq->value;

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWFRAG \n");

    if (wrq->disabled)
        fthr = 2312;
    if ((fthr < 256) || (fthr > 2312)) {
        rc = -EINVAL;
    } else {
        fthr &= ~0x1; // Get an even value
        pDevice->wFragmentationThreshold = (u16)fthr;
    }
    return rc;
}

/*
 * Wireless Handler: get fragment threshold
 */
int iwctl_giwfrag(struct net_device *dev, struct iw_request_info *info,
        struct iw_param *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWFRAG \n");
    wrq->value = pDevice->wFragmentationThreshold;
    wrq->disabled = (wrq->value >= 2312);
    wrq->fixed = 1;
    return 0;
}

/*
 * Wireless Handler: set retry threshold
 */
int iwctl_siwretry(struct net_device *dev, struct iw_request_info *info,
        struct iw_param *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    int rc = 0;

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWRETRY \n");

    if (wrq->disabled) {
        rc = -EINVAL;
        return rc;
    }

    if (wrq->flags & IW_RETRY_LIMIT) {
        if (wrq->flags & IW_RETRY_MAX) {
            pDevice->byLongRetryLimit = wrq->value;
        } else if (wrq->flags & IW_RETRY_MIN) {
            pDevice->byShortRetryLimit = wrq->value;
        } else {
            // No modifier : set both
            pDevice->byShortRetryLimit = wrq->value;
            pDevice->byLongRetryLimit = wrq->value;
        }
    }
    if (wrq->flags & IW_RETRY_LIFETIME)
        pDevice->wMaxTransmitMSDULifetime = wrq->value;
    return rc;
}

/*
 * Wireless Handler: get retry threshold
 */
int iwctl_giwretry(struct net_device *dev, struct iw_request_info *info,
        struct iw_param *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWRETRY \n");
    wrq->disabled = 0; // Can't be disabled

    // Note: by default, display the min retry number
    if ((wrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
        wrq->flags = IW_RETRY_LIFETIME;
        wrq->value = (int)pDevice->wMaxTransmitMSDULifetime; // ms
    } else if ((wrq->flags & IW_RETRY_MAX)) {
        wrq->flags = IW_RETRY_LIMIT | IW_RETRY_MAX;
        wrq->value = (int)pDevice->byLongRetryLimit;
    } else {
        wrq->flags = IW_RETRY_LIMIT;
        wrq->value = (int)pDevice->byShortRetryLimit;
        if ((int)pDevice->byShortRetryLimit != (int)pDevice->byLongRetryLimit)
            wrq->flags |= IW_RETRY_MIN;
    }
    return 0;
}

/*
 * Wireless Handler: set encode mode
 */
int iwctl_siwencode(struct net_device *dev, struct iw_request_info *info,
        struct iw_point *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
    DWORD dwKeyIndex = (DWORD)(wrq->flags & IW_ENCODE_INDEX);
    int ii;
    int uu;
    int rc = 0;
    int index = (wrq->flags & IW_ENCODE_INDEX);

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWENCODE \n");

    // Check the size of the key
    if (wrq->length > WLAN_WEP232_KEYLEN) {
        rc = -EINVAL;
        return rc;
    }

    if (dwKeyIndex > WLAN_WEP_NKEYS) {
        rc = -EINVAL;
        return rc;
    }

    if (dwKeyIndex > 0)
        dwKeyIndex--;

    // Send the key to the card
    if (wrq->length > 0) {
        if (wrq->length == WLAN_WEP232_KEYLEN) {
            DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Set 232 bit wep key\n");
        } else if (wrq->length == WLAN_WEP104_KEYLEN) {
            DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Set 104 bit wep key\n");
        } else if (wrq->length == WLAN_WEP40_KEYLEN) {
            DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Set 40 bit wep key, index= %d\n", (int)dwKeyIndex);
        }
        memset(pDevice->abyKey, 0, WLAN_WEP232_KEYLEN);
        memcpy(pDevice->abyKey, extra, wrq->length);

        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"abyKey: ");
        for (ii = 0; ii < wrq->length; ii++)
            DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "%02x ", pDevice->abyKey[ii]);

        if (pDevice->flags & DEVICE_FLAGS_OPENED) {
            spin_lock_irq(&pDevice->lock);
            KeybSetDefaultKey(pDevice,
                    &(pDevice->sKey),
                    dwKeyIndex | (1 << 31),
                    wrq->length, NULL,
                    pDevice->abyKey,
                    KEY_CTL_WEP);
            spin_unlock_irq(&pDevice->lock);
        }
        pDevice->byKeyIndex = (BYTE)dwKeyIndex;
        pDevice->uKeyLength = wrq->length;
        pDevice->bTransmitKey = TRUE;
        pDevice->bEncryptionEnable = TRUE;
        pDevice->eEncryptionStatus = Ndis802_11Encryption1Enabled;

        // Do we want to just set the transmit key index?
        if (index < 4) {
            pDevice->byKeyIndex = index;
        } else if (!(wrq->flags & IW_ENCODE_MODE)) {
            rc = -EINVAL;
            return rc;
        }
    }
    // Read the flags
    if (wrq->flags & IW_ENCODE_DISABLED) {
        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Disable WEP function\n");
        pMgmt->bShareKeyAlgorithm = FALSE;
        pDevice->bEncryptionEnable = FALSE;
        pDevice->eEncryptionStatus = Ndis802_11EncryptionDisabled;
        if (pDevice->flags & DEVICE_FLAGS_OPENED) {
            spin_lock_irq(&pDevice->lock);
            for (uu = 0; uu < MAX_KEY_TABLE; uu++)
                MACvDisableKeyEntry(pDevice, uu);
            spin_unlock_irq(&pDevice->lock);
        }
    }
    if (wrq->flags & IW_ENCODE_RESTRICTED) {
        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Enable WEP & ShareKey System\n");
        pMgmt->bShareKeyAlgorithm = TRUE;
    }
    if (wrq->flags & IW_ENCODE_OPEN) {
        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Enable WEP & Open System\n");
        pMgmt->bShareKeyAlgorithm = FALSE;
    }

#ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT
    memset(pMgmt->abyDesireBSSID, 0xFF, 6);
#endif
    return rc;
}

int iwctl_giwencode(struct net_device *dev, struct iw_request_info *info,
        struct iw_point *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
    char abyKey[WLAN_WEP232_KEYLEN];

    unsigned index = (unsigned)(wrq->flags & IW_ENCODE_INDEX);
    PSKeyItem pKey = NULL;

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWENCODE\n");

    if (index > WLAN_WEP_NKEYS)
        return  -EINVAL;
    if (index < 1) { // get default key
        if (pDevice->byKeyIndex < WLAN_WEP_NKEYS)
            index = pDevice->byKeyIndex;
            else
            index = 0;
    } else {
        index--;
    }

    memset(abyKey, 0, WLAN_WEP232_KEYLEN);
    // Check encryption mode
    wrq->flags = IW_ENCODE_NOKEY;
    // Is WEP enabled ???
    if (pDevice->bEncryptionEnable)
        wrq->flags |= IW_ENCODE_ENABLED;
    else
        wrq->flags |= IW_ENCODE_DISABLED;

    if (pMgmt->bShareKeyAlgorithm)
        wrq->flags |= IW_ENCODE_RESTRICTED;
    else
        wrq->flags |= IW_ENCODE_OPEN;
    wrq->length = 0;

    if ((index == 0) && (pDevice->eEncryptionStatus == Ndis802_11Encryption2Enabled ||
                pDevice->eEncryptionStatus == Ndis802_11Encryption3Enabled)) { // get wpa pairwise  key
        if (KeybGetKey(&(pDevice->sKey), pMgmt->abyCurrBSSID, 0xffffffff, &pKey)) {
            wrq->length = pKey->uKeyLength;
            memcpy(abyKey, pKey->abyKey,    pKey->uKeyLength);
            memcpy(extra,  abyKey, WLAN_WEP232_KEYLEN);
        }
    } else if (KeybGetKey(&(pDevice->sKey), pDevice->abyBroadcastAddr, (BYTE)index, &pKey)) {
        wrq->length = pKey->uKeyLength;
        memcpy(abyKey, pKey->abyKey, pKey->uKeyLength);
        memcpy(extra, abyKey, WLAN_WEP232_KEYLEN);
    }

    wrq->flags |= index + 1;
    return 0;
}

/*
 * Wireless Handler: set power mode
 */
int iwctl_siwpower(struct net_device *dev, struct iw_request_info *info,
        struct iw_param *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
    int rc = 0;

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWPOWER \n");

    if (!(pDevice->flags & DEVICE_FLAGS_OPENED)) {
        rc = -EINVAL;
        return rc;
    }

    if (wrq->disabled) {
        pDevice->ePSMode = WMAC_POWER_CAM;
        PSvDisablePowerSaving(pDevice);
        return rc;
    }
    if ((wrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
        pDevice->ePSMode = WMAC_POWER_FAST;
        PSvEnablePowerSaving((void *)pDevice, pMgmt->wListenInterval);

    } else if ((wrq->flags & IW_POWER_TYPE) == IW_POWER_PERIOD) {
        pDevice->ePSMode = WMAC_POWER_FAST;
        PSvEnablePowerSaving((void *)pDevice, pMgmt->wListenInterval);
    }
    switch (wrq->flags & IW_POWER_MODE) {
    case IW_POWER_UNICAST_R:
        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWPOWER: IW_POWER_UNICAST_R \n");
        rc = -EINVAL;
        break;
    case IW_POWER_ALL_R:
        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWPOWER: IW_POWER_ALL_R \n");
        rc = -EINVAL;
    case IW_POWER_ON:
        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWPOWER: IW_POWER_ON \n");
        break;
    default:
        rc = -EINVAL;
    }

    return rc;
}

/*
 * Wireless Handler: get power mode
 */
int iwctl_giwpower(struct net_device *dev, struct iw_request_info *info,
        struct iw_param *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
    int mode = pDevice->ePSMode;

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWPOWER \n");

    if ((wrq->disabled = (mode == WMAC_POWER_CAM)))
        return 0;

    if ((wrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
        wrq->value = (int)((pMgmt->wListenInterval * pMgmt->wCurrBeaconPeriod) << 10);
        wrq->flags = IW_POWER_TIMEOUT;
    } else {
        wrq->value = (int)((pMgmt->wListenInterval * pMgmt->wCurrBeaconPeriod) << 10);
        wrq->flags = IW_POWER_PERIOD;
    }
    wrq->flags |= IW_POWER_ALL_R;
    return 0;
}

/*
 * Wireless Handler: get Sensitivity
 */
int iwctl_giwsens(struct net_device *dev, struct iw_request_info *info,
        struct iw_param *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    long ldBm;

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCGIWSENS \n");
    if (pDevice->bLinkPass == TRUE) {
        RFvRSSITodBm(pDevice, (BYTE)(pDevice->uCurrRSSI), &ldBm);
        wrq->value = ldBm;
    } else {
        wrq->value = 0;
    }
    wrq->disabled = (wrq->value == 0);
    wrq->fixed = 1;
    return 0;
}

#ifdef WPA_SUPPLICANT_DRIVER_WEXT_SUPPORT

int iwctl_siwauth(struct net_device *dev, struct iw_request_info *info,
        struct iw_param *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
    int ret = 0;
    static int wpa_version = 0; // must be static to save the last value, einsn liu
    static int pairwise = 0;

    DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " SIOCSIWAUTH \n");
    switch (wrq->flags & IW_AUTH_INDEX) {
    case IW_AUTH_WPA_VERSION:
        wpa_version = wrq->value;
        if (wrq->value == IW_AUTH_WPA_VERSION_DISABLED) {
            PRINT_K("iwctl_siwauth:set WPADEV to disable at 1??????\n");
        } else if (wrq->value == IW_AUTH_WPA_VERSION_WPA) {
            PRINT_K("iwctl_siwauth:set WPADEV to WPA1******\n");
        } else {
            PRINT_K("iwctl_siwauth:set WPADEV to WPA2******\n");
        }
        break;
    case IW_AUTH_CIPHER_PAIRWISE:
        pairwise = wrq->value;
        PRINT_K("iwctl_siwauth:set pairwise=%d\n", pairwise);
        if (pairwise == IW_AUTH_CIPHER_CCMP){
            pDevice->eEncryptionStatus = Ndis802_11Encryption3Enabled;
        } else if (pairwise == IW_AUTH_CIPHER_TKIP) {
            pDevice->eEncryptionStatus = Ndis802_11Encryption2Enabled;
        } else if (pairwise == IW_AUTH_CIPHER_WEP40 ||
            pairwise == IW_AUTH_CIPHER_WEP104) {
            pDevice->eEncryptionStatus = Ndis802_11Encryption1Enabled;
        } else if (pairwise == IW_AUTH_CIPHER_NONE) {
            // do nothing, einsn liu
        } else {
            pDevice->eEncryptionStatus = Ndis802_11EncryptionDisabled;
        }
        break;
    case IW_AUTH_CIPHER_GROUP:
        PRINT_K("iwctl_siwauth:set GROUP=%d\n", wrq->value);
        if (wpa_version == IW_AUTH_WPA_VERSION_DISABLED)
            break;
        if (pairwise == IW_AUTH_CIPHER_NONE) {
            if (wrq->value == IW_AUTH_CIPHER_CCMP)
                pDevice->eEncryptionStatus = Ndis802_11Encryption3Enabled;
            else
                pDevice->eEncryptionStatus = Ndis802_11Encryption2Enabled;
        }
        break;
    case IW_AUTH_KEY_MGMT:
        PRINT_K("iwctl_siwauth(wpa_version=%d):set KEY_MGMT=%d\n", wpa_version,wrq->value);
        if (wpa_version == IW_AUTH_WPA_VERSION_WPA2){
            if (wrq->value == IW_AUTH_KEY_MGMT_PSK)
                pMgmt->eAuthenMode = WMAC_AUTH_WPA2PSK;
            else pMgmt->eAuthenMode = WMAC_AUTH_WPA2;
        } else if (wpa_version == IW_AUTH_WPA_VERSION_WPA) {
            if (wrq->value == 0){
                pMgmt->eAuthenMode = WMAC_AUTH_WPANONE;
            } else if (wrq->value == IW_AUTH_KEY_MGMT_PSK)
                pMgmt->eAuthenMode = WMAC_AUTH_WPAPSK;
        } else {
            pMgmt->eAuthenMode = WMAC_AUTH_WPA;
        }
        break;
    case IW_AUTH_TKIP_COUNTERMEASURES:
        break; /* FIXME */
    case IW_AUTH_DROP_UNENCRYPTED:
        break;
    case IW_AUTH_80211_AUTH_ALG:
        PRINT_K("iwctl_siwauth:set AUTH_ALG=%d\n", wrq->value);
        if (wrq->value == IW_AUTH_ALG_OPEN_SYSTEM)
            pMgmt->bShareKeyAlgorithm = FALSE;
        else if (wrq->value == IW_AUTH_ALG_SHARED_KEY)
            pMgmt->bShareKeyAlgorithm = TRUE;
        break;
    case IW_AUTH_WPA_ENABLED:
        break;
    case IW_AUTH_RX_UNENCRYPTED_EAPOL:
        break;
    case IW_AUTH_ROAMING_CONTROL:
        ret = -EOPNOTSUPP;
        break;
    case IW_AUTH_PRIVACY_INVOKED:
        pDevice->bEncryptionEnable = !!wrq->value;
        if (pDevice->bEncryptionEnable == FALSE) {
            wpa_version = 0;
            pairwise = 0;
            pDevice->eEncryptionStatus = Ndis802_11EncryptionDisabled;
            pMgmt->bShareKeyAlgorithm = FALSE;
            pMgmt->eAuthenMode = WMAC_AUTH_OPEN;
            PRINT_K("iwctl_siwauth:set WPADEV to disaable at 2?????\n");
        }
        break;
    default:
        ret = -EOPNOTSUPP;
        break;
    }
    return ret;
}

int iwctl_giwauth(struct net_device *dev, struct iw_request_info *info,
        struct iw_param *wrq, char *extra)
{
    return -EOPNOTSUPP;
}

int iwctl_siwgenie(struct net_device *dev, struct iw_request_info *info,
        struct iw_point *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
    int ret = 0;

    if (wrq->length){
        if ((wrq->length < 2) || (extra[1] + 2 != wrq->length)) {
            ret = -EINVAL;
            goto out;
        }
        if (wrq->length > MAX_WPA_IE_LEN){
            ret = -ENOMEM;
            goto out;
        }
        memset(pMgmt->abyWPAIE, 0, MAX_WPA_IE_LEN);
        if (copy_from_user(pMgmt->abyWPAIE, extra, wrq->length)){
            ret = -EFAULT;
            goto out;
        }
        pMgmt->wWPAIELen = wrq->length;
    } else {
        memset(pMgmt->abyWPAIE, 0, MAX_WPA_IE_LEN);
        pMgmt->wWPAIELen = 0;
    }

out: // not completely ...not necessary in wpa_supplicant 0.5.8
    return ret;
}

int iwctl_giwgenie(struct net_device *dev, struct iw_request_info *info,
        struct iw_point *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
    int ret = 0;
    int space = wrq->length;

    wrq->length = 0;
    if (pMgmt->wWPAIELen > 0) {
        wrq->length = pMgmt->wWPAIELen;
        if (pMgmt->wWPAIELen <= space) {
            if (copy_to_user(extra, pMgmt->abyWPAIE, pMgmt->wWPAIELen)) {
                ret = -EFAULT;
            }
        } else {
            ret = -E2BIG;
        }
    }
    return ret;
}

int iwctl_siwencodeext(struct net_device *dev, struct iw_request_info *info,
        struct iw_point *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
    struct iw_encode_ext *ext = (struct iw_encode_ext*)extra;
    struct viawget_wpa_param *param=NULL;
// original member
    wpa_alg alg_name;
    u8 addr[6];
    int key_idx;
    int set_tx = 0;
    u8 seq[IW_ENCODE_SEQ_MAX_SIZE];
    u8 key[64];
    size_t seq_len = 0;
    size_t key_len = 0;
    u8 *buf;
    size_t blen;
    u8 key_array[64];
    int ret = 0;

    PRINT_K("SIOCSIWENCODEEXT...... \n");

    blen = sizeof(*param);
    buf = kmalloc((int)blen, (int)GFP_KERNEL);
    if (buf == NULL)
        return -ENOMEM;
    memset(buf, 0, blen);
    param = (struct viawget_wpa_param *)buf;

// recover alg_name
    switch (ext->alg) {
    case IW_ENCODE_ALG_NONE:
        alg_name = WPA_ALG_NONE;
        break;
    case IW_ENCODE_ALG_WEP:
        alg_name = WPA_ALG_WEP;
        break;
    case IW_ENCODE_ALG_TKIP:
        alg_name = WPA_ALG_TKIP;
        break;
    case IW_ENCODE_ALG_CCMP:
        alg_name = WPA_ALG_CCMP;
        break;
    default:
        PRINT_K("Unknown alg = %d\n",ext->alg);
        ret= -ENOMEM;
        goto error;
    }
// recover addr
    memcpy(addr, ext->addr.sa_data, ETH_ALEN);
// recover key_idx
    key_idx = (wrq->flags&IW_ENCODE_INDEX) - 1;
// recover set_tx
    if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY)
        set_tx = 1;
// recover seq,seq_len
    if (ext->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) {
        seq_len=IW_ENCODE_SEQ_MAX_SIZE;
        memcpy(seq, ext->rx_seq, seq_len);
    }
// recover key,key_len
    if (ext->key_len) {
        key_len = ext->key_len;
        memcpy(key, &ext->key[0], key_len);
    }
    memset(key_array, 0, 64);
    if (key_len > 0) {
        memcpy(key_array, key, key_len);
        if (key_len == 32) {
            // notice ! the oder
            memcpy(&key_array[16], &key[24], 8);
            memcpy(&key_array[24], &key[16], 8);
        }
    }

/**************Translate iw_encode_ext to viawget_wpa_param****************/
    memcpy(param->addr, addr, ETH_ALEN);
    param->u.wpa_key.alg_name = (int)alg_name;
    param->u.wpa_key.set_tx = set_tx;
    param->u.wpa_key.key_index = key_idx;
    param->u.wpa_key.key_len = key_len;
    param->u.wpa_key.key = (u8 *)key_array;
    param->u.wpa_key.seq = (u8 *)seq;
    param->u.wpa_key.seq_len = seq_len;

/****set if current action is Network Manager count?? */
/****this method is so foolish,but there is no other way??? */
    if (param->u.wpa_key.alg_name == WPA_ALG_NONE) {
        if (param->u.wpa_key.key_index ==0) {
            pDevice->bwextstep0 = TRUE;
        }
        if ((pDevice->bwextstep0 == TRUE) && (param->u.wpa_key.key_index == 1)) {
            pDevice->bwextstep0 = FALSE;
            pDevice->bwextstep1 = TRUE;
        }
        if ((pDevice->bwextstep1 == TRUE) && (param->u.wpa_key.key_index == 2)) {
            pDevice->bwextstep1 = FALSE;
            pDevice->bwextstep2 = TRUE;
        }
        if ((pDevice->bwextstep2 == TRUE) && (param->u.wpa_key.key_index == 3)) {
            pDevice->bwextstep2 = FALSE;
            pDevice->bwextstep3 = TRUE;
        }
    }
    if (pDevice->bwextstep3 == TRUE) {
        PRINT_K("SIOCSIWENCODEEXT:Enable WPA WEXT SUPPORT!!!!!\n");
        pDevice->bwextstep0 = FALSE;
        pDevice->bwextstep1 = FALSE;
        pDevice->bwextstep2 = FALSE;
        pDevice->bwextstep3 = FALSE;
        pDevice->bWPASuppWextEnabled = TRUE;
        memset(pMgmt->abyDesireBSSID, 0xFF, 6);
        KeyvInitTable(pDevice, &pDevice->sKey);
    }
/*******/
    spin_lock_irq(&pDevice->lock);
    ret = wpa_set_keys(pDevice, param, TRUE);
    spin_unlock_irq(&pDevice->lock);

error:
    kfree(param);
    return ret;
}

int iwctl_giwencodeext(struct net_device *dev, struct iw_request_info *info,
        struct iw_point *wrq, char *extra)
{
    return -EOPNOTSUPP;
}

int iwctl_siwmlme(struct net_device *dev, struct iw_request_info *info,
        struct iw_point *wrq, char *extra)
{
    PSDevice pDevice = netdev_priv(dev);
    PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
    struct iw_mlme *mlme = (struct iw_mlme *)extra;
    int ret = 0;

    if (memcmp(pMgmt->abyCurrBSSID, mlme->addr.sa_data, ETH_ALEN)) {
        ret = -EINVAL;
        return ret;
    }
    switch (mlme->cmd){
    case IW_MLME_DEAUTH:
    case IW_MLME_DISASSOC:
        if (pDevice->bLinkPass == TRUE) {
            PRINT_K("iwctl_siwmlme--->send DISASSOCIATE\n");
            bScheduleCommand((void *)pDevice, WLAN_CMD_DISASSOCIATE,
                    NULL);
        }
        break;
    default:
        ret = -EOPNOTSUPP;
    }
    return ret;
}

#endif

static const iw_handler iwctl_handler[] = {
    (iw_handler)NULL, // SIOCSIWCOMMIT
    (iw_handler)NULL, // SIOCGIWNAME
    (iw_handler)NULL, // SIOCSIWNWID
    (iw_handler)NULL, // SIOCGIWNWID
    (iw_handler)NULL, // SIOCSIWFREQ
    (iw_handler)NULL, // SIOCGIWFREQ
    (iw_handler)NULL, // SIOCSIWMODE
    (iw_handler)NULL, // SIOCGIWMODE
    (iw_handler)NULL, // SIOCSIWSENS
    (iw_handler)NULL, // SIOCGIWSENS
    (iw_handler)NULL, // SIOCSIWRANGE
    (iw_handler)iwctl_giwrange, // SIOCGIWRANGE
    (iw_handler)NULL, // SIOCSIWPRIV
    (iw_handler)NULL, // SIOCGIWPRIV
    (iw_handler)NULL, // SIOCSIWSTATS
    (iw_handler)NULL, // SIOCGIWSTATS
    (iw_handler)NULL, // SIOCSIWSPY
    (iw_handler)NULL, // SIOCGIWSPY
    (iw_handler)NULL, // -- hole --
    (iw_handler)NULL, // -- hole --
    (iw_handler)NULL, // SIOCSIWAP
    (iw_handler)NULL, // SIOCGIWAP
    (iw_handler)NULL, // -- hole -- 0x16
    (iw_handler)NULL, // SIOCGIWAPLIST
    (iw_handler)iwctl_siwscan, // SIOCSIWSCAN
    (iw_handler)iwctl_giwscan, // SIOCGIWSCAN
    (iw_handler)NULL, // SIOCSIWESSID
    (iw_handler)NULL, // SIOCGIWESSID
    (iw_handler)NULL, // SIOCSIWNICKN
    (iw_handler)NULL, // SIOCGIWNICKN
    (iw_handler)NULL, // -- hole --
    (iw_handler)NULL, // -- hole --
    (iw_handler)NULL, // SIOCSIWRATE 0x20
    (iw_handler)NULL, // SIOCGIWRATE
    (iw_handler)NULL, // SIOCSIWRTS
    (iw_handler)NULL, // SIOCGIWRTS
    (iw_handler)NULL, // SIOCSIWFRAG
    (iw_handler)NULL, // SIOCGIWFRAG
    (iw_handler)NULL, // SIOCSIWTXPOW
    (iw_handler)NULL, // SIOCGIWTXPOW
    (iw_handler)NULL, // SIOCSIWRETRY
    (iw_handler)NULL, // SIOCGIWRETRY
    (iw_handler)NULL, // SIOCSIWENCODE
    (iw_handler)NULL, // SIOCGIWENCODE
    (iw_handler)NULL, // SIOCSIWPOWER
    (iw_handler)NULL, // SIOCGIWPOWER
    (iw_handler)NULL, // -- hole --
    (iw_handler)NULL, // -- hole --
    (iw_handler)NULL, // SIOCSIWGENIE
    (iw_handler)NULL, // SIOCGIWGENIE
    (iw_handler)NULL, // SIOCSIWAUTH
    (iw_handler)NULL, // SIOCGIWAUTH
    (iw_handler)NULL, // SIOCSIWENCODEEXT
    (iw_handler)NULL, // SIOCGIWENCODEEXT
    (iw_handler)NULL, // SIOCSIWPMKSA
    (iw_handler)NULL, // -- hole --
};

static const iw_handler iwctl_private_handler[] = {
    NULL, // SIOCIWFIRSTPRIV
};

struct iw_priv_args iwctl_private_args[] = {
    { IOCTL_CMD_SET, IW_PRIV_TYPE_CHAR | 1024, 0, "set" },
};

const struct iw_handler_def iwctl_handler_def = {
    .get_wireless_stats = &iwctl_get_wireless_stats,
    .num_standard       = sizeof(iwctl_handler) / sizeof(iw_handler),
    .num_private        = 0,
    .num_private_args   = 0,
    .standard       = (iw_handler *)iwctl_handler,
    .private        = NULL,
    .private_args       = NULL,
};