1b2441318SGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0 2cb3126e6SKarl Relton /* cfg80211 Interface for prism2_usb module */ 36eaf0788STair Rzayev #include "hfa384x.h" 46eaf0788STair Rzayev #include "prism2mgmt.h" 5cb3126e6SKarl Relton 6d34602deSJustin P. Mattock /* Prism2 channel/frequency/bitrate declarations */ 7cb3126e6SKarl Relton static const struct ieee80211_channel prism2_channels[] = { 8cb3126e6SKarl Relton { .center_freq = 2412 }, 9cb3126e6SKarl Relton { .center_freq = 2417 }, 10cb3126e6SKarl Relton { .center_freq = 2422 }, 11cb3126e6SKarl Relton { .center_freq = 2427 }, 12cb3126e6SKarl Relton { .center_freq = 2432 }, 13cb3126e6SKarl Relton { .center_freq = 2437 }, 14cb3126e6SKarl Relton { .center_freq = 2442 }, 15cb3126e6SKarl Relton { .center_freq = 2447 }, 16cb3126e6SKarl Relton { .center_freq = 2452 }, 17cb3126e6SKarl Relton { .center_freq = 2457 }, 18cb3126e6SKarl Relton { .center_freq = 2462 }, 19cb3126e6SKarl Relton { .center_freq = 2467 }, 20cb3126e6SKarl Relton { .center_freq = 2472 }, 21cb3126e6SKarl Relton { .center_freq = 2484 }, 22cb3126e6SKarl Relton }; 23cb3126e6SKarl Relton 24cb3126e6SKarl Relton static const struct ieee80211_rate prism2_rates[] = { 25cb3126e6SKarl Relton { .bitrate = 10 }, 26cb3126e6SKarl Relton { .bitrate = 20 }, 27cb3126e6SKarl Relton { .bitrate = 55 }, 28cb3126e6SKarl Relton { .bitrate = 110 } 29cb3126e6SKarl Relton }; 30cb3126e6SKarl Relton 31cb3126e6SKarl Relton #define PRISM2_NUM_CIPHER_SUITES 2 32cb3126e6SKarl Relton static const u32 prism2_cipher_suites[PRISM2_NUM_CIPHER_SUITES] = { 33cb3126e6SKarl Relton WLAN_CIPHER_SUITE_WEP40, 34cb3126e6SKarl Relton WLAN_CIPHER_SUITE_WEP104 35cb3126e6SKarl Relton }; 36cb3126e6SKarl Relton 37cb3126e6SKarl Relton /* prism2 device private data */ 38cb3126e6SKarl Relton struct prism2_wiphy_private { 39c9573a8dSsayli karnik struct wlandevice *wlandev; 40cb3126e6SKarl Relton 41cb3126e6SKarl Relton struct ieee80211_supported_band band; 42cb3126e6SKarl Relton struct ieee80211_channel channels[ARRAY_SIZE(prism2_channels)]; 43cb3126e6SKarl Relton struct ieee80211_rate rates[ARRAY_SIZE(prism2_rates)]; 44cb3126e6SKarl Relton 45cb3126e6SKarl Relton struct cfg80211_scan_request *scan_request; 46cb3126e6SKarl Relton }; 47cb3126e6SKarl Relton 48cb3126e6SKarl Relton static const void * const prism2_wiphy_privid = &prism2_wiphy_privid; 49cb3126e6SKarl Relton 50cb3126e6SKarl Relton /* Helper Functions */ 51cb3126e6SKarl Relton static int prism2_result2err(int prism2_result) 52cb3126e6SKarl Relton { 53cb3126e6SKarl Relton int err = 0; 54cb3126e6SKarl Relton 55cb3126e6SKarl Relton switch (prism2_result) { 56cb3126e6SKarl Relton case P80211ENUM_resultcode_invalid_parameters: 57cb3126e6SKarl Relton err = -EINVAL; 58cb3126e6SKarl Relton break; 59cb3126e6SKarl Relton case P80211ENUM_resultcode_implementation_failure: 60cb3126e6SKarl Relton err = -EIO; 61cb3126e6SKarl Relton break; 62cb3126e6SKarl Relton case P80211ENUM_resultcode_not_supported: 63cb3126e6SKarl Relton err = -EOPNOTSUPP; 64cb3126e6SKarl Relton break; 65cb3126e6SKarl Relton default: 66cb3126e6SKarl Relton err = 0; 67cb3126e6SKarl Relton break; 68cb3126e6SKarl Relton } 69cb3126e6SKarl Relton 70cb3126e6SKarl Relton return err; 71cb3126e6SKarl Relton } 72cb3126e6SKarl Relton 73c2f4dd43SK Hodges static int prism2_domibset_uint32(struct wlandevice *wlandev, 74c2f4dd43SK Hodges u32 did, u32 data) 75cb3126e6SKarl Relton { 76b6bb56e6SEdgardo Hames struct p80211msg_dot11req_mibset msg; 77b26b2325SSergio Paracuellos struct p80211item_uint32 *mibitem = 78b26b2325SSergio Paracuellos (struct p80211item_uint32 *)&msg.mibattribute.data; 79cb3126e6SKarl Relton 80e409d2bcSTim Collier msg.msgcode = DIDMSG_DOT11REQ_MIBSET; 81cb3126e6SKarl Relton mibitem->did = did; 82cb3126e6SKarl Relton mibitem->data = data; 83cb3126e6SKarl Relton 84cb3126e6SKarl Relton return p80211req_dorequest(wlandev, (u8 *)&msg); 85cb3126e6SKarl Relton } 86cb3126e6SKarl Relton 87c9573a8dSsayli karnik static int prism2_domibset_pstr32(struct wlandevice *wlandev, 88c1e5f471SJohannes Berg u32 did, u8 len, const u8 *data) 89cb3126e6SKarl Relton { 90b6bb56e6SEdgardo Hames struct p80211msg_dot11req_mibset msg; 916a50b5afSSergio Paracuellos struct p80211item_pstr32 *mibitem = 926a50b5afSSergio Paracuellos (struct p80211item_pstr32 *)&msg.mibattribute.data; 93cb3126e6SKarl Relton 94e409d2bcSTim Collier msg.msgcode = DIDMSG_DOT11REQ_MIBSET; 95cb3126e6SKarl Relton mibitem->did = did; 96cb3126e6SKarl Relton mibitem->data.len = len; 97cb3126e6SKarl Relton memcpy(mibitem->data.data, data, len); 98cb3126e6SKarl Relton 99cb3126e6SKarl Relton return p80211req_dorequest(wlandev, (u8 *)&msg); 100cb3126e6SKarl Relton } 101cb3126e6SKarl Relton 102cb3126e6SKarl Relton /* The interface functions, called by the cfg80211 layer */ 10355da06ebSTeodora Baluta static int prism2_change_virtual_intf(struct wiphy *wiphy, 104cb3126e6SKarl Relton struct net_device *dev, 105818a986eSJohannes Berg enum nl80211_iftype type, 106cb3126e6SKarl Relton struct vif_params *params) 107cb3126e6SKarl Relton { 108c9573a8dSsayli karnik struct wlandevice *wlandev = dev->ml_priv; 109cb3126e6SKarl Relton u32 data; 110cb3126e6SKarl Relton int result; 111cb3126e6SKarl Relton int err = 0; 112cb3126e6SKarl Relton 113cb3126e6SKarl Relton switch (type) { 114cb3126e6SKarl Relton case NL80211_IFTYPE_ADHOC: 1158dd82ebeSEdgardo Hames if (wlandev->macmode == WLAN_MACMODE_IBSS_STA) 1168dd82ebeSEdgardo Hames goto exit; 117cb3126e6SKarl Relton wlandev->macmode = WLAN_MACMODE_IBSS_STA; 118cb3126e6SKarl Relton data = 0; 119cb3126e6SKarl Relton break; 120cb3126e6SKarl Relton case NL80211_IFTYPE_STATION: 1218dd82ebeSEdgardo Hames if (wlandev->macmode == WLAN_MACMODE_ESS_STA) 1228dd82ebeSEdgardo Hames goto exit; 123cb3126e6SKarl Relton wlandev->macmode = WLAN_MACMODE_ESS_STA; 124cb3126e6SKarl Relton data = 1; 125cb3126e6SKarl Relton break; 126cb3126e6SKarl Relton default: 127eed88971SAvinash Kumar netdev_warn(dev, "Operation mode: %d not support\n", type); 128cb3126e6SKarl Relton return -EOPNOTSUPP; 129cb3126e6SKarl Relton } 130cb3126e6SKarl Relton 131cb3126e6SKarl Relton /* Set Operation mode to the PORT TYPE RID */ 1328aac4d44SDevendra Naga result = prism2_domibset_uint32(wlandev, 133a4857d8bSTim Collier DIDMIB_P2_STATIC_CNFPORTTYPE, 1348aac4d44SDevendra Naga data); 135cb3126e6SKarl Relton 136cb3126e6SKarl Relton if (result) 137cb3126e6SKarl Relton err = -EFAULT; 138cb3126e6SKarl Relton 139cb3126e6SKarl Relton dev->ieee80211_ptr->iftype = type; 140cb3126e6SKarl Relton 141cb3126e6SKarl Relton exit: 142cb3126e6SKarl Relton return err; 143cb3126e6SKarl Relton } 144cb3126e6SKarl Relton 14555da06ebSTeodora Baluta static int prism2_add_key(struct wiphy *wiphy, struct net_device *dev, 14634a488c1SBen Hutchings u8 key_index, bool pairwise, const u8 *mac_addr, 1478dd82ebeSEdgardo Hames struct key_params *params) 1488dd82ebeSEdgardo Hames { 149c9573a8dSsayli karnik struct wlandevice *wlandev = dev->ml_priv; 150cb3126e6SKarl Relton u32 did; 151cb3126e6SKarl Relton 1520ca6d8e7SClaudiu Beznea if (key_index >= NUM_WEPKEYS) 1530ca6d8e7SClaudiu Beznea return -EINVAL; 1540ca6d8e7SClaudiu Beznea 1556b142341SChris Opperman if (params->cipher != WLAN_CIPHER_SUITE_WEP40 && 1566b142341SChris Opperman params->cipher != WLAN_CIPHER_SUITE_WEP104) { 1576b142341SChris Opperman pr_debug("Unsupported cipher suite\n"); 1586b142341SChris Opperman return -EFAULT; 1596b142341SChris Opperman } 1606b142341SChris Opperman 1616b142341SChris Opperman if (prism2_domibset_uint32(wlandev, 162eeeeacd8STim Collier DIDMIB_DOT11SMT_PRIVACYTABLE_WEPDEFAULTKEYID, 1636b142341SChris Opperman key_index)) 1646b142341SChris Opperman return -EFAULT; 165cb3126e6SKarl Relton 166cb3126e6SKarl Relton /* send key to driver */ 167ce0f34e4STim Collier did = didmib_dot11smt_wepdefaultkeystable_key(key_index + 1); 168cb3126e6SKarl Relton 1696b142341SChris Opperman if (prism2_domibset_pstr32(wlandev, did, params->key_len, params->key)) 1706b142341SChris Opperman return -EFAULT; 1716b142341SChris Opperman return 0; 172cb3126e6SKarl Relton } 173cb3126e6SKarl Relton 17455da06ebSTeodora Baluta static int prism2_get_key(struct wiphy *wiphy, struct net_device *dev, 17555da06ebSTeodora Baluta u8 key_index, bool pairwise, 17655da06ebSTeodora Baluta const u8 *mac_addr, void *cookie, 1778dd82ebeSEdgardo Hames void (*callback)(void *cookie, struct key_params*)) 1788dd82ebeSEdgardo Hames { 179c9573a8dSsayli karnik struct wlandevice *wlandev = dev->ml_priv; 180cb3126e6SKarl Relton struct key_params params; 181cb3126e6SKarl Relton int len; 182cb3126e6SKarl Relton 1838dd82ebeSEdgardo Hames if (key_index >= NUM_WEPKEYS) 1848dd82ebeSEdgardo Hames return -EINVAL; 185cb3126e6SKarl Relton 186cb3126e6SKarl Relton len = wlandev->wep_keylens[key_index]; 187cb3126e6SKarl Relton memset(¶ms, 0, sizeof(params)); 188cb3126e6SKarl Relton 1898dd82ebeSEdgardo Hames if (len == 13) 190cb3126e6SKarl Relton params.cipher = WLAN_CIPHER_SUITE_WEP104; 1918dd82ebeSEdgardo Hames else if (len == 5) 192cb3126e6SKarl Relton params.cipher = WLAN_CIPHER_SUITE_WEP104; 1938dd82ebeSEdgardo Hames else 1948dd82ebeSEdgardo Hames return -ENOENT; 195cb3126e6SKarl Relton params.key_len = len; 196cb3126e6SKarl Relton params.key = wlandev->wep_keys[key_index]; 197aff3ea4eSKarl Relton params.seq_len = 0; 198cb3126e6SKarl Relton 199cb3126e6SKarl Relton callback(cookie, ¶ms); 2008dd82ebeSEdgardo Hames 201cb3126e6SKarl Relton return 0; 202cb3126e6SKarl Relton } 203cb3126e6SKarl Relton 20455da06ebSTeodora Baluta static int prism2_del_key(struct wiphy *wiphy, struct net_device *dev, 20534a488c1SBen Hutchings u8 key_index, bool pairwise, const u8 *mac_addr) 2068dd82ebeSEdgardo Hames { 207c9573a8dSsayli karnik struct wlandevice *wlandev = dev->ml_priv; 208cb3126e6SKarl Relton u32 did; 209cb3126e6SKarl Relton int err = 0; 210cb3126e6SKarl Relton int result = 0; 211cb3126e6SKarl Relton 212cb3126e6SKarl Relton /* There is no direct way in the hardware (AFAIK) of removing 21335028fe1SGavin O'Leary * a key, so we will cheat by setting the key to a bogus value 21435028fe1SGavin O'Leary */ 21535028fe1SGavin O'Leary 2160ca6d8e7SClaudiu Beznea if (key_index >= NUM_WEPKEYS) 2170ca6d8e7SClaudiu Beznea return -EINVAL; 2180ca6d8e7SClaudiu Beznea 219cb3126e6SKarl Relton /* send key to driver */ 220ce0f34e4STim Collier did = didmib_dot11smt_wepdefaultkeystable_key(key_index + 1); 221cb3126e6SKarl Relton result = prism2_domibset_pstr32(wlandev, did, 13, "0000000000000"); 222cb3126e6SKarl Relton 2238dd82ebeSEdgardo Hames if (result) 2248dd82ebeSEdgardo Hames err = -EFAULT; 225cb3126e6SKarl Relton 226cb3126e6SKarl Relton return err; 227cb3126e6SKarl Relton } 228cb3126e6SKarl Relton 22955da06ebSTeodora Baluta static int prism2_set_default_key(struct wiphy *wiphy, struct net_device *dev, 2309005fcd8SHarry Wei u8 key_index, bool unicast, bool multicast) 2318dd82ebeSEdgardo Hames { 232c9573a8dSsayli karnik struct wlandevice *wlandev = dev->ml_priv; 233cb3126e6SKarl Relton 234f0f74b45SHariprasad Kelam return prism2_domibset_uint32(wlandev, 235eeeeacd8STim Collier DIDMIB_DOT11SMT_PRIVACYTABLE_WEPDEFAULTKEYID, 236cb3126e6SKarl Relton key_index); 237cb3126e6SKarl Relton } 238cb3126e6SKarl Relton 23955da06ebSTeodora Baluta static int prism2_get_station(struct wiphy *wiphy, struct net_device *dev, 2403b3a0162SJohannes Berg const u8 *mac, struct station_info *sinfo) 2418dd82ebeSEdgardo Hames { 242c9573a8dSsayli karnik struct wlandevice *wlandev = dev->ml_priv; 243b6bb56e6SEdgardo Hames struct p80211msg_lnxreq_commsquality quality; 244cb3126e6SKarl Relton int result; 245cb3126e6SKarl Relton 246cb3126e6SKarl Relton memset(sinfo, 0, sizeof(*sinfo)); 247cb3126e6SKarl Relton 248e52f2149SSandhya Bankar if (!wlandev || (wlandev->msdstate != WLAN_MSD_RUNNING)) 249cb3126e6SKarl Relton return -EOPNOTSUPP; 250cb3126e6SKarl Relton 251cb3126e6SKarl Relton /* build request message */ 2523b6ee123STim Collier quality.msgcode = DIDMSG_LNXREQ_COMMSQUALITY; 253cb3126e6SKarl Relton quality.dbm.data = P80211ENUM_truth_true; 254cb3126e6SKarl Relton quality.dbm.status = P80211ENUM_msgitem_status_data_ok; 255cb3126e6SKarl Relton 256cb3126e6SKarl Relton /* send message to nsd */ 257e52f2149SSandhya Bankar if (!wlandev->mlmerequest) 258cb3126e6SKarl Relton return -EOPNOTSUPP; 259cb3126e6SKarl Relton 2603d049431SEdgardo Hames result = wlandev->mlmerequest(wlandev, (struct p80211msg *)&quality); 261cb3126e6SKarl Relton 262cb3126e6SKarl Relton if (result == 0) { 263cb3126e6SKarl Relton sinfo->txrate.legacy = quality.txrate.data; 2645c6a5eb3SOmer Efrat sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_BITRATE); 265cb3126e6SKarl Relton sinfo->signal = quality.level.data; 2665c6a5eb3SOmer Efrat sinfo->filled |= BIT_ULL(NL80211_STA_INFO_SIGNAL); 267cb3126e6SKarl Relton } 268cb3126e6SKarl Relton 269cb3126e6SKarl Relton return result; 270cb3126e6SKarl Relton } 271cb3126e6SKarl Relton 272bb1da756SHimangi Saraogi static int prism2_scan(struct wiphy *wiphy, 273bb1da756SHimangi Saraogi struct cfg80211_scan_request *request) 274cb3126e6SKarl Relton { 2755d5d7c3bSEmil Goode struct net_device *dev; 276cb3126e6SKarl Relton struct prism2_wiphy_private *priv = wiphy_priv(wiphy); 277c9573a8dSsayli karnik struct wlandevice *wlandev; 278b6bb56e6SEdgardo Hames struct p80211msg_dot11req_scan msg1; 279b6bb56e6SEdgardo Hames struct p80211msg_dot11req_scan_results msg2; 28019f798adSKrzysztof Wilczynski struct cfg80211_bss *bss; 2811d76250bSAvraham Stern struct cfg80211_scan_info info = {}; 2821d76250bSAvraham Stern 283cb3126e6SKarl Relton int result; 284cb3126e6SKarl Relton int err = 0; 285cb3126e6SKarl Relton int numbss = 0; 286cb3126e6SKarl Relton int i = 0; 287cb3126e6SKarl Relton u8 ie_buf[46]; 288cb3126e6SKarl Relton int ie_len; 289cb3126e6SKarl Relton 290cb3126e6SKarl Relton if (!request) 291cb3126e6SKarl Relton return -EINVAL; 292cb3126e6SKarl Relton 2935d5d7c3bSEmil Goode dev = request->wdev->netdev; 2945d5d7c3bSEmil Goode wlandev = dev->ml_priv; 2955d5d7c3bSEmil Goode 296cb3126e6SKarl Relton if (priv->scan_request && priv->scan_request != request) 297cb3126e6SKarl Relton return -EBUSY; 298cb3126e6SKarl Relton 299cb3126e6SKarl Relton if (wlandev->macmode == WLAN_MACMODE_ESS_AP) { 300eed88971SAvinash Kumar netdev_err(dev, "Can't scan in AP mode\n"); 301cb3126e6SKarl Relton return -EOPNOTSUPP; 302cb3126e6SKarl Relton } 303cb3126e6SKarl Relton 304cb3126e6SKarl Relton priv->scan_request = request; 305cb3126e6SKarl Relton 30689e13b45SSergio Paracuellos memset(&msg1, 0x00, sizeof(msg1)); 3071ffaa906STim Collier msg1.msgcode = DIDMSG_DOT11REQ_SCAN; 308cb3126e6SKarl Relton msg1.bsstype.data = P80211ENUM_bsstype_any; 309cb3126e6SKarl Relton 310625aeb3aSDan Carpenter memset(&msg1.bssid.data.data, 0xFF, sizeof(msg1.bssid.data.data)); 311cb3126e6SKarl Relton msg1.bssid.data.len = 6; 312cb3126e6SKarl Relton 313cb3126e6SKarl Relton if (request->n_ssids > 0) { 314cb3126e6SKarl Relton msg1.scantype.data = P80211ENUM_scantype_active; 315cb3126e6SKarl Relton msg1.ssid.data.len = request->ssids->ssid_len; 3168aac4d44SDevendra Naga memcpy(msg1.ssid.data.data, 3178aac4d44SDevendra Naga request->ssids->ssid, request->ssids->ssid_len); 318cb3126e6SKarl Relton } else { 319cb3126e6SKarl Relton msg1.scantype.data = 0; 320cb3126e6SKarl Relton } 321cb3126e6SKarl Relton msg1.probedelay.data = 0; 322cb3126e6SKarl Relton 323cb3126e6SKarl Relton for (i = 0; 324cb3126e6SKarl Relton (i < request->n_channels) && i < ARRAY_SIZE(prism2_channels); 325cb3126e6SKarl Relton i++) 326cb3126e6SKarl Relton msg1.channellist.data.data[i] = 327bb1da756SHimangi Saraogi ieee80211_frequency_to_channel( 328bb1da756SHimangi Saraogi request->channels[i]->center_freq); 329cb3126e6SKarl Relton msg1.channellist.data.len = request->n_channels; 330cb3126e6SKarl Relton 331cb3126e6SKarl Relton msg1.maxchanneltime.data = 250; 332cb3126e6SKarl Relton msg1.minchanneltime.data = 200; 333cb3126e6SKarl Relton 334cb3126e6SKarl Relton result = p80211req_dorequest(wlandev, (u8 *)&msg1); 335cb3126e6SKarl Relton if (result) { 336cb3126e6SKarl Relton err = prism2_result2err(msg1.resultcode.data); 337cb3126e6SKarl Relton goto exit; 338cb3126e6SKarl Relton } 339cb3126e6SKarl Relton /* Now retrieve scan results */ 340cb3126e6SKarl Relton numbss = msg1.numbss.data; 341cb3126e6SKarl Relton 342cb3126e6SKarl Relton for (i = 0; i < numbss; i++) { 3434e5e9d7cSZhao, Gang int freq; 3444e5e9d7cSZhao, Gang 345cb3126e6SKarl Relton memset(&msg2, 0, sizeof(msg2)); 346e3186790STim Collier msg2.msgcode = DIDMSG_DOT11REQ_SCAN_RESULTS; 347cb3126e6SKarl Relton msg2.bssindex.data = i; 348cb3126e6SKarl Relton 349cb3126e6SKarl Relton result = p80211req_dorequest(wlandev, (u8 *)&msg2); 350cb3126e6SKarl Relton if ((result != 0) || 351cb3126e6SKarl Relton (msg2.resultcode.data != P80211ENUM_resultcode_success)) { 352cb3126e6SKarl Relton break; 353cb3126e6SKarl Relton } 354cb3126e6SKarl Relton 355cb3126e6SKarl Relton ie_buf[0] = WLAN_EID_SSID; 356cb3126e6SKarl Relton ie_buf[1] = msg2.ssid.data.len; 357cb3126e6SKarl Relton ie_len = ie_buf[1] + 2; 358efffed8eSsayli karnik memcpy(&ie_buf[2], &msg2.ssid.data.data, msg2.ssid.data.len); 3594e5e9d7cSZhao, Gang freq = ieee80211_channel_to_frequency(msg2.dschannel.data, 36057fbcce3SJohannes Berg NL80211_BAND_2GHZ); 36119f798adSKrzysztof Wilczynski bss = cfg80211_inform_bss(wiphy, 3624e5e9d7cSZhao, Gang ieee80211_get_channel(wiphy, freq), 3635bc8c1f2SJohannes Berg CFG80211_BSS_FTYPE_UNKNOWN, 364efffed8eSsayli karnik (const u8 *)&msg2.bssid.data.data, 365cb3126e6SKarl Relton msg2.timestamp.data, msg2.capinfo.data, 366cb3126e6SKarl Relton msg2.beaconperiod.data, 367cb3126e6SKarl Relton ie_buf, 368cb3126e6SKarl Relton ie_len, 369cb3126e6SKarl Relton (msg2.signal.data - 65536) * 100, /* Conversion to signed type */ 370cb3126e6SKarl Relton GFP_KERNEL 371cb3126e6SKarl Relton ); 37219f798adSKrzysztof Wilczynski 37319f798adSKrzysztof Wilczynski if (!bss) { 37419f798adSKrzysztof Wilczynski err = -ENOMEM; 37519f798adSKrzysztof Wilczynski goto exit; 37619f798adSKrzysztof Wilczynski } 37719f798adSKrzysztof Wilczynski 3785b112d3dSJohannes Berg cfg80211_put_bss(wiphy, bss); 379cb3126e6SKarl Relton } 380cb3126e6SKarl Relton 3818dd82ebeSEdgardo Hames if (result) 382cb3126e6SKarl Relton err = prism2_result2err(msg2.resultcode.data); 383cb3126e6SKarl Relton 384cb3126e6SKarl Relton exit: 3851d76250bSAvraham Stern info.aborted = !!(err); 3861d76250bSAvraham Stern cfg80211_scan_done(request, &info); 387cb3126e6SKarl Relton priv->scan_request = NULL; 388cb3126e6SKarl Relton return err; 389cb3126e6SKarl Relton } 390cb3126e6SKarl Relton 39155da06ebSTeodora Baluta static int prism2_set_wiphy_params(struct wiphy *wiphy, u32 changed) 3928dd82ebeSEdgardo Hames { 393cb3126e6SKarl Relton struct prism2_wiphy_private *priv = wiphy_priv(wiphy); 394c9573a8dSsayli karnik struct wlandevice *wlandev = priv->wlandev; 395cb3126e6SKarl Relton u32 data; 396cb3126e6SKarl Relton int result; 397cb3126e6SKarl Relton int err = 0; 398cb3126e6SKarl Relton 399cb3126e6SKarl Relton if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 400cb3126e6SKarl Relton if (wiphy->rts_threshold == -1) 401cb3126e6SKarl Relton data = 2347; 402cb3126e6SKarl Relton else 403cb3126e6SKarl Relton data = wiphy->rts_threshold; 404cb3126e6SKarl Relton 4058dd82ebeSEdgardo Hames result = prism2_domibset_uint32(wlandev, 406334e5e68STim Collier DIDMIB_DOT11MAC_OPERATIONTABLE_RTSTHRESHOLD, 407cb3126e6SKarl Relton data); 408cb3126e6SKarl Relton if (result) { 409cb3126e6SKarl Relton err = -EFAULT; 410cb3126e6SKarl Relton goto exit; 411cb3126e6SKarl Relton } 412cb3126e6SKarl Relton } 413cb3126e6SKarl Relton 414cb3126e6SKarl Relton if (changed & WIPHY_PARAM_FRAG_THRESHOLD) { 415cb3126e6SKarl Relton if (wiphy->frag_threshold == -1) 416cb3126e6SKarl Relton data = 2346; 417cb3126e6SKarl Relton else 418cb3126e6SKarl Relton data = wiphy->frag_threshold; 419cb3126e6SKarl Relton 4208dd82ebeSEdgardo Hames result = prism2_domibset_uint32(wlandev, 42104bbfc2aSTim Collier DIDMIB_DOT11MAC_OPERATIONTABLE_FRAGMENTATIONTHRESHOLD, 422cb3126e6SKarl Relton data); 423cb3126e6SKarl Relton if (result) { 424cb3126e6SKarl Relton err = -EFAULT; 425cb3126e6SKarl Relton goto exit; 426cb3126e6SKarl Relton } 427cb3126e6SKarl Relton } 428cb3126e6SKarl Relton 429cb3126e6SKarl Relton exit: 430cb3126e6SKarl Relton return err; 431cb3126e6SKarl Relton } 432cb3126e6SKarl Relton 43355da06ebSTeodora Baluta static int prism2_connect(struct wiphy *wiphy, struct net_device *dev, 4348dd82ebeSEdgardo Hames struct cfg80211_connect_params *sme) 4358dd82ebeSEdgardo Hames { 436c9573a8dSsayli karnik struct wlandevice *wlandev = dev->ml_priv; 437cb3126e6SKarl Relton struct ieee80211_channel *channel = sme->channel; 438b6bb56e6SEdgardo Hames struct p80211msg_lnxreq_autojoin msg_join; 439cb3126e6SKarl Relton u32 did; 440cb3126e6SKarl Relton int length = sme->ssid_len; 441cb3126e6SKarl Relton int chan = -1; 442cb3126e6SKarl Relton int is_wep = (sme->crypto.cipher_group == WLAN_CIPHER_SUITE_WEP40) || 443cb3126e6SKarl Relton (sme->crypto.cipher_group == WLAN_CIPHER_SUITE_WEP104); 444cb3126e6SKarl Relton int result; 445cb3126e6SKarl Relton int err = 0; 446cb3126e6SKarl Relton 447cb3126e6SKarl Relton /* Set the channel */ 448cb3126e6SKarl Relton if (channel) { 449cb3126e6SKarl Relton chan = ieee80211_frequency_to_channel(channel->center_freq); 4508dd82ebeSEdgardo Hames result = prism2_domibset_uint32(wlandev, 45193d5a1dcSTim Collier DIDMIB_DOT11PHY_DSSSTABLE_CURRENTCHANNEL, 452cb3126e6SKarl Relton chan); 4538dd82ebeSEdgardo Hames if (result) 4548dd82ebeSEdgardo Hames goto exit; 455cb3126e6SKarl Relton } 456cb3126e6SKarl Relton 457d34602deSJustin P. Mattock /* Set the authorization */ 458cb3126e6SKarl Relton if ((sme->auth_type == NL80211_AUTHTYPE_OPEN_SYSTEM) || 459cb3126e6SKarl Relton ((sme->auth_type == NL80211_AUTHTYPE_AUTOMATIC) && !is_wep)) 460cb3126e6SKarl Relton msg_join.authtype.data = P80211ENUM_authalg_opensystem; 461cb3126e6SKarl Relton else if ((sme->auth_type == NL80211_AUTHTYPE_SHARED_KEY) || 462cb3126e6SKarl Relton ((sme->auth_type == NL80211_AUTHTYPE_AUTOMATIC) && is_wep)) 463cb3126e6SKarl Relton msg_join.authtype.data = P80211ENUM_authalg_sharedkey; 4648dd82ebeSEdgardo Hames else 465eed88971SAvinash Kumar netdev_warn(dev, 4668dd82ebeSEdgardo Hames "Unhandled authorisation type for connect (%d)\n", 4678dd82ebeSEdgardo Hames sme->auth_type); 468cb3126e6SKarl Relton 469cb3126e6SKarl Relton /* Set the encryption - we only support wep */ 470cb3126e6SKarl Relton if (is_wep) { 471cb3126e6SKarl Relton if (sme->key) { 472153c5d81SColin Ian King if (sme->key_idx >= NUM_WEPKEYS) 473153c5d81SColin Ian King return -EINVAL; 4740ca6d8e7SClaudiu Beznea 475cb3126e6SKarl Relton result = prism2_domibset_uint32(wlandev, 476eeeeacd8STim Collier DIDMIB_DOT11SMT_PRIVACYTABLE_WEPDEFAULTKEYID, 477cb3126e6SKarl Relton sme->key_idx); 4788dd82ebeSEdgardo Hames if (result) 4798dd82ebeSEdgardo Hames goto exit; 480cb3126e6SKarl Relton 481cb3126e6SKarl Relton /* send key to driver */ 482ce0f34e4STim Collier did = didmib_dot11smt_wepdefaultkeystable_key( 4830ca6d8e7SClaudiu Beznea sme->key_idx + 1); 4848aac4d44SDevendra Naga result = prism2_domibset_pstr32(wlandev, 4858aac4d44SDevendra Naga did, sme->key_len, 4868aac4d44SDevendra Naga (u8 *)sme->key); 4878dd82ebeSEdgardo Hames if (result) 4888dd82ebeSEdgardo Hames goto exit; 489cb3126e6SKarl Relton } 490cb3126e6SKarl Relton 491cb3126e6SKarl Relton /* Assume we should set privacy invoked and exclude unencrypted 49235028fe1SGavin O'Leary * We could possible use sme->privacy here, but the assumption 49335028fe1SGavin O'Leary * seems reasonable anyways 49435028fe1SGavin O'Leary */ 4958dd82ebeSEdgardo Hames result = prism2_domibset_uint32(wlandev, 496184fcaa1STim Collier DIDMIB_DOT11SMT_PRIVACYTABLE_PRIVACYINVOKED, 497cb3126e6SKarl Relton P80211ENUM_truth_true); 4988dd82ebeSEdgardo Hames if (result) 4998dd82ebeSEdgardo Hames goto exit; 5008dd82ebeSEdgardo Hames 5018dd82ebeSEdgardo Hames result = prism2_domibset_uint32(wlandev, 5022ddc995dSTim Collier DIDMIB_DOT11SMT_PRIVACYTABLE_EXCLUDEUNENCRYPTED, 503cb3126e6SKarl Relton P80211ENUM_truth_true); 5048dd82ebeSEdgardo Hames if (result) 5058dd82ebeSEdgardo Hames goto exit; 506cb3126e6SKarl Relton 507cb3126e6SKarl Relton } else { 5088dd82ebeSEdgardo Hames /* Assume we should unset privacy invoked 50935028fe1SGavin O'Leary * and exclude unencrypted 51035028fe1SGavin O'Leary */ 5118dd82ebeSEdgardo Hames result = prism2_domibset_uint32(wlandev, 512184fcaa1STim Collier DIDMIB_DOT11SMT_PRIVACYTABLE_PRIVACYINVOKED, 513cb3126e6SKarl Relton P80211ENUM_truth_false); 5148dd82ebeSEdgardo Hames if (result) 5158dd82ebeSEdgardo Hames goto exit; 5168dd82ebeSEdgardo Hames 5178dd82ebeSEdgardo Hames result = prism2_domibset_uint32(wlandev, 5182ddc995dSTim Collier DIDMIB_DOT11SMT_PRIVACYTABLE_EXCLUDEUNENCRYPTED, 519cb3126e6SKarl Relton P80211ENUM_truth_false); 5208dd82ebeSEdgardo Hames if (result) 5218dd82ebeSEdgardo Hames goto exit; 522cb3126e6SKarl Relton } 523cb3126e6SKarl Relton 524cb3126e6SKarl Relton /* Now do the actual join. Note there is no way that I can 5254f9de774SGavin O'Leary * see to request a specific bssid 5264f9de774SGavin O'Leary */ 527b1f1118bSTim Collier msg_join.msgcode = DIDMSG_LNXREQ_AUTOJOIN; 528cb3126e6SKarl Relton 529cb3126e6SKarl Relton memcpy(msg_join.ssid.data.data, sme->ssid, length); 530cb3126e6SKarl Relton msg_join.ssid.data.len = length; 531cb3126e6SKarl Relton 532cb3126e6SKarl Relton result = p80211req_dorequest(wlandev, (u8 *)&msg_join); 533cb3126e6SKarl Relton 534cb3126e6SKarl Relton exit: 5358dd82ebeSEdgardo Hames if (result) 5368dd82ebeSEdgardo Hames err = -EFAULT; 537cb3126e6SKarl Relton 538cb3126e6SKarl Relton return err; 539cb3126e6SKarl Relton } 540cb3126e6SKarl Relton 54155da06ebSTeodora Baluta static int prism2_disconnect(struct wiphy *wiphy, struct net_device *dev, 5428dd82ebeSEdgardo Hames u16 reason_code) 5438dd82ebeSEdgardo Hames { 544c9573a8dSsayli karnik struct wlandevice *wlandev = dev->ml_priv; 545b6bb56e6SEdgardo Hames struct p80211msg_lnxreq_autojoin msg_join; 546cb3126e6SKarl Relton int result; 547cb3126e6SKarl Relton int err = 0; 548cb3126e6SKarl Relton 549cb3126e6SKarl Relton /* Do a join, with a bogus ssid. Thats the only way I can think of */ 550b1f1118bSTim Collier msg_join.msgcode = DIDMSG_LNXREQ_AUTOJOIN; 551cb3126e6SKarl Relton 552cb3126e6SKarl Relton memcpy(msg_join.ssid.data.data, "---", 3); 553cb3126e6SKarl Relton msg_join.ssid.data.len = 3; 554cb3126e6SKarl Relton 555cb3126e6SKarl Relton result = p80211req_dorequest(wlandev, (u8 *)&msg_join); 556cb3126e6SKarl Relton 5578dd82ebeSEdgardo Hames if (result) 5588dd82ebeSEdgardo Hames err = -EFAULT; 559cb3126e6SKarl Relton 560cb3126e6SKarl Relton return err; 561cb3126e6SKarl Relton } 562cb3126e6SKarl Relton 56355da06ebSTeodora Baluta static int prism2_join_ibss(struct wiphy *wiphy, struct net_device *dev, 5648dd82ebeSEdgardo Hames struct cfg80211_ibss_params *params) 5658dd82ebeSEdgardo Hames { 566cb3126e6SKarl Relton return -EOPNOTSUPP; 567cb3126e6SKarl Relton } 568cb3126e6SKarl Relton 56955da06ebSTeodora Baluta static int prism2_leave_ibss(struct wiphy *wiphy, struct net_device *dev) 5708dd82ebeSEdgardo Hames { 571cb3126e6SKarl Relton return -EOPNOTSUPP; 572cb3126e6SKarl Relton } 573cb3126e6SKarl Relton 57455da06ebSTeodora Baluta static int prism2_set_tx_power(struct wiphy *wiphy, struct wireless_dev *wdev, 5755f3b361aSEmil Goode enum nl80211_tx_power_setting type, int mbm) 5768dd82ebeSEdgardo Hames { 577cb3126e6SKarl Relton struct prism2_wiphy_private *priv = wiphy_priv(wiphy); 578c9573a8dSsayli karnik struct wlandevice *wlandev = priv->wlandev; 579cb3126e6SKarl Relton u32 data; 580cb3126e6SKarl Relton int result; 581cb3126e6SKarl Relton int err = 0; 582cb3126e6SKarl Relton 5839015e499SChristoph Fritz if (type == NL80211_TX_POWER_AUTOMATIC) 584cb3126e6SKarl Relton data = 30; 585cb3126e6SKarl Relton else 5869015e499SChristoph Fritz data = MBM_TO_DBM(mbm); 587cb3126e6SKarl Relton 588cb3126e6SKarl Relton result = prism2_domibset_uint32(wlandev, 589c9a89f4eSTim Collier DIDMIB_DOT11PHY_TXPOWERTABLE_CURRENTTXPOWERLEVEL, 590cb3126e6SKarl Relton data); 591cb3126e6SKarl Relton 592cb3126e6SKarl Relton if (result) { 593cb3126e6SKarl Relton err = -EFAULT; 594cb3126e6SKarl Relton goto exit; 595cb3126e6SKarl Relton } 596cb3126e6SKarl Relton 597cb3126e6SKarl Relton exit: 598cb3126e6SKarl Relton return err; 599cb3126e6SKarl Relton } 600cb3126e6SKarl Relton 60155da06ebSTeodora Baluta static int prism2_get_tx_power(struct wiphy *wiphy, struct wireless_dev *wdev, 6025f3b361aSEmil Goode int *dbm) 6038dd82ebeSEdgardo Hames { 604cb3126e6SKarl Relton struct prism2_wiphy_private *priv = wiphy_priv(wiphy); 605c9573a8dSsayli karnik struct wlandevice *wlandev = priv->wlandev; 606b6bb56e6SEdgardo Hames struct p80211msg_dot11req_mibget msg; 607b26b2325SSergio Paracuellos struct p80211item_uint32 *mibitem; 608cb3126e6SKarl Relton int result; 609cb3126e6SKarl Relton int err = 0; 610cb3126e6SKarl Relton 611b26b2325SSergio Paracuellos mibitem = (struct p80211item_uint32 *)&msg.mibattribute.data; 61208ac8573STim Collier msg.msgcode = DIDMSG_DOT11REQ_MIBGET; 61304950c3fSTim Collier mibitem->did = DIDMIB_DOT11PHY_TXPOWERTABLE_CURRENTTXPOWERLEVEL; 614cb3126e6SKarl Relton 615cb3126e6SKarl Relton result = p80211req_dorequest(wlandev, (u8 *)&msg); 616cb3126e6SKarl Relton 617cb3126e6SKarl Relton if (result) { 618cb3126e6SKarl Relton err = -EFAULT; 619cb3126e6SKarl Relton goto exit; 620cb3126e6SKarl Relton } 621cb3126e6SKarl Relton 622cb3126e6SKarl Relton *dbm = mibitem->data; 623cb3126e6SKarl Relton 624cb3126e6SKarl Relton exit: 625cb3126e6SKarl Relton return err; 626cb3126e6SKarl Relton } 627cb3126e6SKarl Relton 628cb3126e6SKarl Relton /* Interface callback functions, passing data back up to the cfg80211 layer */ 629c9573a8dSsayli karnik void prism2_connect_result(struct wlandevice *wlandev, u8 failed) 6308dd82ebeSEdgardo Hames { 6318aac4d44SDevendra Naga u16 status = failed ? 6328aac4d44SDevendra Naga WLAN_STATUS_UNSPECIFIED_FAILURE : WLAN_STATUS_SUCCESS; 633cb3126e6SKarl Relton 634cb3126e6SKarl Relton cfg80211_connect_result(wlandev->netdev, wlandev->bssid, 6358dd82ebeSEdgardo Hames NULL, 0, NULL, 0, status, GFP_KERNEL); 636cb3126e6SKarl Relton } 637cb3126e6SKarl Relton 638c9573a8dSsayli karnik void prism2_disconnected(struct wlandevice *wlandev) 6398dd82ebeSEdgardo Hames { 640cb3126e6SKarl Relton cfg80211_disconnected(wlandev->netdev, 0, NULL, 64180279fb7SJohannes Berg 0, false, GFP_KERNEL); 642cb3126e6SKarl Relton } 643cb3126e6SKarl Relton 644c9573a8dSsayli karnik void prism2_roamed(struct wlandevice *wlandev) 6458dd82ebeSEdgardo Hames { 64629ce6ecbSAvraham Stern struct cfg80211_roam_info roam_info = { 64729ce6ecbSAvraham Stern .bssid = wlandev->bssid, 64829ce6ecbSAvraham Stern }; 64929ce6ecbSAvraham Stern 65029ce6ecbSAvraham Stern cfg80211_roamed(wlandev->netdev, &roam_info, GFP_KERNEL); 651cb3126e6SKarl Relton } 652cb3126e6SKarl Relton 653cb3126e6SKarl Relton /* Structures for declaring wiphy interface */ 654cb3126e6SKarl Relton static const struct cfg80211_ops prism2_usb_cfg_ops = { 655cb3126e6SKarl Relton .change_virtual_intf = prism2_change_virtual_intf, 656cb3126e6SKarl Relton .add_key = prism2_add_key, 657cb3126e6SKarl Relton .get_key = prism2_get_key, 658cb3126e6SKarl Relton .del_key = prism2_del_key, 659cb3126e6SKarl Relton .set_default_key = prism2_set_default_key, 660cb3126e6SKarl Relton .get_station = prism2_get_station, 661cb3126e6SKarl Relton .scan = prism2_scan, 662cb3126e6SKarl Relton .set_wiphy_params = prism2_set_wiphy_params, 663cb3126e6SKarl Relton .connect = prism2_connect, 664cb3126e6SKarl Relton .disconnect = prism2_disconnect, 665cb3126e6SKarl Relton .join_ibss = prism2_join_ibss, 666cb3126e6SKarl Relton .leave_ibss = prism2_leave_ibss, 667cb3126e6SKarl Relton .set_tx_power = prism2_set_tx_power, 668cb3126e6SKarl Relton .get_tx_power = prism2_get_tx_power, 669cb3126e6SKarl Relton }; 670cb3126e6SKarl Relton 671cb3126e6SKarl Relton /* Functions to create/free wiphy interface */ 672285376ffSTim Collier static struct wiphy *wlan_create_wiphy(struct device *dev, 673285376ffSTim Collier struct wlandevice *wlandev) 674cb3126e6SKarl Relton { 675cb3126e6SKarl Relton struct wiphy *wiphy; 676cb3126e6SKarl Relton struct prism2_wiphy_private *priv; 6778aac4d44SDevendra Naga 6788aac4d44SDevendra Naga wiphy = wiphy_new(&prism2_usb_cfg_ops, sizeof(*priv)); 679cb3126e6SKarl Relton if (!wiphy) 680cb3126e6SKarl Relton return NULL; 681cb3126e6SKarl Relton 682cb3126e6SKarl Relton priv = wiphy_priv(wiphy); 683cb3126e6SKarl Relton priv->wlandev = wlandev; 684cb3126e6SKarl Relton memcpy(priv->channels, prism2_channels, sizeof(prism2_channels)); 685cb3126e6SKarl Relton memcpy(priv->rates, prism2_rates, sizeof(prism2_rates)); 686cb3126e6SKarl Relton priv->band.channels = priv->channels; 687cb3126e6SKarl Relton priv->band.n_channels = ARRAY_SIZE(prism2_channels); 688cb3126e6SKarl Relton priv->band.bitrates = priv->rates; 689cb3126e6SKarl Relton priv->band.n_bitrates = ARRAY_SIZE(prism2_rates); 69057fbcce3SJohannes Berg priv->band.band = NL80211_BAND_2GHZ; 691aff3ea4eSKarl Relton priv->band.ht_cap.ht_supported = false; 69257fbcce3SJohannes Berg wiphy->bands[NL80211_BAND_2GHZ] = &priv->band; 693cb3126e6SKarl Relton 694cb3126e6SKarl Relton set_wiphy_dev(wiphy, dev); 695cb3126e6SKarl Relton wiphy->privid = prism2_wiphy_privid; 696cb3126e6SKarl Relton wiphy->max_scan_ssids = 1; 6978dd82ebeSEdgardo Hames wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) 6988dd82ebeSEdgardo Hames | BIT(NL80211_IFTYPE_ADHOC); 699cb3126e6SKarl Relton wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 700cb3126e6SKarl Relton wiphy->n_cipher_suites = PRISM2_NUM_CIPHER_SUITES; 701cb3126e6SKarl Relton wiphy->cipher_suites = prism2_cipher_suites; 702cb3126e6SKarl Relton 703f96b36c7SClaudiu Beznea if (wiphy_register(wiphy) < 0) { 704f96b36c7SClaudiu Beznea wiphy_free(wiphy); 705cb3126e6SKarl Relton return NULL; 706f96b36c7SClaudiu Beznea } 707cb3126e6SKarl Relton 708cb3126e6SKarl Relton return wiphy; 709cb3126e6SKarl Relton } 710cb3126e6SKarl Relton 71136d9c250STugce Sirin static void wlan_free_wiphy(struct wiphy *wiphy) 712cb3126e6SKarl Relton { 713cb3126e6SKarl Relton wiphy_unregister(wiphy); 714cb3126e6SKarl Relton wiphy_free(wiphy); 715cb3126e6SKarl Relton } 716