12be7d22fSVladimir Kondratiev /* 2849a564bSDedy Lansky * Copyright (c) 2012-2017 Qualcomm Atheros, Inc. 32be7d22fSVladimir Kondratiev * 42be7d22fSVladimir Kondratiev * Permission to use, copy, modify, and/or distribute this software for any 52be7d22fSVladimir Kondratiev * purpose with or without fee is hereby granted, provided that the above 62be7d22fSVladimir Kondratiev * copyright notice and this permission notice appear in all copies. 72be7d22fSVladimir Kondratiev * 82be7d22fSVladimir Kondratiev * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 92be7d22fSVladimir Kondratiev * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 102be7d22fSVladimir Kondratiev * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 112be7d22fSVladimir Kondratiev * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 122be7d22fSVladimir Kondratiev * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 132be7d22fSVladimir Kondratiev * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 142be7d22fSVladimir Kondratiev * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 152be7d22fSVladimir Kondratiev */ 162be7d22fSVladimir Kondratiev 172be7d22fSVladimir Kondratiev #include <linux/moduleparam.h> 182be7d22fSVladimir Kondratiev #include <linux/if_arp.h> 19108d1eb6SVladimir Kondratiev #include <linux/etherdevice.h> 202be7d22fSVladimir Kondratiev 212be7d22fSVladimir Kondratiev #include "wil6210.h" 22b4490f42SVladimir Kondratiev #include "txrx.h" 23f172b563SDedy Lansky #include "wmi.h" 24f1ad8c93SVladimir Kondratiev #include "boot_loader.h" 25f172b563SDedy Lansky 26349214c1SMaya Erez #define WAIT_FOR_HALP_VOTE_MS 100 27035859a5SMaya Erez #define WAIT_FOR_SCAN_ABORT_MS 1000 28349214c1SMaya Erez 29bfc2dc7aSVladimir Kondratiev bool debug_fw; /* = false; */ 30bfc2dc7aSVladimir Kondratiev module_param(debug_fw, bool, S_IRUGO); 31bfc2dc7aSVladimir Kondratiev MODULE_PARM_DESC(debug_fw, " do not perform card reset. For FW debug"); 32bfc2dc7aSVladimir Kondratiev 331f1a361aSLior David static bool oob_mode; 341f1a361aSLior David module_param(oob_mode, bool, S_IRUGO); 351f1a361aSLior David MODULE_PARM_DESC(oob_mode, 361f1a361aSLior David " enable out of the box (OOB) mode in FW, for diagnostics and certification"); 371f1a361aSLior David 38c33407a8SVladimir Kondratiev bool no_fw_recovery; 39ed6f9dc6SVladimir Kondratiev module_param(no_fw_recovery, bool, S_IRUGO | S_IWUSR); 40c33407a8SVladimir Kondratiev MODULE_PARM_DESC(no_fw_recovery, " disable automatic FW error recovery"); 41ed6f9dc6SVladimir Kondratiev 42ab954628SVladimir Kondratiev /* if not set via modparam, will be set to default value of 1/8 of 43ab954628SVladimir Kondratiev * rx ring size during init flow 44ab954628SVladimir Kondratiev */ 45ab954628SVladimir Kondratiev unsigned short rx_ring_overflow_thrsh = WIL6210_RX_HIGH_TRSH_INIT; 46ab954628SVladimir Kondratiev module_param(rx_ring_overflow_thrsh, ushort, S_IRUGO); 47ab954628SVladimir Kondratiev MODULE_PARM_DESC(rx_ring_overflow_thrsh, 48ab954628SVladimir Kondratiev " RX ring overflow threshold in descriptors."); 49b6b1b0ecSVladimir Kondratiev 509a06bec9SVladimir Kondratiev /* We allow allocation of more than 1 page buffers to support large packets. 519a06bec9SVladimir Kondratiev * It is suboptimal behavior performance wise in case MTU above page size. 529a06bec9SVladimir Kondratiev */ 53c44690a1SVladimir Kondratiev unsigned int mtu_max = TXRX_BUF_LEN_DEFAULT - WIL_MAX_MPDU_OVERHEAD; 549a06bec9SVladimir Kondratiev static int mtu_max_set(const char *val, const struct kernel_param *kp) 559a06bec9SVladimir Kondratiev { 569a06bec9SVladimir Kondratiev int ret; 579a06bec9SVladimir Kondratiev 589a06bec9SVladimir Kondratiev /* sets mtu_max directly. no need to restore it in case of 599a06bec9SVladimir Kondratiev * illegal value since we assume this will fail insmod 609a06bec9SVladimir Kondratiev */ 619a06bec9SVladimir Kondratiev ret = param_set_uint(val, kp); 629a06bec9SVladimir Kondratiev if (ret) 639a06bec9SVladimir Kondratiev return ret; 649a06bec9SVladimir Kondratiev 654590d812SVladimir Kondratiev if (mtu_max < 68 || mtu_max > WIL_MAX_ETH_MTU) 669a06bec9SVladimir Kondratiev ret = -EINVAL; 679a06bec9SVladimir Kondratiev 689a06bec9SVladimir Kondratiev return ret; 699a06bec9SVladimir Kondratiev } 709a06bec9SVladimir Kondratiev 719c27847dSLuis R. Rodriguez static const struct kernel_param_ops mtu_max_ops = { 729a06bec9SVladimir Kondratiev .set = mtu_max_set, 739a06bec9SVladimir Kondratiev .get = param_get_uint, 749a06bec9SVladimir Kondratiev }; 759a06bec9SVladimir Kondratiev 769a06bec9SVladimir Kondratiev module_param_cb(mtu_max, &mtu_max_ops, &mtu_max, S_IRUGO); 779a06bec9SVladimir Kondratiev MODULE_PARM_DESC(mtu_max, " Max MTU value."); 789a06bec9SVladimir Kondratiev 79d3762b40SVladimir Kondratiev static uint rx_ring_order = WIL_RX_RING_SIZE_ORDER_DEFAULT; 80d3762b40SVladimir Kondratiev static uint tx_ring_order = WIL_TX_RING_SIZE_ORDER_DEFAULT; 8141d6b093SVladimir Kondratiev static uint bcast_ring_order = WIL_BCAST_RING_SIZE_ORDER_DEFAULT; 82d3762b40SVladimir Kondratiev 83d3762b40SVladimir Kondratiev static int ring_order_set(const char *val, const struct kernel_param *kp) 84d3762b40SVladimir Kondratiev { 85d3762b40SVladimir Kondratiev int ret; 86d3762b40SVladimir Kondratiev uint x; 87d3762b40SVladimir Kondratiev 88d3762b40SVladimir Kondratiev ret = kstrtouint(val, 0, &x); 89d3762b40SVladimir Kondratiev if (ret) 90d3762b40SVladimir Kondratiev return ret; 91d3762b40SVladimir Kondratiev 92d3762b40SVladimir Kondratiev if ((x < WIL_RING_SIZE_ORDER_MIN) || (x > WIL_RING_SIZE_ORDER_MAX)) 93d3762b40SVladimir Kondratiev return -EINVAL; 94d3762b40SVladimir Kondratiev 95d3762b40SVladimir Kondratiev *((uint *)kp->arg) = x; 96d3762b40SVladimir Kondratiev 97d3762b40SVladimir Kondratiev return 0; 98d3762b40SVladimir Kondratiev } 99d3762b40SVladimir Kondratiev 1009c27847dSLuis R. Rodriguez static const struct kernel_param_ops ring_order_ops = { 101d3762b40SVladimir Kondratiev .set = ring_order_set, 102d3762b40SVladimir Kondratiev .get = param_get_uint, 103d3762b40SVladimir Kondratiev }; 104d3762b40SVladimir Kondratiev 105d3762b40SVladimir Kondratiev module_param_cb(rx_ring_order, &ring_order_ops, &rx_ring_order, S_IRUGO); 106d3762b40SVladimir Kondratiev MODULE_PARM_DESC(rx_ring_order, " Rx ring order; size = 1 << order"); 107d3762b40SVladimir Kondratiev module_param_cb(tx_ring_order, &ring_order_ops, &tx_ring_order, S_IRUGO); 108d3762b40SVladimir Kondratiev MODULE_PARM_DESC(tx_ring_order, " Tx ring order; size = 1 << order"); 109d507d1b7SVladimir Kondratiev module_param_cb(bcast_ring_order, &ring_order_ops, &bcast_ring_order, S_IRUGO); 110d507d1b7SVladimir Kondratiev MODULE_PARM_DESC(bcast_ring_order, " Bcast ring order; size = 1 << order"); 111d3762b40SVladimir Kondratiev 112520d68e7SVladimir Kondratiev #define RST_DELAY (20) /* msec, for loop in @wil_target_reset */ 113520d68e7SVladimir Kondratiev #define RST_COUNT (1 + 1000/RST_DELAY) /* round up to be above 1 sec total */ 114520d68e7SVladimir Kondratiev 1152be7d22fSVladimir Kondratiev /* 1162be7d22fSVladimir Kondratiev * Due to a hardware issue, 1172be7d22fSVladimir Kondratiev * one has to read/write to/from NIC in 32-bit chunks; 1182be7d22fSVladimir Kondratiev * regular memcpy_fromio and siblings will 1192be7d22fSVladimir Kondratiev * not work on 64-bit platform - it uses 64-bit transactions 1202be7d22fSVladimir Kondratiev * 1212be7d22fSVladimir Kondratiev * Force 32-bit transactions to enable NIC on 64-bit platforms 1222be7d22fSVladimir Kondratiev * 1232be7d22fSVladimir Kondratiev * To avoid byte swap on big endian host, __raw_{read|write}l 1242be7d22fSVladimir Kondratiev * should be used - {read|write}l would swap bytes to provide 1252be7d22fSVladimir Kondratiev * little endian on PCI value in host endianness. 1262be7d22fSVladimir Kondratiev */ 1272be7d22fSVladimir Kondratiev void wil_memcpy_fromio_32(void *dst, const volatile void __iomem *src, 1282be7d22fSVladimir Kondratiev size_t count) 1292be7d22fSVladimir Kondratiev { 1302be7d22fSVladimir Kondratiev u32 *d = dst; 1312be7d22fSVladimir Kondratiev const volatile u32 __iomem *s = src; 1322be7d22fSVladimir Kondratiev 1332be7d22fSVladimir Kondratiev /* size_t is unsigned, if (count%4 != 0) it will wrap */ 1342be7d22fSVladimir Kondratiev for (count += 4; count > 4; count -= 4) 1352be7d22fSVladimir Kondratiev *d++ = __raw_readl(s++); 1362be7d22fSVladimir Kondratiev } 1372be7d22fSVladimir Kondratiev 138349214c1SMaya Erez void wil_memcpy_fromio_halp_vote(struct wil6210_priv *wil, void *dst, 139349214c1SMaya Erez const volatile void __iomem *src, size_t count) 140349214c1SMaya Erez { 141349214c1SMaya Erez wil_halp_vote(wil); 142349214c1SMaya Erez wil_memcpy_fromio_32(dst, src, count); 143349214c1SMaya Erez wil_halp_unvote(wil); 144349214c1SMaya Erez } 145349214c1SMaya Erez 1462be7d22fSVladimir Kondratiev void wil_memcpy_toio_32(volatile void __iomem *dst, const void *src, 1472be7d22fSVladimir Kondratiev size_t count) 1482be7d22fSVladimir Kondratiev { 1492be7d22fSVladimir Kondratiev volatile u32 __iomem *d = dst; 1502be7d22fSVladimir Kondratiev const u32 *s = src; 1512be7d22fSVladimir Kondratiev 1522be7d22fSVladimir Kondratiev for (count += 4; count > 4; count -= 4) 1532be7d22fSVladimir Kondratiev __raw_writel(*s++, d++); 1542be7d22fSVladimir Kondratiev } 1552be7d22fSVladimir Kondratiev 156349214c1SMaya Erez void wil_memcpy_toio_halp_vote(struct wil6210_priv *wil, 157349214c1SMaya Erez volatile void __iomem *dst, 158349214c1SMaya Erez const void *src, size_t count) 159349214c1SMaya Erez { 160349214c1SMaya Erez wil_halp_vote(wil); 161349214c1SMaya Erez wil_memcpy_toio_32(dst, src, count); 162349214c1SMaya Erez wil_halp_unvote(wil); 163349214c1SMaya Erez } 164349214c1SMaya Erez 165b516fcc5SVladimir Kondratiev static void wil_disconnect_cid(struct wil6210_priv *wil, int cid, 1664821e6d8SVladimir Kondratiev u16 reason_code, bool from_event) 167bd33273bSVladimir Kondratiev __acquires(&sta->tid_rx_lock) __releases(&sta->tid_rx_lock) 1682be7d22fSVladimir Kondratiev { 16991886b0bSVladimir Kondratiev uint i; 170fc58f681SVladimir Kondratiev struct net_device *ndev = wil_to_ndev(wil); 171fc58f681SVladimir Kondratiev struct wireless_dev *wdev = wil->wdev; 172b4490f42SVladimir Kondratiev struct wil_sta_info *sta = &wil->sta[cid]; 1738fe59627SVladimir Kondratiev 174bd33273bSVladimir Kondratiev might_sleep(); 175af3db60aSLazar Alexei wil_dbg_misc(wil, "disconnect_cid: CID %d, status %d\n", 176af3db60aSLazar Alexei cid, sta->status); 17758527421SVladimir Kondratiev /* inform upper/lower layers */ 1784d55a0a1SVladimir Kondratiev if (sta->status != wil_sta_unused) { 179849a564bSDedy Lansky if (!from_event) { 180849a564bSDedy Lansky bool del_sta = (wdev->iftype == NL80211_IFTYPE_AP) ? 181849a564bSDedy Lansky disable_ap_sme : false; 182849a564bSDedy Lansky wmi_disconnect_sta(wil, sta->addr, reason_code, 183849a564bSDedy Lansky true, del_sta); 184849a564bSDedy Lansky } 185b516fcc5SVladimir Kondratiev 186fc58f681SVladimir Kondratiev switch (wdev->iftype) { 187fc58f681SVladimir Kondratiev case NL80211_IFTYPE_AP: 188fc58f681SVladimir Kondratiev case NL80211_IFTYPE_P2P_GO: 189fc58f681SVladimir Kondratiev /* AP-like interface */ 190fc58f681SVladimir Kondratiev cfg80211_del_sta(ndev, sta->addr, GFP_KERNEL); 191fc58f681SVladimir Kondratiev break; 192fc58f681SVladimir Kondratiev default: 193fc58f681SVladimir Kondratiev break; 194fc58f681SVladimir Kondratiev } 1954d55a0a1SVladimir Kondratiev sta->status = wil_sta_unused; 1964d55a0a1SVladimir Kondratiev } 19758527421SVladimir Kondratiev /* reorder buffers */ 198b4490f42SVladimir Kondratiev for (i = 0; i < WIL_STA_TID_NUM; i++) { 199ec81b5adSDedy Lansky struct wil_tid_ampdu_rx *r; 200ec81b5adSDedy Lansky 201bd33273bSVladimir Kondratiev spin_lock_bh(&sta->tid_rx_lock); 202ec81b5adSDedy Lansky 203ec81b5adSDedy Lansky r = sta->tid_rx[i]; 204b4490f42SVladimir Kondratiev sta->tid_rx[i] = NULL; 205b4490f42SVladimir Kondratiev wil_tid_ampdu_rx_free(wil, r); 206ec81b5adSDedy Lansky 207bd33273bSVladimir Kondratiev spin_unlock_bh(&sta->tid_rx_lock); 208b4490f42SVladimir Kondratiev } 20958527421SVladimir Kondratiev /* crypto context */ 21058527421SVladimir Kondratiev memset(sta->tid_crypto_rx, 0, sizeof(sta->tid_crypto_rx)); 21158527421SVladimir Kondratiev memset(&sta->group_crypto_rx, 0, sizeof(sta->group_crypto_rx)); 21258527421SVladimir Kondratiev /* release vrings */ 21391886b0bSVladimir Kondratiev for (i = 0; i < ARRAY_SIZE(wil->vring_tx); i++) { 21491886b0bSVladimir Kondratiev if (wil->vring2cid_tid[i][0] == cid) 21591886b0bSVladimir Kondratiev wil_vring_fini_tx(wil, i); 21691886b0bSVladimir Kondratiev } 21758527421SVladimir Kondratiev /* statistics */ 21891886b0bSVladimir Kondratiev memset(&sta->stats, 0, sizeof(sta->stats)); 219b4490f42SVladimir Kondratiev } 220b4490f42SVladimir Kondratiev 221f9e3033fSDedy Lansky static bool wil_is_connected(struct wil6210_priv *wil) 22254eaa8c6SMaya Erez { 22354eaa8c6SMaya Erez int i; 22454eaa8c6SMaya Erez 22554eaa8c6SMaya Erez for (i = 0; i < ARRAY_SIZE(wil->sta); i++) { 22654eaa8c6SMaya Erez if (wil->sta[i].status == wil_sta_connected) 22754eaa8c6SMaya Erez return true; 22854eaa8c6SMaya Erez } 22954eaa8c6SMaya Erez 23054eaa8c6SMaya Erez return false; 23154eaa8c6SMaya Erez } 23254eaa8c6SMaya Erez 233b516fcc5SVladimir Kondratiev static void _wil6210_disconnect(struct wil6210_priv *wil, const u8 *bssid, 2344821e6d8SVladimir Kondratiev u16 reason_code, bool from_event) 23591886b0bSVladimir Kondratiev { 23691886b0bSVladimir Kondratiev int cid = -ENOENT; 23791886b0bSVladimir Kondratiev struct net_device *ndev = wil_to_ndev(wil); 23891886b0bSVladimir Kondratiev struct wireless_dev *wdev = wil->wdev; 23991886b0bSVladimir Kondratiev 2402690c4c0SLior David if (unlikely(!ndev)) 2412690c4c0SLior David return; 2422690c4c0SLior David 24391886b0bSVladimir Kondratiev might_sleep(); 244af3db60aSLazar Alexei wil_info(wil, "bssid=%pM, reason=%d, ev%s\n", bssid, 245100106d7SVladimir Kondratiev reason_code, from_event ? "+" : "-"); 24691886b0bSVladimir Kondratiev 247100106d7SVladimir Kondratiev /* Cases are: 248100106d7SVladimir Kondratiev * - disconnect single STA, still connected 249100106d7SVladimir Kondratiev * - disconnect single STA, already disconnected 250100106d7SVladimir Kondratiev * - disconnect all 251100106d7SVladimir Kondratiev * 25268682b41SVladimir Kondratiev * For "disconnect all", there are 3 options: 253100106d7SVladimir Kondratiev * - bssid == NULL 25468682b41SVladimir Kondratiev * - bssid is broadcast address (ff:ff:ff:ff:ff:ff) 255100106d7SVladimir Kondratiev * - bssid is our MAC address 256100106d7SVladimir Kondratiev */ 25768682b41SVladimir Kondratiev if (bssid && !is_broadcast_ether_addr(bssid) && 25868682b41SVladimir Kondratiev !ether_addr_equal_unaligned(ndev->dev_addr, bssid)) { 259100106d7SVladimir Kondratiev cid = wil_find_cid(wil, bssid); 260100106d7SVladimir Kondratiev wil_dbg_misc(wil, "Disconnect %pM, CID=%d, reason=%d\n", 261100106d7SVladimir Kondratiev bssid, cid, reason_code); 26291886b0bSVladimir Kondratiev if (cid >= 0) /* disconnect 1 peer */ 2634821e6d8SVladimir Kondratiev wil_disconnect_cid(wil, cid, reason_code, from_event); 264100106d7SVladimir Kondratiev } else { /* all */ 265100106d7SVladimir Kondratiev wil_dbg_misc(wil, "Disconnect all\n"); 26691886b0bSVladimir Kondratiev for (cid = 0; cid < WIL6210_MAX_CID; cid++) 2674821e6d8SVladimir Kondratiev wil_disconnect_cid(wil, cid, reason_code, from_event); 268100106d7SVladimir Kondratiev } 26991886b0bSVladimir Kondratiev 27091886b0bSVladimir Kondratiev /* link state */ 27191886b0bSVladimir Kondratiev switch (wdev->iftype) { 27291886b0bSVladimir Kondratiev case NL80211_IFTYPE_STATION: 27391886b0bSVladimir Kondratiev case NL80211_IFTYPE_P2P_CLIENT: 27441d6b093SVladimir Kondratiev wil_bcast_fini(wil); 275f9e3033fSDedy Lansky wil_update_net_queues_bh(wil, NULL, true); 276c5e96c91SDedy Lansky netif_carrier_off(ndev); 277c5e96c91SDedy Lansky 2789419b6a2SVladimir Kondratiev if (test_bit(wil_status_fwconnected, wil->status)) { 2799419b6a2SVladimir Kondratiev clear_bit(wil_status_fwconnected, wil->status); 2804821e6d8SVladimir Kondratiev cfg80211_disconnected(ndev, reason_code, 28180279fb7SJohannes Berg NULL, 0, false, GFP_KERNEL); 2829419b6a2SVladimir Kondratiev } else if (test_bit(wil_status_fwconnecting, wil->status)) { 2832be7d22fSVladimir Kondratiev cfg80211_connect_result(ndev, bssid, NULL, 0, NULL, 0, 2842be7d22fSVladimir Kondratiev WLAN_STATUS_UNSPECIFIED_FAILURE, 2852be7d22fSVladimir Kondratiev GFP_KERNEL); 2862be7d22fSVladimir Kondratiev } 2879419b6a2SVladimir Kondratiev clear_bit(wil_status_fwconnecting, wil->status); 28891886b0bSVladimir Kondratiev break; 28954eaa8c6SMaya Erez case NL80211_IFTYPE_AP: 29054eaa8c6SMaya Erez case NL80211_IFTYPE_P2P_GO: 291f9e3033fSDedy Lansky if (!wil_is_connected(wil)) { 292f9e3033fSDedy Lansky wil_update_net_queues_bh(wil, NULL, true); 29354eaa8c6SMaya Erez clear_bit(wil_status_fwconnected, wil->status); 294f9e3033fSDedy Lansky } else { 295f9e3033fSDedy Lansky wil_update_net_queues_bh(wil, NULL, false); 296f9e3033fSDedy Lansky } 29754eaa8c6SMaya Erez break; 29891886b0bSVladimir Kondratiev default: 29991886b0bSVladimir Kondratiev break; 30091886b0bSVladimir Kondratiev } 3012be7d22fSVladimir Kondratiev } 3022be7d22fSVladimir Kondratiev 3032be7d22fSVladimir Kondratiev static void wil_disconnect_worker(struct work_struct *work) 3042be7d22fSVladimir Kondratiev { 3052be7d22fSVladimir Kondratiev struct wil6210_priv *wil = container_of(work, 3062be7d22fSVladimir Kondratiev struct wil6210_priv, disconnect_worker); 3072be7d22fSVladimir Kondratiev 308097638a0SVladimir Kondratiev mutex_lock(&wil->mutex); 3094821e6d8SVladimir Kondratiev _wil6210_disconnect(wil, NULL, WLAN_REASON_UNSPECIFIED, false); 310097638a0SVladimir Kondratiev mutex_unlock(&wil->mutex); 3112be7d22fSVladimir Kondratiev } 3122be7d22fSVladimir Kondratiev 3132be7d22fSVladimir Kondratiev static void wil_connect_timer_fn(ulong x) 3142be7d22fSVladimir Kondratiev { 3152be7d22fSVladimir Kondratiev struct wil6210_priv *wil = (void *)x; 3160916d9f2SMaya Erez bool q; 3172be7d22fSVladimir Kondratiev 3180916d9f2SMaya Erez wil_err(wil, "Connect timeout detected, disconnect station\n"); 3192be7d22fSVladimir Kondratiev 3202be7d22fSVladimir Kondratiev /* reschedule to thread context - disconnect won't 3210916d9f2SMaya Erez * run from atomic context. 3220916d9f2SMaya Erez * queue on wmi_wq to prevent race with connect event. 3232be7d22fSVladimir Kondratiev */ 3240916d9f2SMaya Erez q = queue_work(wil->wmi_wq, &wil->disconnect_worker); 3250916d9f2SMaya Erez wil_dbg_wmi(wil, "queue_work of disconnect_worker -> %d\n", q); 3262be7d22fSVladimir Kondratiev } 3272be7d22fSVladimir Kondratiev 328047e5d74SVladimir Kondratiev static void wil_scan_timer_fn(ulong x) 329047e5d74SVladimir Kondratiev { 330047e5d74SVladimir Kondratiev struct wil6210_priv *wil = (void *)x; 331047e5d74SVladimir Kondratiev 3329419b6a2SVladimir Kondratiev clear_bit(wil_status_fwready, wil->status); 333047e5d74SVladimir Kondratiev wil_err(wil, "Scan timeout detected, start fw error recovery\n"); 3348ad6600fSVladimir Kondratiev wil_fw_error_recovery(wil); 335047e5d74SVladimir Kondratiev } 336047e5d74SVladimir Kondratiev 337c33407a8SVladimir Kondratiev static int wil_wait_for_recovery(struct wil6210_priv *wil) 338c33407a8SVladimir Kondratiev { 339c33407a8SVladimir Kondratiev if (wait_event_interruptible(wil->wq, wil->recovery_state != 340c33407a8SVladimir Kondratiev fw_recovery_pending)) { 341c33407a8SVladimir Kondratiev wil_err(wil, "Interrupt, canceling recovery\n"); 342c33407a8SVladimir Kondratiev return -ERESTARTSYS; 343c33407a8SVladimir Kondratiev } 344c33407a8SVladimir Kondratiev if (wil->recovery_state != fw_recovery_running) { 345c33407a8SVladimir Kondratiev wil_info(wil, "Recovery cancelled\n"); 346c33407a8SVladimir Kondratiev return -EINTR; 347c33407a8SVladimir Kondratiev } 348c33407a8SVladimir Kondratiev wil_info(wil, "Proceed with recovery\n"); 349c33407a8SVladimir Kondratiev return 0; 350c33407a8SVladimir Kondratiev } 351c33407a8SVladimir Kondratiev 352c33407a8SVladimir Kondratiev void wil_set_recovery_state(struct wil6210_priv *wil, int state) 353c33407a8SVladimir Kondratiev { 354af3db60aSLazar Alexei wil_dbg_misc(wil, "set_recovery_state: %d -> %d\n", 355c33407a8SVladimir Kondratiev wil->recovery_state, state); 356c33407a8SVladimir Kondratiev 357c33407a8SVladimir Kondratiev wil->recovery_state = state; 358c33407a8SVladimir Kondratiev wake_up_interruptible(&wil->wq); 359c33407a8SVladimir Kondratiev } 360c33407a8SVladimir Kondratiev 361375a173fSLior David bool wil_is_recovery_blocked(struct wil6210_priv *wil) 362375a173fSLior David { 363375a173fSLior David return no_fw_recovery && (wil->recovery_state == fw_recovery_pending); 364375a173fSLior David } 365375a173fSLior David 366ed6f9dc6SVladimir Kondratiev static void wil_fw_error_worker(struct work_struct *work) 367ed6f9dc6SVladimir Kondratiev { 368c33407a8SVladimir Kondratiev struct wil6210_priv *wil = container_of(work, struct wil6210_priv, 369c33407a8SVladimir Kondratiev fw_error_worker); 370ed6f9dc6SVladimir Kondratiev struct wireless_dev *wdev = wil->wdev; 371ed6f9dc6SVladimir Kondratiev 372ed6f9dc6SVladimir Kondratiev wil_dbg_misc(wil, "fw error worker\n"); 373ed6f9dc6SVladimir Kondratiev 374cded9369SVladimir Kondratiev if (!netif_running(wil_to_ndev(wil))) { 375cded9369SVladimir Kondratiev wil_info(wil, "No recovery - interface is down\n"); 376cded9369SVladimir Kondratiev return; 377cded9369SVladimir Kondratiev } 378cded9369SVladimir Kondratiev 379fc219eedSVladimir Kondratiev /* increment @recovery_count if less then WIL6210_FW_RECOVERY_TO 380fc219eedSVladimir Kondratiev * passed since last recovery attempt 381fc219eedSVladimir Kondratiev */ 382fc219eedSVladimir Kondratiev if (time_is_after_jiffies(wil->last_fw_recovery + 383fc219eedSVladimir Kondratiev WIL6210_FW_RECOVERY_TO)) 384fc219eedSVladimir Kondratiev wil->recovery_count++; 385fc219eedSVladimir Kondratiev else 386fc219eedSVladimir Kondratiev wil->recovery_count = 1; /* fw was alive for a long time */ 387fc219eedSVladimir Kondratiev 388fc219eedSVladimir Kondratiev if (wil->recovery_count > WIL6210_FW_RECOVERY_RETRIES) { 389fc219eedSVladimir Kondratiev wil_err(wil, "too many recovery attempts (%d), giving up\n", 390fc219eedSVladimir Kondratiev wil->recovery_count); 391fc219eedSVladimir Kondratiev return; 392fc219eedSVladimir Kondratiev } 393fc219eedSVladimir Kondratiev 394fc219eedSVladimir Kondratiev wil->last_fw_recovery = jiffies; 395fc219eedSVladimir Kondratiev 396dfb5b098SLior David wil_info(wil, "fw error recovery requested (try %d)...\n", 397dfb5b098SLior David wil->recovery_count); 398dfb5b098SLior David if (!no_fw_recovery) 399dfb5b098SLior David wil->recovery_state = fw_recovery_running; 400dfb5b098SLior David if (wil_wait_for_recovery(wil) != 0) 401dfb5b098SLior David return; 402dfb5b098SLior David 4039c3bde56SVladimir Kondratiev mutex_lock(&wil->mutex); 404ed6f9dc6SVladimir Kondratiev switch (wdev->iftype) { 405ed6f9dc6SVladimir Kondratiev case NL80211_IFTYPE_STATION: 406ed6f9dc6SVladimir Kondratiev case NL80211_IFTYPE_P2P_CLIENT: 407ed6f9dc6SVladimir Kondratiev case NL80211_IFTYPE_MONITOR: 408dfb5b098SLior David /* silent recovery, upper layers will see disconnect */ 40973d839aeSVladimir Kondratiev __wil_down(wil); 41073d839aeSVladimir Kondratiev __wil_up(wil); 411ed6f9dc6SVladimir Kondratiev break; 412ed6f9dc6SVladimir Kondratiev case NL80211_IFTYPE_AP: 413ed6f9dc6SVladimir Kondratiev case NL80211_IFTYPE_P2P_GO: 414e240537bSVladimir Kondratiev wil_info(wil, "No recovery for AP-like interface\n"); 415ed6f9dc6SVladimir Kondratiev /* recovery in these modes is done by upper layers */ 416ed6f9dc6SVladimir Kondratiev break; 417ed6f9dc6SVladimir Kondratiev default: 418e240537bSVladimir Kondratiev wil_err(wil, "No recovery - unknown interface type %d\n", 419e240537bSVladimir Kondratiev wdev->iftype); 420ed6f9dc6SVladimir Kondratiev break; 421ed6f9dc6SVladimir Kondratiev } 4229c3bde56SVladimir Kondratiev mutex_unlock(&wil->mutex); 423ed6f9dc6SVladimir Kondratiev } 424ed6f9dc6SVladimir Kondratiev 4259a177384SVladimir Kondratiev static int wil_find_free_vring(struct wil6210_priv *wil) 4269a177384SVladimir Kondratiev { 4279a177384SVladimir Kondratiev int i; 4288fe59627SVladimir Kondratiev 4299a177384SVladimir Kondratiev for (i = 0; i < WIL6210_MAX_TX_RINGS; i++) { 4309a177384SVladimir Kondratiev if (!wil->vring_tx[i].va) 4319a177384SVladimir Kondratiev return i; 4329a177384SVladimir Kondratiev } 4339a177384SVladimir Kondratiev return -EINVAL; 4349a177384SVladimir Kondratiev } 4359a177384SVladimir Kondratiev 4360916d9f2SMaya Erez int wil_tx_init(struct wil6210_priv *wil, int cid) 4370916d9f2SMaya Erez { 4380916d9f2SMaya Erez int rc = -EINVAL, ringid; 4390916d9f2SMaya Erez 4400916d9f2SMaya Erez if (cid < 0) { 4410916d9f2SMaya Erez wil_err(wil, "No connection pending\n"); 4420916d9f2SMaya Erez goto out; 4430916d9f2SMaya Erez } 4440916d9f2SMaya Erez ringid = wil_find_free_vring(wil); 4450916d9f2SMaya Erez if (ringid < 0) { 4460916d9f2SMaya Erez wil_err(wil, "No free vring found\n"); 4470916d9f2SMaya Erez goto out; 4480916d9f2SMaya Erez } 4490916d9f2SMaya Erez 4500916d9f2SMaya Erez wil_dbg_wmi(wil, "Configure for connection CID %d vring %d\n", 4510916d9f2SMaya Erez cid, ringid); 4520916d9f2SMaya Erez 4530916d9f2SMaya Erez rc = wil_vring_init_tx(wil, ringid, 1 << tx_ring_order, cid, 0); 4540916d9f2SMaya Erez if (rc) 4550916d9f2SMaya Erez wil_err(wil, "wil_vring_init_tx for CID %d vring %d failed\n", 4560916d9f2SMaya Erez cid, ringid); 4570916d9f2SMaya Erez 4580916d9f2SMaya Erez out: 4590916d9f2SMaya Erez return rc; 4600916d9f2SMaya Erez } 4610916d9f2SMaya Erez 46241d6b093SVladimir Kondratiev int wil_bcast_init(struct wil6210_priv *wil) 46341d6b093SVladimir Kondratiev { 46441d6b093SVladimir Kondratiev int ri = wil->bcast_vring, rc; 46541d6b093SVladimir Kondratiev 46641d6b093SVladimir Kondratiev if ((ri >= 0) && wil->vring_tx[ri].va) 46741d6b093SVladimir Kondratiev return 0; 46841d6b093SVladimir Kondratiev 46941d6b093SVladimir Kondratiev ri = wil_find_free_vring(wil); 47041d6b093SVladimir Kondratiev if (ri < 0) 47141d6b093SVladimir Kondratiev return ri; 47241d6b093SVladimir Kondratiev 47341d6b093SVladimir Kondratiev wil->bcast_vring = ri; 474230d8442SVladimir Kondratiev rc = wil_vring_init_bcast(wil, ri, 1 << bcast_ring_order); 475230d8442SVladimir Kondratiev if (rc) 476230d8442SVladimir Kondratiev wil->bcast_vring = -1; 47741d6b093SVladimir Kondratiev 47841d6b093SVladimir Kondratiev return rc; 47941d6b093SVladimir Kondratiev } 48041d6b093SVladimir Kondratiev 48141d6b093SVladimir Kondratiev void wil_bcast_fini(struct wil6210_priv *wil) 48241d6b093SVladimir Kondratiev { 48341d6b093SVladimir Kondratiev int ri = wil->bcast_vring; 48441d6b093SVladimir Kondratiev 48541d6b093SVladimir Kondratiev if (ri < 0) 48641d6b093SVladimir Kondratiev return; 48741d6b093SVladimir Kondratiev 48841d6b093SVladimir Kondratiev wil->bcast_vring = -1; 48941d6b093SVladimir Kondratiev wil_vring_fini_tx(wil, ri); 49041d6b093SVladimir Kondratiev } 49141d6b093SVladimir Kondratiev 4922be7d22fSVladimir Kondratiev int wil_priv_init(struct wil6210_priv *wil) 4932be7d22fSVladimir Kondratiev { 494ec81b5adSDedy Lansky uint i; 495ec81b5adSDedy Lansky 496af3db60aSLazar Alexei wil_dbg_misc(wil, "priv_init\n"); 4972be7d22fSVladimir Kondratiev 4983df2cd36SVladimir Kondratiev memset(wil->sta, 0, sizeof(wil->sta)); 499ec81b5adSDedy Lansky for (i = 0; i < WIL6210_MAX_CID; i++) 500ec81b5adSDedy Lansky spin_lock_init(&wil->sta[i].tid_rx_lock); 5013df2cd36SVladimir Kondratiev 502875e9439SMaya Erez for (i = 0; i < WIL6210_MAX_TX_RINGS; i++) 503875e9439SMaya Erez spin_lock_init(&wil->vring_tx_data[i].lock); 504875e9439SMaya Erez 5052be7d22fSVladimir Kondratiev mutex_init(&wil->mutex); 5062be7d22fSVladimir Kondratiev mutex_init(&wil->wmi_mutex); 50740822a90SVladimir Kondratiev mutex_init(&wil->probe_client_mutex); 5084332cac1SLior David mutex_init(&wil->p2p_wdev_mutex); 509349214c1SMaya Erez mutex_init(&wil->halp.lock); 5102be7d22fSVladimir Kondratiev 5112be7d22fSVladimir Kondratiev init_completion(&wil->wmi_ready); 51259502647SDedy Lansky init_completion(&wil->wmi_call); 513349214c1SMaya Erez init_completion(&wil->halp.comp); 5142be7d22fSVladimir Kondratiev 51541d6b093SVladimir Kondratiev wil->bcast_vring = -1; 5162be7d22fSVladimir Kondratiev setup_timer(&wil->connect_timer, wil_connect_timer_fn, (ulong)wil); 517047e5d74SVladimir Kondratiev setup_timer(&wil->scan_timer, wil_scan_timer_fn, (ulong)wil); 518e6d68341SDedy Lansky setup_timer(&wil->p2p.discovery_timer, wil_p2p_discovery_timer_fn, 519e6d68341SDedy Lansky (ulong)wil); 5202be7d22fSVladimir Kondratiev 5212be7d22fSVladimir Kondratiev INIT_WORK(&wil->disconnect_worker, wil_disconnect_worker); 5222be7d22fSVladimir Kondratiev INIT_WORK(&wil->wmi_event_worker, wmi_event_worker); 523ed6f9dc6SVladimir Kondratiev INIT_WORK(&wil->fw_error_worker, wil_fw_error_worker); 52440822a90SVladimir Kondratiev INIT_WORK(&wil->probe_client_worker, wil_probe_client_worker); 525bb6743f7SLior David INIT_WORK(&wil->p2p.delayed_listen_work, wil_p2p_delayed_listen_work); 5262be7d22fSVladimir Kondratiev 5272be7d22fSVladimir Kondratiev INIT_LIST_HEAD(&wil->pending_wmi_ev); 52840822a90SVladimir Kondratiev INIT_LIST_HEAD(&wil->probe_client_pending); 5292be7d22fSVladimir Kondratiev spin_lock_init(&wil->wmi_ev_lock); 530f9e3033fSDedy Lansky spin_lock_init(&wil->net_queue_lock); 531f9e3033fSDedy Lansky wil->net_queue_stopped = 1; 532c33407a8SVladimir Kondratiev init_waitqueue_head(&wil->wq); 5332be7d22fSVladimir Kondratiev 5342be7d22fSVladimir Kondratiev wil->wmi_wq = create_singlethread_workqueue(WIL_NAME "_wmi"); 5352be7d22fSVladimir Kondratiev if (!wil->wmi_wq) 5362be7d22fSVladimir Kondratiev return -EAGAIN; 5372be7d22fSVladimir Kondratiev 5383277213fSVladimir Kondratiev wil->wq_service = create_singlethread_workqueue(WIL_NAME "_service"); 5393277213fSVladimir Kondratiev if (!wil->wq_service) 5403277213fSVladimir Kondratiev goto out_wmi_wq; 5412be7d22fSVladimir Kondratiev 542fc219eedSVladimir Kondratiev wil->last_fw_recovery = jiffies; 5431f80af2eSVladimir Shulman wil->tx_interframe_timeout = WIL6210_ITR_TX_INTERFRAME_TIMEOUT_DEFAULT; 5441f80af2eSVladimir Shulman wil->rx_interframe_timeout = WIL6210_ITR_RX_INTERFRAME_TIMEOUT_DEFAULT; 5451f80af2eSVladimir Shulman wil->tx_max_burst_duration = WIL6210_ITR_TX_MAX_BURST_DURATION_DEFAULT; 5461f80af2eSVladimir Shulman wil->rx_max_burst_duration = WIL6210_ITR_RX_MAX_BURST_DURATION_DEFAULT; 547fc219eedSVladimir Kondratiev 548ab954628SVladimir Kondratiev if (rx_ring_overflow_thrsh == WIL6210_RX_HIGH_TRSH_INIT) 549ab954628SVladimir Kondratiev rx_ring_overflow_thrsh = WIL6210_RX_HIGH_TRSH_DEFAULT; 5502be7d22fSVladimir Kondratiev return 0; 5513277213fSVladimir Kondratiev 5523277213fSVladimir Kondratiev out_wmi_wq: 5533277213fSVladimir Kondratiev destroy_workqueue(wil->wmi_wq); 5543277213fSVladimir Kondratiev 5553277213fSVladimir Kondratiev return -EAGAIN; 5562be7d22fSVladimir Kondratiev } 5572be7d22fSVladimir Kondratiev 558b516fcc5SVladimir Kondratiev /** 559b516fcc5SVladimir Kondratiev * wil6210_disconnect - disconnect one connection 560b516fcc5SVladimir Kondratiev * @wil: driver context 561b516fcc5SVladimir Kondratiev * @bssid: peer to disconnect, NULL to disconnect all 5624821e6d8SVladimir Kondratiev * @reason_code: Reason code for the Disassociation frame 563b516fcc5SVladimir Kondratiev * @from_event: whether is invoked from FW event handler 564b516fcc5SVladimir Kondratiev * 565b516fcc5SVladimir Kondratiev * Disconnect and release associated resources. If invoked not from the 566b516fcc5SVladimir Kondratiev * FW event handler, issue WMI command(s) to trigger MAC disconnect. 567b516fcc5SVladimir Kondratiev */ 568b516fcc5SVladimir Kondratiev void wil6210_disconnect(struct wil6210_priv *wil, const u8 *bssid, 5694821e6d8SVladimir Kondratiev u16 reason_code, bool from_event) 5702be7d22fSVladimir Kondratiev { 571af3db60aSLazar Alexei wil_dbg_misc(wil, "disconnect\n"); 5729cf10d62SVladimir Kondratiev 5732be7d22fSVladimir Kondratiev del_timer_sync(&wil->connect_timer); 5744821e6d8SVladimir Kondratiev _wil6210_disconnect(wil, bssid, reason_code, from_event); 5752be7d22fSVladimir Kondratiev } 5762be7d22fSVladimir Kondratiev 5772be7d22fSVladimir Kondratiev void wil_priv_deinit(struct wil6210_priv *wil) 5782be7d22fSVladimir Kondratiev { 579af3db60aSLazar Alexei wil_dbg_misc(wil, "priv_deinit\n"); 5809cf10d62SVladimir Kondratiev 581c33407a8SVladimir Kondratiev wil_set_recovery_state(wil, fw_recovery_idle); 582047e5d74SVladimir Kondratiev del_timer_sync(&wil->scan_timer); 583e6d68341SDedy Lansky del_timer_sync(&wil->p2p.discovery_timer); 5842be7d22fSVladimir Kondratiev cancel_work_sync(&wil->disconnect_worker); 585ed6f9dc6SVladimir Kondratiev cancel_work_sync(&wil->fw_error_worker); 586e6d68341SDedy Lansky cancel_work_sync(&wil->p2p.discovery_expired_work); 587bb6743f7SLior David cancel_work_sync(&wil->p2p.delayed_listen_work); 588097638a0SVladimir Kondratiev mutex_lock(&wil->mutex); 5894821e6d8SVladimir Kondratiev wil6210_disconnect(wil, NULL, WLAN_REASON_DEAUTH_LEAVING, false); 590097638a0SVladimir Kondratiev mutex_unlock(&wil->mutex); 5912be7d22fSVladimir Kondratiev wmi_event_flush(wil); 59240822a90SVladimir Kondratiev wil_probe_client_flush(wil); 59340822a90SVladimir Kondratiev cancel_work_sync(&wil->probe_client_worker); 5943277213fSVladimir Kondratiev destroy_workqueue(wil->wq_service); 5952be7d22fSVladimir Kondratiev destroy_workqueue(wil->wmi_wq); 5962be7d22fSVladimir Kondratiev } 5972be7d22fSVladimir Kondratiev 598151a9706SVladimir Kondratiev static inline void wil_halt_cpu(struct wil6210_priv *wil) 599151a9706SVladimir Kondratiev { 600b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_USER_CPU_0, BIT_USER_USER_CPU_MAN_RST); 601b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_MAC_CPU_0, BIT_USER_MAC_CPU_MAN_RST); 602151a9706SVladimir Kondratiev } 603151a9706SVladimir Kondratiev 604151a9706SVladimir Kondratiev static inline void wil_release_cpu(struct wil6210_priv *wil) 605151a9706SVladimir Kondratiev { 606151a9706SVladimir Kondratiev /* Start CPU */ 607b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_USER_CPU_0, 1); 608151a9706SVladimir Kondratiev } 609151a9706SVladimir Kondratiev 6101f1a361aSLior David static void wil_set_oob_mode(struct wil6210_priv *wil, bool enable) 6111f1a361aSLior David { 612af3db60aSLazar Alexei wil_info(wil, "enable=%d\n", enable); 613349214c1SMaya Erez if (enable) 6141f1a361aSLior David wil_s(wil, RGF_USER_USAGE_6, BIT_USER_OOB_MODE); 615349214c1SMaya Erez else 6161f1a361aSLior David wil_c(wil, RGF_USER_USAGE_6, BIT_USER_OOB_MODE); 6171f1a361aSLior David } 6181f1a361aSLior David 619bbb2adc7SVladimir Kondratiev static int wil_target_reset(struct wil6210_priv *wil) 6202be7d22fSVladimir Kondratiev { 62198a65b59SVladimir Kondratiev int delay = 0; 622bb6c8dccSVladimir Kondratiev u32 x, x1 = 0; 62336b10a72SVladimir Kondratiev 6241aeda13bSVladimir Kondratiev wil_dbg_misc(wil, "Resetting \"%s\"...\n", wil->hw_name); 6256508281bSVladimir Kondratiev 6266508281bSVladimir Kondratiev /* Clear MAC link up */ 627b9eeb512SVladimir Kondratiev wil_s(wil, RGF_HP_CTRL, BIT(15)); 628b9eeb512SVladimir Kondratiev wil_s(wil, RGF_USER_CLKS_CTL_SW_RST_MASK_0, BIT_HPAL_PERST_FROM_PAD); 629b9eeb512SVladimir Kondratiev wil_s(wil, RGF_USER_CLKS_CTL_SW_RST_MASK_0, BIT_CAR_PERST_RST); 630151a9706SVladimir Kondratiev 631151a9706SVladimir Kondratiev wil_halt_cpu(wil); 6322be7d22fSVladimir Kondratiev 6332cd0f021SVladimir Kondratiev /* clear all boot loader "ready" bits */ 634b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_BL + 635f1ad8c93SVladimir Kondratiev offsetof(struct bl_dedicated_registers_v0, boot_loader_ready), 0); 636cce47711SVladimir Kondratiev /* Clear Fw Download notification */ 637b9eeb512SVladimir Kondratiev wil_c(wil, RGF_USER_USAGE_6, BIT(0)); 638cce47711SVladimir Kondratiev 639b9eeb512SVladimir Kondratiev wil_s(wil, RGF_CAF_OSC_CONTROL, BIT_CAF_OSC_XTAL_EN); 64048516298SVladimir Kondratiev /* XTAL stabilization should take about 3ms */ 64148516298SVladimir Kondratiev usleep_range(5000, 7000); 642b9eeb512SVladimir Kondratiev x = wil_r(wil, RGF_CAF_PLL_LOCK_STATUS); 64348516298SVladimir Kondratiev if (!(x & BIT_CAF_OSC_DIG_XTAL_STABLE)) { 64448516298SVladimir Kondratiev wil_err(wil, "Xtal stabilization timeout\n" 64548516298SVladimir Kondratiev "RGF_CAF_PLL_LOCK_STATUS = 0x%08x\n", x); 64648516298SVladimir Kondratiev return -ETIME; 64748516298SVladimir Kondratiev } 64848516298SVladimir Kondratiev /* switch 10k to XTAL*/ 649b9eeb512SVladimir Kondratiev wil_c(wil, RGF_USER_SPARROW_M_4, BIT_SPARROW_M_4_SEL_SLEEP_OR_REF); 65048516298SVladimir Kondratiev /* 40 MHz */ 651b9eeb512SVladimir Kondratiev wil_c(wil, RGF_USER_CLKS_CTL_0, BIT_USER_CLKS_CAR_AHB_SW_SEL); 65248516298SVladimir Kondratiev 653b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_0, 0x3ff81f); 654b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_1, 0xf); 6556508281bSVladimir Kondratiev 656b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0xFE000000); 657b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_1, 0x0000003F); 658b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0x000000f0); 659b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0xFFE7FE00); 6602be7d22fSVladimir Kondratiev 661b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_0, 0x0); 662b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_1, 0x0); 6636508281bSVladimir Kondratiev 664b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0); 665b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0); 666b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_1, 0); 667b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0); 6682be7d22fSVladimir Kondratiev 669b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0x00000003); 670b9eeb512SVladimir Kondratiev /* reset A2 PCIE AHB */ 671b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0x00008000); 6726508281bSVladimir Kondratiev 673b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0); 6742be7d22fSVladimir Kondratiev 6752cd0f021SVladimir Kondratiev /* wait until device ready. typical time is 20..80 msec */ 67636b10a72SVladimir Kondratiev do { 677520d68e7SVladimir Kondratiev msleep(RST_DELAY); 678b9eeb512SVladimir Kondratiev x = wil_r(wil, RGF_USER_BL + 679b9eeb512SVladimir Kondratiev offsetof(struct bl_dedicated_registers_v0, 680f1ad8c93SVladimir Kondratiev boot_loader_ready)); 681bb6c8dccSVladimir Kondratiev if (x1 != x) { 682bb6c8dccSVladimir Kondratiev wil_dbg_misc(wil, "BL.ready 0x%08x => 0x%08x\n", x1, x); 683bb6c8dccSVladimir Kondratiev x1 = x; 684bb6c8dccSVladimir Kondratiev } 685520d68e7SVladimir Kondratiev if (delay++ > RST_COUNT) { 6862cd0f021SVladimir Kondratiev wil_err(wil, "Reset not completed, bl.ready 0x%08x\n", 68748516298SVladimir Kondratiev x); 688bbb2adc7SVladimir Kondratiev return -ETIME; 68936b10a72SVladimir Kondratiev } 690f1ad8c93SVladimir Kondratiev } while (x != BL_READY); 69136b10a72SVladimir Kondratiev 692b9eeb512SVladimir Kondratiev wil_c(wil, RGF_USER_CLKS_CTL_0, BIT_USER_CLKS_RST_PWGD); 693972072aaSVladimir Kondratiev 694e3351277SVladimir Kondratiev /* enable fix for HW bug related to the SA/DA swap in AP Rx */ 695b9eeb512SVladimir Kondratiev wil_s(wil, RGF_DMA_OFUL_NID_0, BIT_DMA_OFUL_NID_0_RX_EXT_TR_EN | 696e3351277SVladimir Kondratiev BIT_DMA_OFUL_NID_0_RX_EXT_A3_SRC); 697e3351277SVladimir Kondratiev 698520d68e7SVladimir Kondratiev wil_dbg_misc(wil, "Reset completed in %d ms\n", delay * RST_DELAY); 699bbb2adc7SVladimir Kondratiev return 0; 700151a9706SVladimir Kondratiev } 7012be7d22fSVladimir Kondratiev 7023fea18d0SLior David static void wil_collect_fw_info(struct wil6210_priv *wil) 7033fea18d0SLior David { 7043fea18d0SLior David struct wiphy *wiphy = wil_to_wiphy(wil); 7053fea18d0SLior David u8 retry_short; 7063fea18d0SLior David int rc; 7073fea18d0SLior David 7083fea18d0SLior David rc = wmi_get_mgmt_retry(wil, &retry_short); 7093fea18d0SLior David if (!rc) { 7103fea18d0SLior David wiphy->retry_short = retry_short; 7113fea18d0SLior David wil_dbg_misc(wil, "FW retry_short: %d\n", retry_short); 7123fea18d0SLior David } 7133fea18d0SLior David } 7143fea18d0SLior David 7152be7d22fSVladimir Kondratiev void wil_mbox_ring_le2cpus(struct wil6210_mbox_ring *r) 7162be7d22fSVladimir Kondratiev { 7172be7d22fSVladimir Kondratiev le32_to_cpus(&r->base); 7182be7d22fSVladimir Kondratiev le16_to_cpus(&r->entry_size); 7192be7d22fSVladimir Kondratiev le16_to_cpus(&r->size); 7202be7d22fSVladimir Kondratiev le32_to_cpus(&r->tail); 7212be7d22fSVladimir Kondratiev le32_to_cpus(&r->head); 7222be7d22fSVladimir Kondratiev } 7232be7d22fSVladimir Kondratiev 7242cd0f021SVladimir Kondratiev static int wil_get_bl_info(struct wil6210_priv *wil) 7252cd0f021SVladimir Kondratiev { 7262cd0f021SVladimir Kondratiev struct net_device *ndev = wil_to_ndev(wil); 727b42f1196SHamad Kadmany struct wiphy *wiphy = wil_to_wiphy(wil); 728f1ad8c93SVladimir Kondratiev union { 729f1ad8c93SVladimir Kondratiev struct bl_dedicated_registers_v0 bl0; 730f1ad8c93SVladimir Kondratiev struct bl_dedicated_registers_v1 bl1; 731f1ad8c93SVladimir Kondratiev } bl; 732f1ad8c93SVladimir Kondratiev u32 bl_ver; 733f1ad8c93SVladimir Kondratiev u8 *mac; 734f1ad8c93SVladimir Kondratiev u16 rf_status; 7352cd0f021SVladimir Kondratiev 736f1ad8c93SVladimir Kondratiev wil_memcpy_fromio_32(&bl, wil->csr + HOSTADDR(RGF_USER_BL), 73719c871ceSVladimir Kondratiev sizeof(bl)); 73819c871ceSVladimir Kondratiev bl_ver = le32_to_cpu(bl.bl0.boot_loader_struct_version); 73919c871ceSVladimir Kondratiev mac = bl.bl0.mac_address; 74019c871ceSVladimir Kondratiev 74119c871ceSVladimir Kondratiev if (bl_ver == 0) { 742f1ad8c93SVladimir Kondratiev le32_to_cpus(&bl.bl0.rf_type); 743f1ad8c93SVladimir Kondratiev le32_to_cpus(&bl.bl0.baseband_type); 744f1ad8c93SVladimir Kondratiev rf_status = 0; /* actually, unknown */ 745f1ad8c93SVladimir Kondratiev wil_info(wil, 746f1ad8c93SVladimir Kondratiev "Boot Loader struct v%d: MAC = %pM RF = 0x%08x bband = 0x%08x\n", 747f1ad8c93SVladimir Kondratiev bl_ver, mac, 748f1ad8c93SVladimir Kondratiev bl.bl0.rf_type, bl.bl0.baseband_type); 749f1ad8c93SVladimir Kondratiev wil_info(wil, "Boot Loader build unknown for struct v0\n"); 75019c871ceSVladimir Kondratiev } else { 751f1ad8c93SVladimir Kondratiev le16_to_cpus(&bl.bl1.rf_type); 752f1ad8c93SVladimir Kondratiev rf_status = le16_to_cpu(bl.bl1.rf_status); 753f1ad8c93SVladimir Kondratiev le32_to_cpus(&bl.bl1.baseband_type); 754f1ad8c93SVladimir Kondratiev le16_to_cpus(&bl.bl1.bl_version_subminor); 755f1ad8c93SVladimir Kondratiev le16_to_cpus(&bl.bl1.bl_version_build); 756f1ad8c93SVladimir Kondratiev wil_info(wil, 757f1ad8c93SVladimir Kondratiev "Boot Loader struct v%d: MAC = %pM RF = 0x%04x (status 0x%04x) bband = 0x%08x\n", 758f1ad8c93SVladimir Kondratiev bl_ver, mac, 759f1ad8c93SVladimir Kondratiev bl.bl1.rf_type, rf_status, 760f1ad8c93SVladimir Kondratiev bl.bl1.baseband_type); 761f1ad8c93SVladimir Kondratiev wil_info(wil, "Boot Loader build %d.%d.%d.%d\n", 762f1ad8c93SVladimir Kondratiev bl.bl1.bl_version_major, bl.bl1.bl_version_minor, 763f1ad8c93SVladimir Kondratiev bl.bl1.bl_version_subminor, bl.bl1.bl_version_build); 7642cd0f021SVladimir Kondratiev } 7652cd0f021SVladimir Kondratiev 766f1ad8c93SVladimir Kondratiev if (!is_valid_ether_addr(mac)) { 767f1ad8c93SVladimir Kondratiev wil_err(wil, "BL: Invalid MAC %pM\n", mac); 768f1ad8c93SVladimir Kondratiev return -EINVAL; 769f1ad8c93SVladimir Kondratiev } 770f1ad8c93SVladimir Kondratiev 771f1ad8c93SVladimir Kondratiev ether_addr_copy(ndev->perm_addr, mac); 772b42f1196SHamad Kadmany ether_addr_copy(wiphy->perm_addr, mac); 7732cd0f021SVladimir Kondratiev if (!is_valid_ether_addr(ndev->dev_addr)) 774f1ad8c93SVladimir Kondratiev ether_addr_copy(ndev->dev_addr, mac); 775f1ad8c93SVladimir Kondratiev 776f1ad8c93SVladimir Kondratiev if (rf_status) {/* bad RF cable? */ 777f1ad8c93SVladimir Kondratiev wil_err(wil, "RF communication error 0x%04x", 778f1ad8c93SVladimir Kondratiev rf_status); 779f1ad8c93SVladimir Kondratiev return -EAGAIN; 780f1ad8c93SVladimir Kondratiev } 7812cd0f021SVladimir Kondratiev 7822cd0f021SVladimir Kondratiev return 0; 7832cd0f021SVladimir Kondratiev } 7842cd0f021SVladimir Kondratiev 785409ead54SVladimir Kondratiev static void wil_bl_crash_info(struct wil6210_priv *wil, bool is_err) 786409ead54SVladimir Kondratiev { 787409ead54SVladimir Kondratiev u32 bl_assert_code, bl_assert_blink, bl_magic_number; 788409ead54SVladimir Kondratiev u32 bl_ver = wil_r(wil, RGF_USER_BL + 789409ead54SVladimir Kondratiev offsetof(struct bl_dedicated_registers_v0, 790409ead54SVladimir Kondratiev boot_loader_struct_version)); 791409ead54SVladimir Kondratiev 792409ead54SVladimir Kondratiev if (bl_ver < 2) 793409ead54SVladimir Kondratiev return; 794409ead54SVladimir Kondratiev 795409ead54SVladimir Kondratiev bl_assert_code = wil_r(wil, RGF_USER_BL + 796409ead54SVladimir Kondratiev offsetof(struct bl_dedicated_registers_v1, 797409ead54SVladimir Kondratiev bl_assert_code)); 798409ead54SVladimir Kondratiev bl_assert_blink = wil_r(wil, RGF_USER_BL + 799409ead54SVladimir Kondratiev offsetof(struct bl_dedicated_registers_v1, 800409ead54SVladimir Kondratiev bl_assert_blink)); 801409ead54SVladimir Kondratiev bl_magic_number = wil_r(wil, RGF_USER_BL + 802409ead54SVladimir Kondratiev offsetof(struct bl_dedicated_registers_v1, 803409ead54SVladimir Kondratiev bl_magic_number)); 804409ead54SVladimir Kondratiev 805409ead54SVladimir Kondratiev if (is_err) { 806409ead54SVladimir Kondratiev wil_err(wil, 807409ead54SVladimir Kondratiev "BL assert code 0x%08x blink 0x%08x magic 0x%08x\n", 808409ead54SVladimir Kondratiev bl_assert_code, bl_assert_blink, bl_magic_number); 809409ead54SVladimir Kondratiev } else { 810409ead54SVladimir Kondratiev wil_dbg_misc(wil, 811409ead54SVladimir Kondratiev "BL assert code 0x%08x blink 0x%08x magic 0x%08x\n", 812409ead54SVladimir Kondratiev bl_assert_code, bl_assert_blink, bl_magic_number); 813409ead54SVladimir Kondratiev } 814409ead54SVladimir Kondratiev } 815409ead54SVladimir Kondratiev 8162be7d22fSVladimir Kondratiev static int wil_wait_for_fw_ready(struct wil6210_priv *wil) 8172be7d22fSVladimir Kondratiev { 8182be7d22fSVladimir Kondratiev ulong to = msecs_to_jiffies(1000); 8192be7d22fSVladimir Kondratiev ulong left = wait_for_completion_timeout(&wil->wmi_ready, to); 8208fe59627SVladimir Kondratiev 8212be7d22fSVladimir Kondratiev if (0 == left) { 8222be7d22fSVladimir Kondratiev wil_err(wil, "Firmware not ready\n"); 8232be7d22fSVladimir Kondratiev return -ETIME; 8242be7d22fSVladimir Kondratiev } else { 82515e23124SVladimir Kondratiev wil_info(wil, "FW ready after %d ms. HW version 0x%08x\n", 82615e23124SVladimir Kondratiev jiffies_to_msecs(to-left), wil->hw_version); 8272be7d22fSVladimir Kondratiev } 8282be7d22fSVladimir Kondratiev return 0; 8292be7d22fSVladimir Kondratiev } 8302be7d22fSVladimir Kondratiev 831035859a5SMaya Erez void wil_abort_scan(struct wil6210_priv *wil, bool sync) 832035859a5SMaya Erez { 833035859a5SMaya Erez int rc; 834035859a5SMaya Erez struct cfg80211_scan_info info = { 835035859a5SMaya Erez .aborted = true, 836035859a5SMaya Erez }; 837035859a5SMaya Erez 838035859a5SMaya Erez lockdep_assert_held(&wil->p2p_wdev_mutex); 839035859a5SMaya Erez 840035859a5SMaya Erez if (!wil->scan_request) 841035859a5SMaya Erez return; 842035859a5SMaya Erez 843035859a5SMaya Erez wil_dbg_misc(wil, "Abort scan_request 0x%p\n", wil->scan_request); 844035859a5SMaya Erez del_timer_sync(&wil->scan_timer); 845035859a5SMaya Erez mutex_unlock(&wil->p2p_wdev_mutex); 846035859a5SMaya Erez rc = wmi_abort_scan(wil); 847035859a5SMaya Erez if (!rc && sync) 848035859a5SMaya Erez wait_event_interruptible_timeout(wil->wq, !wil->scan_request, 849035859a5SMaya Erez msecs_to_jiffies( 850035859a5SMaya Erez WAIT_FOR_SCAN_ABORT_MS)); 851035859a5SMaya Erez 852035859a5SMaya Erez mutex_lock(&wil->p2p_wdev_mutex); 853035859a5SMaya Erez if (wil->scan_request) { 854035859a5SMaya Erez cfg80211_scan_done(wil->scan_request, &info); 855035859a5SMaya Erez wil->scan_request = NULL; 856035859a5SMaya Erez } 857035859a5SMaya Erez } 858035859a5SMaya Erez 8592be7d22fSVladimir Kondratiev /* 8602be7d22fSVladimir Kondratiev * We reset all the structures, and we reset the UMAC. 8612be7d22fSVladimir Kondratiev * After calling this routine, you're expected to reload 8622be7d22fSVladimir Kondratiev * the firmware. 8632be7d22fSVladimir Kondratiev */ 8642cd0f021SVladimir Kondratiev int wil_reset(struct wil6210_priv *wil, bool load_fw) 8652be7d22fSVladimir Kondratiev { 8662be7d22fSVladimir Kondratiev int rc; 8672be7d22fSVladimir Kondratiev 868af3db60aSLazar Alexei wil_dbg_misc(wil, "reset\n"); 8699cf10d62SVladimir Kondratiev 870097638a0SVladimir Kondratiev WARN_ON(!mutex_is_locked(&wil->mutex)); 8719419b6a2SVladimir Kondratiev WARN_ON(test_bit(wil_status_napi_en, wil->status)); 872097638a0SVladimir Kondratiev 873bfc2dc7aSVladimir Kondratiev if (debug_fw) { 874bfc2dc7aSVladimir Kondratiev static const u8 mac[ETH_ALEN] = { 875bfc2dc7aSVladimir Kondratiev 0x00, 0xde, 0xad, 0x12, 0x34, 0x56, 876bfc2dc7aSVladimir Kondratiev }; 877bfc2dc7aSVladimir Kondratiev struct net_device *ndev = wil_to_ndev(wil); 878bfc2dc7aSVladimir Kondratiev 879bfc2dc7aSVladimir Kondratiev ether_addr_copy(ndev->perm_addr, mac); 880bfc2dc7aSVladimir Kondratiev ether_addr_copy(ndev->dev_addr, ndev->perm_addr); 881bfc2dc7aSVladimir Kondratiev return 0; 882bfc2dc7aSVladimir Kondratiev } 883bfc2dc7aSVladimir Kondratiev 88467131a1dSVladimir Kondratiev if (wil->hw_version == HW_VER_UNKNOWN) 88567131a1dSVladimir Kondratiev return -ENODEV; 88667131a1dSVladimir Kondratiev 8875f0823efSMaya Erez if (wil->platform_ops.notify) { 8885f0823efSMaya Erez rc = wil->platform_ops.notify(wil->platform_handle, 8895f0823efSMaya Erez WIL_PLATFORM_EVT_PRE_RESET); 8905f0823efSMaya Erez if (rc) 891af3db60aSLazar Alexei wil_err(wil, "PRE_RESET platform notify failed, rc %d\n", 892af3db60aSLazar Alexei rc); 8935f0823efSMaya Erez } 8945f0823efSMaya Erez 895f13e0630SHamad Kadmany set_bit(wil_status_resetting, wil->status); 896f13e0630SHamad Kadmany 897097638a0SVladimir Kondratiev cancel_work_sync(&wil->disconnect_worker); 8984821e6d8SVladimir Kondratiev wil6210_disconnect(wil, NULL, WLAN_REASON_DEAUTH_LEAVING, false); 89941d6b093SVladimir Kondratiev wil_bcast_fini(wil); 900097638a0SVladimir Kondratiev 90110d599adSMaya Erez /* Disable device led before reset*/ 90210d599adSMaya Erez wmi_led_cfg(wil, false); 90310d599adSMaya Erez 904452133a7SMaya Erez /* prevent NAPI from being scheduled and prevent wmi commands */ 905452133a7SMaya Erez mutex_lock(&wil->wmi_mutex); 9069419b6a2SVladimir Kondratiev bitmap_zero(wil->status, wil_status_last); 907452133a7SMaya Erez mutex_unlock(&wil->wmi_mutex); 9080fef1818SVladimir Kondratiev 9095ffae432SLior David mutex_lock(&wil->p2p_wdev_mutex); 910035859a5SMaya Erez wil_abort_scan(wil, false); 9115ffae432SLior David mutex_unlock(&wil->p2p_wdev_mutex); 912ed6f9dc6SVladimir Kondratiev 913e4dbb093SVladimir Kondratiev wil_mask_irq(wil); 9142be7d22fSVladimir Kondratiev 915e08b5906SVladimir Kondratiev wmi_event_flush(wil); 916e08b5906SVladimir Kondratiev 9173277213fSVladimir Kondratiev flush_workqueue(wil->wq_service); 918e08b5906SVladimir Kondratiev flush_workqueue(wil->wmi_wq); 919e08b5906SVladimir Kondratiev 920409ead54SVladimir Kondratiev wil_bl_crash_info(wil, false); 921bbb2adc7SVladimir Kondratiev rc = wil_target_reset(wil); 9228bf6adb9SVladimir Kondratiev wil_rx_fini(wil); 923409ead54SVladimir Kondratiev if (rc) { 924409ead54SVladimir Kondratiev wil_bl_crash_info(wil, true); 925bbb2adc7SVladimir Kondratiev return rc; 926409ead54SVladimir Kondratiev } 927bbb2adc7SVladimir Kondratiev 9282cd0f021SVladimir Kondratiev rc = wil_get_bl_info(wil); 929f1ad8c93SVladimir Kondratiev if (rc == -EAGAIN && !load_fw) /* ignore RF error if not going up */ 930f1ad8c93SVladimir Kondratiev rc = 0; 9312cd0f021SVladimir Kondratiev if (rc) 9322cd0f021SVladimir Kondratiev return rc; 9332cd0f021SVladimir Kondratiev 9341f1a361aSLior David wil_set_oob_mode(wil, oob_mode); 9352cd0f021SVladimir Kondratiev if (load_fw) { 936a351f2f5SLazar Alexei wil_info(wil, "Use firmware <%s> + board <%s>\n", 937a351f2f5SLazar Alexei wil->wil_fw_name, WIL_BOARD_FILE_NAME); 9382cd0f021SVladimir Kondratiev 939151a9706SVladimir Kondratiev wil_halt_cpu(wil); 94013cd9f75SLior David memset(wil->fw_version, 0, sizeof(wil->fw_version)); 941151a9706SVladimir Kondratiev /* Loading f/w from the file */ 942a351f2f5SLazar Alexei rc = wil_request_firmware(wil, wil->wil_fw_name, true); 943151a9706SVladimir Kondratiev if (rc) 944151a9706SVladimir Kondratiev return rc; 945a351f2f5SLazar Alexei rc = wil_request_firmware(wil, WIL_BOARD_FILE_NAME, true); 9462cd0f021SVladimir Kondratiev if (rc) 9472cd0f021SVladimir Kondratiev return rc; 948151a9706SVladimir Kondratiev 9492cd0f021SVladimir Kondratiev /* Mark FW as loaded from host */ 950b9eeb512SVladimir Kondratiev wil_s(wil, RGF_USER_USAGE_6, 1); 9512cd0f021SVladimir Kondratiev 9522cd0f021SVladimir Kondratiev /* clear any interrupts which on-card-firmware 9532cd0f021SVladimir Kondratiev * may have set 9542cd0f021SVladimir Kondratiev */ 955151a9706SVladimir Kondratiev wil6210_clear_irq(wil); 9562cd0f021SVladimir Kondratiev /* CAF_ICR - clear and mask */ 9572cd0f021SVladimir Kondratiev /* it is W1C, clear by writing back same value */ 958b9eeb512SVladimir Kondratiev wil_s(wil, RGF_CAF_ICR + offsetof(struct RGF_ICR, ICR), 0); 959b9eeb512SVladimir Kondratiev wil_w(wil, RGF_CAF_ICR + offsetof(struct RGF_ICR, IMV), ~0); 960151a9706SVladimir Kondratiev 961151a9706SVladimir Kondratiev wil_release_cpu(wil); 962151a9706SVladimir Kondratiev } 9638bf6adb9SVladimir Kondratiev 9642be7d22fSVladimir Kondratiev /* init after reset */ 96502beaf1aSVladimir Kondratiev wil->ap_isolate = 0; 96616735d02SWolfram Sang reinit_completion(&wil->wmi_ready); 96759502647SDedy Lansky reinit_completion(&wil->wmi_call); 968349214c1SMaya Erez reinit_completion(&wil->halp.comp); 9692be7d22fSVladimir Kondratiev 9702cd0f021SVladimir Kondratiev if (load_fw) { 97178366f69SVladimir Kondratiev wil_configure_interrupt_moderation(wil); 972e4dbb093SVladimir Kondratiev wil_unmask_irq(wil); 9732be7d22fSVladimir Kondratiev 9742be7d22fSVladimir Kondratiev /* we just started MAC, wait for FW ready */ 9752be7d22fSVladimir Kondratiev rc = wil_wait_for_fw_ready(wil); 9765f0823efSMaya Erez if (rc) 9775f0823efSMaya Erez return rc; 9785f0823efSMaya Erez 9795f0823efSMaya Erez /* check FW is responsive */ 980cec94d8cSVladimir Kondratiev rc = wmi_echo(wil); 9815f0823efSMaya Erez if (rc) { 982af3db60aSLazar Alexei wil_err(wil, "wmi_echo failed, rc %d\n", rc); 9835f0823efSMaya Erez return rc; 9845f0823efSMaya Erez } 9855f0823efSMaya Erez 9863fea18d0SLior David wil_collect_fw_info(wil); 9873fea18d0SLior David 9885f0823efSMaya Erez if (wil->platform_ops.notify) { 9895f0823efSMaya Erez rc = wil->platform_ops.notify(wil->platform_handle, 9905f0823efSMaya Erez WIL_PLATFORM_EVT_FW_RDY); 9915f0823efSMaya Erez if (rc) { 992af3db60aSLazar Alexei wil_err(wil, "FW_RDY notify failed, rc %d\n", 993af3db60aSLazar Alexei rc); 9945f0823efSMaya Erez rc = 0; 9955f0823efSMaya Erez } 9965f0823efSMaya Erez } 9972cd0f021SVladimir Kondratiev } 9982be7d22fSVladimir Kondratiev 9992be7d22fSVladimir Kondratiev return rc; 10002be7d22fSVladimir Kondratiev } 10012be7d22fSVladimir Kondratiev 1002ed6f9dc6SVladimir Kondratiev void wil_fw_error_recovery(struct wil6210_priv *wil) 1003ed6f9dc6SVladimir Kondratiev { 1004ed6f9dc6SVladimir Kondratiev wil_dbg_misc(wil, "starting fw error recovery\n"); 1005f13e0630SHamad Kadmany 1006f13e0630SHamad Kadmany if (test_bit(wil_status_resetting, wil->status)) { 1007f13e0630SHamad Kadmany wil_info(wil, "Reset already in progress\n"); 1008f13e0630SHamad Kadmany return; 1009f13e0630SHamad Kadmany } 1010f13e0630SHamad Kadmany 1011c33407a8SVladimir Kondratiev wil->recovery_state = fw_recovery_pending; 1012ed6f9dc6SVladimir Kondratiev schedule_work(&wil->fw_error_worker); 1013ed6f9dc6SVladimir Kondratiev } 10142be7d22fSVladimir Kondratiev 101573d839aeSVladimir Kondratiev int __wil_up(struct wil6210_priv *wil) 10162be7d22fSVladimir Kondratiev { 10172be7d22fSVladimir Kondratiev struct net_device *ndev = wil_to_ndev(wil); 10182be7d22fSVladimir Kondratiev struct wireless_dev *wdev = wil->wdev; 10192be7d22fSVladimir Kondratiev int rc; 10202be7d22fSVladimir Kondratiev 1021097638a0SVladimir Kondratiev WARN_ON(!mutex_is_locked(&wil->mutex)); 1022097638a0SVladimir Kondratiev 10232cd0f021SVladimir Kondratiev rc = wil_reset(wil, true); 10242be7d22fSVladimir Kondratiev if (rc) 10252be7d22fSVladimir Kondratiev return rc; 10262be7d22fSVladimir Kondratiev 1027e31b2562SVladimir Kondratiev /* Rx VRING. After MAC and beacon */ 1028d3762b40SVladimir Kondratiev rc = wil_rx_init(wil, 1 << rx_ring_order); 1029e31b2562SVladimir Kondratiev if (rc) 1030e31b2562SVladimir Kondratiev return rc; 1031e31b2562SVladimir Kondratiev 10322be7d22fSVladimir Kondratiev switch (wdev->iftype) { 10332be7d22fSVladimir Kondratiev case NL80211_IFTYPE_STATION: 10347743882dSVladimir Kondratiev wil_dbg_misc(wil, "type: STATION\n"); 10352be7d22fSVladimir Kondratiev ndev->type = ARPHRD_ETHER; 10362be7d22fSVladimir Kondratiev break; 10372be7d22fSVladimir Kondratiev case NL80211_IFTYPE_AP: 10387743882dSVladimir Kondratiev wil_dbg_misc(wil, "type: AP\n"); 10392be7d22fSVladimir Kondratiev ndev->type = ARPHRD_ETHER; 10402be7d22fSVladimir Kondratiev break; 10412be7d22fSVladimir Kondratiev case NL80211_IFTYPE_P2P_CLIENT: 10427743882dSVladimir Kondratiev wil_dbg_misc(wil, "type: P2P_CLIENT\n"); 10432be7d22fSVladimir Kondratiev ndev->type = ARPHRD_ETHER; 10442be7d22fSVladimir Kondratiev break; 10452be7d22fSVladimir Kondratiev case NL80211_IFTYPE_P2P_GO: 10467743882dSVladimir Kondratiev wil_dbg_misc(wil, "type: P2P_GO\n"); 10472be7d22fSVladimir Kondratiev ndev->type = ARPHRD_ETHER; 10482be7d22fSVladimir Kondratiev break; 10492be7d22fSVladimir Kondratiev case NL80211_IFTYPE_MONITOR: 10507743882dSVladimir Kondratiev wil_dbg_misc(wil, "type: Monitor\n"); 10512be7d22fSVladimir Kondratiev ndev->type = ARPHRD_IEEE80211_RADIOTAP; 10522be7d22fSVladimir Kondratiev /* ARPHRD_IEEE80211 or ARPHRD_IEEE80211_RADIOTAP ? */ 10532be7d22fSVladimir Kondratiev break; 10542be7d22fSVladimir Kondratiev default: 10552be7d22fSVladimir Kondratiev return -EOPNOTSUPP; 10562be7d22fSVladimir Kondratiev } 10572be7d22fSVladimir Kondratiev 10582be7d22fSVladimir Kondratiev /* MAC address - pre-requisite for other commands */ 10592be7d22fSVladimir Kondratiev wmi_set_mac_address(wil, ndev->dev_addr); 10602be7d22fSVladimir Kondratiev 106173d839aeSVladimir Kondratiev wil_dbg_misc(wil, "NAPI enable\n"); 1062e0287c4aSVladimir Kondratiev napi_enable(&wil->napi_rx); 1063e0287c4aSVladimir Kondratiev napi_enable(&wil->napi_tx); 10649419b6a2SVladimir Kondratiev set_bit(wil_status_napi_en, wil->status); 1065e0287c4aSVladimir Kondratiev 1066f772ebfbSVladimir Kondratiev if (wil->platform_ops.bus_request) 1067f772ebfbSVladimir Kondratiev wil->platform_ops.bus_request(wil->platform_handle, 1068f772ebfbSVladimir Kondratiev WIL_MAX_BUS_REQUEST_KBPS); 1069f772ebfbSVladimir Kondratiev 10702be7d22fSVladimir Kondratiev return 0; 10712be7d22fSVladimir Kondratiev } 10722be7d22fSVladimir Kondratiev 10732be7d22fSVladimir Kondratiev int wil_up(struct wil6210_priv *wil) 10742be7d22fSVladimir Kondratiev { 10752be7d22fSVladimir Kondratiev int rc; 10762be7d22fSVladimir Kondratiev 1077af3db60aSLazar Alexei wil_dbg_misc(wil, "up\n"); 10789cf10d62SVladimir Kondratiev 10792be7d22fSVladimir Kondratiev mutex_lock(&wil->mutex); 10802be7d22fSVladimir Kondratiev rc = __wil_up(wil); 10812be7d22fSVladimir Kondratiev mutex_unlock(&wil->mutex); 10822be7d22fSVladimir Kondratiev 10832be7d22fSVladimir Kondratiev return rc; 10842be7d22fSVladimir Kondratiev } 10852be7d22fSVladimir Kondratiev 108673d839aeSVladimir Kondratiev int __wil_down(struct wil6210_priv *wil) 10872be7d22fSVladimir Kondratiev { 1088097638a0SVladimir Kondratiev WARN_ON(!mutex_is_locked(&wil->mutex)); 1089097638a0SVladimir Kondratiev 1090b0c0e688SLazar Alexei set_bit(wil_status_resetting, wil->status); 1091b0c0e688SLazar Alexei 1092f772ebfbSVladimir Kondratiev if (wil->platform_ops.bus_request) 1093f772ebfbSVladimir Kondratiev wil->platform_ops.bus_request(wil->platform_handle, 0); 1094f772ebfbSVladimir Kondratiev 109573d839aeSVladimir Kondratiev wil_disable_irq(wil); 10969419b6a2SVladimir Kondratiev if (test_and_clear_bit(wil_status_napi_en, wil->status)) { 1097e0287c4aSVladimir Kondratiev napi_disable(&wil->napi_rx); 1098e0287c4aSVladimir Kondratiev napi_disable(&wil->napi_tx); 109973d839aeSVladimir Kondratiev wil_dbg_misc(wil, "NAPI disable\n"); 110073d839aeSVladimir Kondratiev } 110173d839aeSVladimir Kondratiev wil_enable_irq(wil); 1102e0287c4aSVladimir Kondratiev 11035ffae432SLior David mutex_lock(&wil->p2p_wdev_mutex); 1104035859a5SMaya Erez wil_p2p_stop_radio_operations(wil); 1105035859a5SMaya Erez wil_abort_scan(wil, false); 11065ffae432SLior David mutex_unlock(&wil->p2p_wdev_mutex); 11072be7d22fSVladimir Kondratiev 11082cd0f021SVladimir Kondratiev wil_reset(wil, false); 11092be7d22fSVladimir Kondratiev 11102be7d22fSVladimir Kondratiev return 0; 11112be7d22fSVladimir Kondratiev } 11122be7d22fSVladimir Kondratiev 11132be7d22fSVladimir Kondratiev int wil_down(struct wil6210_priv *wil) 11142be7d22fSVladimir Kondratiev { 11152be7d22fSVladimir Kondratiev int rc; 11162be7d22fSVladimir Kondratiev 1117af3db60aSLazar Alexei wil_dbg_misc(wil, "down\n"); 11189cf10d62SVladimir Kondratiev 1119c33407a8SVladimir Kondratiev wil_set_recovery_state(wil, fw_recovery_idle); 11202be7d22fSVladimir Kondratiev mutex_lock(&wil->mutex); 11212be7d22fSVladimir Kondratiev rc = __wil_down(wil); 11222be7d22fSVladimir Kondratiev mutex_unlock(&wil->mutex); 11232be7d22fSVladimir Kondratiev 11242be7d22fSVladimir Kondratiev return rc; 11252be7d22fSVladimir Kondratiev } 11263df2cd36SVladimir Kondratiev 11273df2cd36SVladimir Kondratiev int wil_find_cid(struct wil6210_priv *wil, const u8 *mac) 11283df2cd36SVladimir Kondratiev { 11293df2cd36SVladimir Kondratiev int i; 11303df2cd36SVladimir Kondratiev int rc = -ENOENT; 11313df2cd36SVladimir Kondratiev 11323df2cd36SVladimir Kondratiev for (i = 0; i < ARRAY_SIZE(wil->sta); i++) { 11333df2cd36SVladimir Kondratiev if ((wil->sta[i].status != wil_sta_unused) && 1134108d1eb6SVladimir Kondratiev ether_addr_equal(wil->sta[i].addr, mac)) { 11353df2cd36SVladimir Kondratiev rc = i; 11363df2cd36SVladimir Kondratiev break; 11373df2cd36SVladimir Kondratiev } 11383df2cd36SVladimir Kondratiev } 11393df2cd36SVladimir Kondratiev 11403df2cd36SVladimir Kondratiev return rc; 11413df2cd36SVladimir Kondratiev } 1142349214c1SMaya Erez 1143349214c1SMaya Erez void wil_halp_vote(struct wil6210_priv *wil) 1144349214c1SMaya Erez { 1145349214c1SMaya Erez unsigned long rc; 1146349214c1SMaya Erez unsigned long to_jiffies = msecs_to_jiffies(WAIT_FOR_HALP_VOTE_MS); 1147349214c1SMaya Erez 1148349214c1SMaya Erez mutex_lock(&wil->halp.lock); 1149349214c1SMaya Erez 1150af3db60aSLazar Alexei wil_dbg_irq(wil, "halp_vote: start, HALP ref_cnt (%d)\n", 1151349214c1SMaya Erez wil->halp.ref_cnt); 1152349214c1SMaya Erez 1153349214c1SMaya Erez if (++wil->halp.ref_cnt == 1) { 1154349214c1SMaya Erez wil6210_set_halp(wil); 1155349214c1SMaya Erez rc = wait_for_completion_timeout(&wil->halp.comp, to_jiffies); 1156f1b7764fSMaya Erez if (!rc) { 1157af3db60aSLazar Alexei wil_err(wil, "HALP vote timed out\n"); 1158f1b7764fSMaya Erez /* Mask HALP as done in case the interrupt is raised */ 1159f1b7764fSMaya Erez wil6210_mask_halp(wil); 1160f1b7764fSMaya Erez } else { 1161ef86f249SLior David wil_dbg_irq(wil, 1162af3db60aSLazar Alexei "halp_vote: HALP vote completed after %d ms\n", 1163349214c1SMaya Erez jiffies_to_msecs(to_jiffies - rc)); 1164349214c1SMaya Erez } 1165f1b7764fSMaya Erez } 1166349214c1SMaya Erez 1167af3db60aSLazar Alexei wil_dbg_irq(wil, "halp_vote: end, HALP ref_cnt (%d)\n", 1168349214c1SMaya Erez wil->halp.ref_cnt); 1169349214c1SMaya Erez 1170349214c1SMaya Erez mutex_unlock(&wil->halp.lock); 1171349214c1SMaya Erez } 1172349214c1SMaya Erez 1173349214c1SMaya Erez void wil_halp_unvote(struct wil6210_priv *wil) 1174349214c1SMaya Erez { 1175349214c1SMaya Erez WARN_ON(wil->halp.ref_cnt == 0); 1176349214c1SMaya Erez 1177349214c1SMaya Erez mutex_lock(&wil->halp.lock); 1178349214c1SMaya Erez 1179af3db60aSLazar Alexei wil_dbg_irq(wil, "halp_unvote: start, HALP ref_cnt (%d)\n", 1180349214c1SMaya Erez wil->halp.ref_cnt); 1181349214c1SMaya Erez 1182349214c1SMaya Erez if (--wil->halp.ref_cnt == 0) { 1183349214c1SMaya Erez wil6210_clear_halp(wil); 1184af3db60aSLazar Alexei wil_dbg_irq(wil, "HALP unvote\n"); 1185349214c1SMaya Erez } 1186349214c1SMaya Erez 1187af3db60aSLazar Alexei wil_dbg_irq(wil, "halp_unvote:end, HALP ref_cnt (%d)\n", 1188349214c1SMaya Erez wil->halp.ref_cnt); 1189349214c1SMaya Erez 1190349214c1SMaya Erez mutex_unlock(&wil->halp.lock); 1191349214c1SMaya Erez } 1192