12be7d22fSVladimir Kondratiev /* 20916d9f2SMaya Erez * Copyright (c) 2012-2016 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 27349214c1SMaya Erez 28bfc2dc7aSVladimir Kondratiev bool debug_fw; /* = false; */ 29bfc2dc7aSVladimir Kondratiev module_param(debug_fw, bool, S_IRUGO); 30bfc2dc7aSVladimir Kondratiev MODULE_PARM_DESC(debug_fw, " do not perform card reset. For FW debug"); 31bfc2dc7aSVladimir Kondratiev 321f1a361aSLior David static bool oob_mode; 331f1a361aSLior David module_param(oob_mode, bool, S_IRUGO); 341f1a361aSLior David MODULE_PARM_DESC(oob_mode, 351f1a361aSLior David " enable out of the box (OOB) mode in FW, for diagnostics and certification"); 361f1a361aSLior David 37c33407a8SVladimir Kondratiev bool no_fw_recovery; 38ed6f9dc6SVladimir Kondratiev module_param(no_fw_recovery, bool, S_IRUGO | S_IWUSR); 39c33407a8SVladimir Kondratiev MODULE_PARM_DESC(no_fw_recovery, " disable automatic FW error recovery"); 40ed6f9dc6SVladimir Kondratiev 41ab954628SVladimir Kondratiev /* if not set via modparam, will be set to default value of 1/8 of 42ab954628SVladimir Kondratiev * rx ring size during init flow 43ab954628SVladimir Kondratiev */ 44ab954628SVladimir Kondratiev unsigned short rx_ring_overflow_thrsh = WIL6210_RX_HIGH_TRSH_INIT; 45ab954628SVladimir Kondratiev module_param(rx_ring_overflow_thrsh, ushort, S_IRUGO); 46ab954628SVladimir Kondratiev MODULE_PARM_DESC(rx_ring_overflow_thrsh, 47ab954628SVladimir Kondratiev " RX ring overflow threshold in descriptors."); 48b6b1b0ecSVladimir Kondratiev 499a06bec9SVladimir Kondratiev /* We allow allocation of more than 1 page buffers to support large packets. 509a06bec9SVladimir Kondratiev * It is suboptimal behavior performance wise in case MTU above page size. 519a06bec9SVladimir Kondratiev */ 52c44690a1SVladimir Kondratiev unsigned int mtu_max = TXRX_BUF_LEN_DEFAULT - WIL_MAX_MPDU_OVERHEAD; 539a06bec9SVladimir Kondratiev static int mtu_max_set(const char *val, const struct kernel_param *kp) 549a06bec9SVladimir Kondratiev { 559a06bec9SVladimir Kondratiev int ret; 569a06bec9SVladimir Kondratiev 579a06bec9SVladimir Kondratiev /* sets mtu_max directly. no need to restore it in case of 589a06bec9SVladimir Kondratiev * illegal value since we assume this will fail insmod 599a06bec9SVladimir Kondratiev */ 609a06bec9SVladimir Kondratiev ret = param_set_uint(val, kp); 619a06bec9SVladimir Kondratiev if (ret) 629a06bec9SVladimir Kondratiev return ret; 639a06bec9SVladimir Kondratiev 644590d812SVladimir Kondratiev if (mtu_max < 68 || mtu_max > WIL_MAX_ETH_MTU) 659a06bec9SVladimir Kondratiev ret = -EINVAL; 669a06bec9SVladimir Kondratiev 679a06bec9SVladimir Kondratiev return ret; 689a06bec9SVladimir Kondratiev } 699a06bec9SVladimir Kondratiev 709c27847dSLuis R. Rodriguez static const struct kernel_param_ops mtu_max_ops = { 719a06bec9SVladimir Kondratiev .set = mtu_max_set, 729a06bec9SVladimir Kondratiev .get = param_get_uint, 739a06bec9SVladimir Kondratiev }; 749a06bec9SVladimir Kondratiev 759a06bec9SVladimir Kondratiev module_param_cb(mtu_max, &mtu_max_ops, &mtu_max, S_IRUGO); 769a06bec9SVladimir Kondratiev MODULE_PARM_DESC(mtu_max, " Max MTU value."); 779a06bec9SVladimir Kondratiev 78d3762b40SVladimir Kondratiev static uint rx_ring_order = WIL_RX_RING_SIZE_ORDER_DEFAULT; 79d3762b40SVladimir Kondratiev static uint tx_ring_order = WIL_TX_RING_SIZE_ORDER_DEFAULT; 8041d6b093SVladimir Kondratiev static uint bcast_ring_order = WIL_BCAST_RING_SIZE_ORDER_DEFAULT; 81d3762b40SVladimir Kondratiev 82d3762b40SVladimir Kondratiev static int ring_order_set(const char *val, const struct kernel_param *kp) 83d3762b40SVladimir Kondratiev { 84d3762b40SVladimir Kondratiev int ret; 85d3762b40SVladimir Kondratiev uint x; 86d3762b40SVladimir Kondratiev 87d3762b40SVladimir Kondratiev ret = kstrtouint(val, 0, &x); 88d3762b40SVladimir Kondratiev if (ret) 89d3762b40SVladimir Kondratiev return ret; 90d3762b40SVladimir Kondratiev 91d3762b40SVladimir Kondratiev if ((x < WIL_RING_SIZE_ORDER_MIN) || (x > WIL_RING_SIZE_ORDER_MAX)) 92d3762b40SVladimir Kondratiev return -EINVAL; 93d3762b40SVladimir Kondratiev 94d3762b40SVladimir Kondratiev *((uint *)kp->arg) = x; 95d3762b40SVladimir Kondratiev 96d3762b40SVladimir Kondratiev return 0; 97d3762b40SVladimir Kondratiev } 98d3762b40SVladimir Kondratiev 999c27847dSLuis R. Rodriguez static const struct kernel_param_ops ring_order_ops = { 100d3762b40SVladimir Kondratiev .set = ring_order_set, 101d3762b40SVladimir Kondratiev .get = param_get_uint, 102d3762b40SVladimir Kondratiev }; 103d3762b40SVladimir Kondratiev 104d3762b40SVladimir Kondratiev module_param_cb(rx_ring_order, &ring_order_ops, &rx_ring_order, S_IRUGO); 105d3762b40SVladimir Kondratiev MODULE_PARM_DESC(rx_ring_order, " Rx ring order; size = 1 << order"); 106d3762b40SVladimir Kondratiev module_param_cb(tx_ring_order, &ring_order_ops, &tx_ring_order, S_IRUGO); 107d3762b40SVladimir Kondratiev MODULE_PARM_DESC(tx_ring_order, " Tx ring order; size = 1 << order"); 108d507d1b7SVladimir Kondratiev module_param_cb(bcast_ring_order, &ring_order_ops, &bcast_ring_order, S_IRUGO); 109d507d1b7SVladimir Kondratiev MODULE_PARM_DESC(bcast_ring_order, " Bcast ring order; size = 1 << order"); 110d3762b40SVladimir Kondratiev 111520d68e7SVladimir Kondratiev #define RST_DELAY (20) /* msec, for loop in @wil_target_reset */ 112520d68e7SVladimir Kondratiev #define RST_COUNT (1 + 1000/RST_DELAY) /* round up to be above 1 sec total */ 113520d68e7SVladimir Kondratiev 1142be7d22fSVladimir Kondratiev /* 1152be7d22fSVladimir Kondratiev * Due to a hardware issue, 1162be7d22fSVladimir Kondratiev * one has to read/write to/from NIC in 32-bit chunks; 1172be7d22fSVladimir Kondratiev * regular memcpy_fromio and siblings will 1182be7d22fSVladimir Kondratiev * not work on 64-bit platform - it uses 64-bit transactions 1192be7d22fSVladimir Kondratiev * 1202be7d22fSVladimir Kondratiev * Force 32-bit transactions to enable NIC on 64-bit platforms 1212be7d22fSVladimir Kondratiev * 1222be7d22fSVladimir Kondratiev * To avoid byte swap on big endian host, __raw_{read|write}l 1232be7d22fSVladimir Kondratiev * should be used - {read|write}l would swap bytes to provide 1242be7d22fSVladimir Kondratiev * little endian on PCI value in host endianness. 1252be7d22fSVladimir Kondratiev */ 1262be7d22fSVladimir Kondratiev void wil_memcpy_fromio_32(void *dst, const volatile void __iomem *src, 1272be7d22fSVladimir Kondratiev size_t count) 1282be7d22fSVladimir Kondratiev { 1292be7d22fSVladimir Kondratiev u32 *d = dst; 1302be7d22fSVladimir Kondratiev const volatile u32 __iomem *s = src; 1312be7d22fSVladimir Kondratiev 1322be7d22fSVladimir Kondratiev /* size_t is unsigned, if (count%4 != 0) it will wrap */ 1332be7d22fSVladimir Kondratiev for (count += 4; count > 4; count -= 4) 1342be7d22fSVladimir Kondratiev *d++ = __raw_readl(s++); 1352be7d22fSVladimir Kondratiev } 1362be7d22fSVladimir Kondratiev 137349214c1SMaya Erez void wil_memcpy_fromio_halp_vote(struct wil6210_priv *wil, void *dst, 138349214c1SMaya Erez const volatile void __iomem *src, size_t count) 139349214c1SMaya Erez { 140349214c1SMaya Erez wil_halp_vote(wil); 141349214c1SMaya Erez wil_memcpy_fromio_32(dst, src, count); 142349214c1SMaya Erez wil_halp_unvote(wil); 143349214c1SMaya Erez } 144349214c1SMaya Erez 1452be7d22fSVladimir Kondratiev void wil_memcpy_toio_32(volatile void __iomem *dst, const void *src, 1462be7d22fSVladimir Kondratiev size_t count) 1472be7d22fSVladimir Kondratiev { 1482be7d22fSVladimir Kondratiev volatile u32 __iomem *d = dst; 1492be7d22fSVladimir Kondratiev const u32 *s = src; 1502be7d22fSVladimir Kondratiev 1512be7d22fSVladimir Kondratiev for (count += 4; count > 4; count -= 4) 1522be7d22fSVladimir Kondratiev __raw_writel(*s++, d++); 1532be7d22fSVladimir Kondratiev } 1542be7d22fSVladimir Kondratiev 155349214c1SMaya Erez void wil_memcpy_toio_halp_vote(struct wil6210_priv *wil, 156349214c1SMaya Erez volatile void __iomem *dst, 157349214c1SMaya Erez const void *src, size_t count) 158349214c1SMaya Erez { 159349214c1SMaya Erez wil_halp_vote(wil); 160349214c1SMaya Erez wil_memcpy_toio_32(dst, src, count); 161349214c1SMaya Erez wil_halp_unvote(wil); 162349214c1SMaya Erez } 163349214c1SMaya Erez 164b516fcc5SVladimir Kondratiev static void wil_disconnect_cid(struct wil6210_priv *wil, int cid, 1654821e6d8SVladimir Kondratiev u16 reason_code, bool from_event) 166bd33273bSVladimir Kondratiev __acquires(&sta->tid_rx_lock) __releases(&sta->tid_rx_lock) 1672be7d22fSVladimir Kondratiev { 16891886b0bSVladimir Kondratiev uint i; 169fc58f681SVladimir Kondratiev struct net_device *ndev = wil_to_ndev(wil); 170fc58f681SVladimir Kondratiev struct wireless_dev *wdev = wil->wdev; 171b4490f42SVladimir Kondratiev struct wil_sta_info *sta = &wil->sta[cid]; 1728fe59627SVladimir Kondratiev 173bd33273bSVladimir Kondratiev might_sleep(); 174fc58f681SVladimir Kondratiev wil_dbg_misc(wil, "%s(CID %d, status %d)\n", __func__, cid, 175fc58f681SVladimir Kondratiev sta->status); 17658527421SVladimir Kondratiev /* inform upper/lower layers */ 1774d55a0a1SVladimir Kondratiev if (sta->status != wil_sta_unused) { 178b516fcc5SVladimir Kondratiev if (!from_event) 1790916d9f2SMaya Erez wmi_disconnect_sta(wil, sta->addr, reason_code, true); 180b516fcc5SVladimir Kondratiev 181fc58f681SVladimir Kondratiev switch (wdev->iftype) { 182fc58f681SVladimir Kondratiev case NL80211_IFTYPE_AP: 183fc58f681SVladimir Kondratiev case NL80211_IFTYPE_P2P_GO: 184fc58f681SVladimir Kondratiev /* AP-like interface */ 185fc58f681SVladimir Kondratiev cfg80211_del_sta(ndev, sta->addr, GFP_KERNEL); 186fc58f681SVladimir Kondratiev break; 187fc58f681SVladimir Kondratiev default: 188fc58f681SVladimir Kondratiev break; 189fc58f681SVladimir Kondratiev } 1904d55a0a1SVladimir Kondratiev sta->status = wil_sta_unused; 1914d55a0a1SVladimir Kondratiev } 19258527421SVladimir Kondratiev /* reorder buffers */ 193b4490f42SVladimir Kondratiev for (i = 0; i < WIL_STA_TID_NUM; i++) { 194ec81b5adSDedy Lansky struct wil_tid_ampdu_rx *r; 195ec81b5adSDedy Lansky 196bd33273bSVladimir Kondratiev spin_lock_bh(&sta->tid_rx_lock); 197ec81b5adSDedy Lansky 198ec81b5adSDedy Lansky r = sta->tid_rx[i]; 199b4490f42SVladimir Kondratiev sta->tid_rx[i] = NULL; 200b4490f42SVladimir Kondratiev wil_tid_ampdu_rx_free(wil, r); 201ec81b5adSDedy Lansky 202bd33273bSVladimir Kondratiev spin_unlock_bh(&sta->tid_rx_lock); 203b4490f42SVladimir Kondratiev } 20458527421SVladimir Kondratiev /* crypto context */ 20558527421SVladimir Kondratiev memset(sta->tid_crypto_rx, 0, sizeof(sta->tid_crypto_rx)); 20658527421SVladimir Kondratiev memset(&sta->group_crypto_rx, 0, sizeof(sta->group_crypto_rx)); 20758527421SVladimir Kondratiev /* release vrings */ 20891886b0bSVladimir Kondratiev for (i = 0; i < ARRAY_SIZE(wil->vring_tx); i++) { 20991886b0bSVladimir Kondratiev if (wil->vring2cid_tid[i][0] == cid) 21091886b0bSVladimir Kondratiev wil_vring_fini_tx(wil, i); 21191886b0bSVladimir Kondratiev } 21258527421SVladimir Kondratiev /* statistics */ 21391886b0bSVladimir Kondratiev memset(&sta->stats, 0, sizeof(sta->stats)); 214b4490f42SVladimir Kondratiev } 215b4490f42SVladimir Kondratiev 21654eaa8c6SMaya Erez static bool wil_ap_is_connected(struct wil6210_priv *wil) 21754eaa8c6SMaya Erez { 21854eaa8c6SMaya Erez int i; 21954eaa8c6SMaya Erez 22054eaa8c6SMaya Erez for (i = 0; i < ARRAY_SIZE(wil->sta); i++) { 22154eaa8c6SMaya Erez if (wil->sta[i].status == wil_sta_connected) 22254eaa8c6SMaya Erez return true; 22354eaa8c6SMaya Erez } 22454eaa8c6SMaya Erez 22554eaa8c6SMaya Erez return false; 22654eaa8c6SMaya Erez } 22754eaa8c6SMaya Erez 228b516fcc5SVladimir Kondratiev static void _wil6210_disconnect(struct wil6210_priv *wil, const u8 *bssid, 2294821e6d8SVladimir Kondratiev u16 reason_code, bool from_event) 23091886b0bSVladimir Kondratiev { 23191886b0bSVladimir Kondratiev int cid = -ENOENT; 23291886b0bSVladimir Kondratiev struct net_device *ndev = wil_to_ndev(wil); 23391886b0bSVladimir Kondratiev struct wireless_dev *wdev = wil->wdev; 23491886b0bSVladimir Kondratiev 23591886b0bSVladimir Kondratiev might_sleep(); 2360916d9f2SMaya Erez wil_info(wil, "%s(bssid=%pM, reason=%d, ev%s)\n", __func__, bssid, 237100106d7SVladimir Kondratiev reason_code, from_event ? "+" : "-"); 23891886b0bSVladimir Kondratiev 239100106d7SVladimir Kondratiev /* Cases are: 240100106d7SVladimir Kondratiev * - disconnect single STA, still connected 241100106d7SVladimir Kondratiev * - disconnect single STA, already disconnected 242100106d7SVladimir Kondratiev * - disconnect all 243100106d7SVladimir Kondratiev * 24468682b41SVladimir Kondratiev * For "disconnect all", there are 3 options: 245100106d7SVladimir Kondratiev * - bssid == NULL 24668682b41SVladimir Kondratiev * - bssid is broadcast address (ff:ff:ff:ff:ff:ff) 247100106d7SVladimir Kondratiev * - bssid is our MAC address 248100106d7SVladimir Kondratiev */ 24968682b41SVladimir Kondratiev if (bssid && !is_broadcast_ether_addr(bssid) && 25068682b41SVladimir Kondratiev !ether_addr_equal_unaligned(ndev->dev_addr, bssid)) { 251100106d7SVladimir Kondratiev cid = wil_find_cid(wil, bssid); 252100106d7SVladimir Kondratiev wil_dbg_misc(wil, "Disconnect %pM, CID=%d, reason=%d\n", 253100106d7SVladimir Kondratiev bssid, cid, reason_code); 25491886b0bSVladimir Kondratiev if (cid >= 0) /* disconnect 1 peer */ 2554821e6d8SVladimir Kondratiev wil_disconnect_cid(wil, cid, reason_code, from_event); 256100106d7SVladimir Kondratiev } else { /* all */ 257100106d7SVladimir Kondratiev wil_dbg_misc(wil, "Disconnect all\n"); 25891886b0bSVladimir Kondratiev for (cid = 0; cid < WIL6210_MAX_CID; cid++) 2594821e6d8SVladimir Kondratiev wil_disconnect_cid(wil, cid, reason_code, from_event); 260100106d7SVladimir Kondratiev } 26191886b0bSVladimir Kondratiev 26291886b0bSVladimir Kondratiev /* link state */ 26391886b0bSVladimir Kondratiev switch (wdev->iftype) { 26491886b0bSVladimir Kondratiev case NL80211_IFTYPE_STATION: 26591886b0bSVladimir Kondratiev case NL80211_IFTYPE_P2P_CLIENT: 26641d6b093SVladimir Kondratiev wil_bcast_fini(wil); 267c5e96c91SDedy Lansky netif_tx_stop_all_queues(ndev); 268c5e96c91SDedy Lansky netif_carrier_off(ndev); 269c5e96c91SDedy Lansky 2709419b6a2SVladimir Kondratiev if (test_bit(wil_status_fwconnected, wil->status)) { 2719419b6a2SVladimir Kondratiev clear_bit(wil_status_fwconnected, wil->status); 2724821e6d8SVladimir Kondratiev cfg80211_disconnected(ndev, reason_code, 27380279fb7SJohannes Berg NULL, 0, false, GFP_KERNEL); 2749419b6a2SVladimir Kondratiev } else if (test_bit(wil_status_fwconnecting, wil->status)) { 2752be7d22fSVladimir Kondratiev cfg80211_connect_result(ndev, bssid, NULL, 0, NULL, 0, 2762be7d22fSVladimir Kondratiev WLAN_STATUS_UNSPECIFIED_FAILURE, 2772be7d22fSVladimir Kondratiev GFP_KERNEL); 2782be7d22fSVladimir Kondratiev } 2799419b6a2SVladimir Kondratiev clear_bit(wil_status_fwconnecting, wil->status); 28091886b0bSVladimir Kondratiev break; 28154eaa8c6SMaya Erez case NL80211_IFTYPE_AP: 28254eaa8c6SMaya Erez case NL80211_IFTYPE_P2P_GO: 28354eaa8c6SMaya Erez if (!wil_ap_is_connected(wil)) 28454eaa8c6SMaya Erez clear_bit(wil_status_fwconnected, wil->status); 28554eaa8c6SMaya Erez break; 28691886b0bSVladimir Kondratiev default: 28791886b0bSVladimir Kondratiev break; 28891886b0bSVladimir Kondratiev } 2892be7d22fSVladimir Kondratiev } 2902be7d22fSVladimir Kondratiev 2912be7d22fSVladimir Kondratiev static void wil_disconnect_worker(struct work_struct *work) 2922be7d22fSVladimir Kondratiev { 2932be7d22fSVladimir Kondratiev struct wil6210_priv *wil = container_of(work, 2942be7d22fSVladimir Kondratiev struct wil6210_priv, disconnect_worker); 2952be7d22fSVladimir Kondratiev 296097638a0SVladimir Kondratiev mutex_lock(&wil->mutex); 2974821e6d8SVladimir Kondratiev _wil6210_disconnect(wil, NULL, WLAN_REASON_UNSPECIFIED, false); 298097638a0SVladimir Kondratiev mutex_unlock(&wil->mutex); 2992be7d22fSVladimir Kondratiev } 3002be7d22fSVladimir Kondratiev 3012be7d22fSVladimir Kondratiev static void wil_connect_timer_fn(ulong x) 3022be7d22fSVladimir Kondratiev { 3032be7d22fSVladimir Kondratiev struct wil6210_priv *wil = (void *)x; 3040916d9f2SMaya Erez bool q; 3052be7d22fSVladimir Kondratiev 3060916d9f2SMaya Erez wil_err(wil, "Connect timeout detected, disconnect station\n"); 3072be7d22fSVladimir Kondratiev 3082be7d22fSVladimir Kondratiev /* reschedule to thread context - disconnect won't 3090916d9f2SMaya Erez * run from atomic context. 3100916d9f2SMaya Erez * queue on wmi_wq to prevent race with connect event. 3112be7d22fSVladimir Kondratiev */ 3120916d9f2SMaya Erez q = queue_work(wil->wmi_wq, &wil->disconnect_worker); 3130916d9f2SMaya Erez wil_dbg_wmi(wil, "queue_work of disconnect_worker -> %d\n", q); 3142be7d22fSVladimir Kondratiev } 3152be7d22fSVladimir Kondratiev 316047e5d74SVladimir Kondratiev static void wil_scan_timer_fn(ulong x) 317047e5d74SVladimir Kondratiev { 318047e5d74SVladimir Kondratiev struct wil6210_priv *wil = (void *)x; 319047e5d74SVladimir Kondratiev 3209419b6a2SVladimir Kondratiev clear_bit(wil_status_fwready, wil->status); 321047e5d74SVladimir Kondratiev wil_err(wil, "Scan timeout detected, start fw error recovery\n"); 3228ad6600fSVladimir Kondratiev wil_fw_error_recovery(wil); 323047e5d74SVladimir Kondratiev } 324047e5d74SVladimir Kondratiev 325c33407a8SVladimir Kondratiev static int wil_wait_for_recovery(struct wil6210_priv *wil) 326c33407a8SVladimir Kondratiev { 327c33407a8SVladimir Kondratiev if (wait_event_interruptible(wil->wq, wil->recovery_state != 328c33407a8SVladimir Kondratiev fw_recovery_pending)) { 329c33407a8SVladimir Kondratiev wil_err(wil, "Interrupt, canceling recovery\n"); 330c33407a8SVladimir Kondratiev return -ERESTARTSYS; 331c33407a8SVladimir Kondratiev } 332c33407a8SVladimir Kondratiev if (wil->recovery_state != fw_recovery_running) { 333c33407a8SVladimir Kondratiev wil_info(wil, "Recovery cancelled\n"); 334c33407a8SVladimir Kondratiev return -EINTR; 335c33407a8SVladimir Kondratiev } 336c33407a8SVladimir Kondratiev wil_info(wil, "Proceed with recovery\n"); 337c33407a8SVladimir Kondratiev return 0; 338c33407a8SVladimir Kondratiev } 339c33407a8SVladimir Kondratiev 340c33407a8SVladimir Kondratiev void wil_set_recovery_state(struct wil6210_priv *wil, int state) 341c33407a8SVladimir Kondratiev { 342c33407a8SVladimir Kondratiev wil_dbg_misc(wil, "%s(%d -> %d)\n", __func__, 343c33407a8SVladimir Kondratiev wil->recovery_state, state); 344c33407a8SVladimir Kondratiev 345c33407a8SVladimir Kondratiev wil->recovery_state = state; 346c33407a8SVladimir Kondratiev wake_up_interruptible(&wil->wq); 347c33407a8SVladimir Kondratiev } 348c33407a8SVladimir Kondratiev 349375a173fSLior David bool wil_is_recovery_blocked(struct wil6210_priv *wil) 350375a173fSLior David { 351375a173fSLior David return no_fw_recovery && (wil->recovery_state == fw_recovery_pending); 352375a173fSLior David } 353375a173fSLior David 354ed6f9dc6SVladimir Kondratiev static void wil_fw_error_worker(struct work_struct *work) 355ed6f9dc6SVladimir Kondratiev { 356c33407a8SVladimir Kondratiev struct wil6210_priv *wil = container_of(work, struct wil6210_priv, 357c33407a8SVladimir Kondratiev fw_error_worker); 358ed6f9dc6SVladimir Kondratiev struct wireless_dev *wdev = wil->wdev; 359ed6f9dc6SVladimir Kondratiev 360ed6f9dc6SVladimir Kondratiev wil_dbg_misc(wil, "fw error worker\n"); 361ed6f9dc6SVladimir Kondratiev 362cded9369SVladimir Kondratiev if (!netif_running(wil_to_ndev(wil))) { 363cded9369SVladimir Kondratiev wil_info(wil, "No recovery - interface is down\n"); 364cded9369SVladimir Kondratiev return; 365cded9369SVladimir Kondratiev } 366cded9369SVladimir Kondratiev 367fc219eedSVladimir Kondratiev /* increment @recovery_count if less then WIL6210_FW_RECOVERY_TO 368fc219eedSVladimir Kondratiev * passed since last recovery attempt 369fc219eedSVladimir Kondratiev */ 370fc219eedSVladimir Kondratiev if (time_is_after_jiffies(wil->last_fw_recovery + 371fc219eedSVladimir Kondratiev WIL6210_FW_RECOVERY_TO)) 372fc219eedSVladimir Kondratiev wil->recovery_count++; 373fc219eedSVladimir Kondratiev else 374fc219eedSVladimir Kondratiev wil->recovery_count = 1; /* fw was alive for a long time */ 375fc219eedSVladimir Kondratiev 376fc219eedSVladimir Kondratiev if (wil->recovery_count > WIL6210_FW_RECOVERY_RETRIES) { 377fc219eedSVladimir Kondratiev wil_err(wil, "too many recovery attempts (%d), giving up\n", 378fc219eedSVladimir Kondratiev wil->recovery_count); 379fc219eedSVladimir Kondratiev return; 380fc219eedSVladimir Kondratiev } 381fc219eedSVladimir Kondratiev 382fc219eedSVladimir Kondratiev wil->last_fw_recovery = jiffies; 383fc219eedSVladimir Kondratiev 3849c3bde56SVladimir Kondratiev mutex_lock(&wil->mutex); 385ed6f9dc6SVladimir Kondratiev switch (wdev->iftype) { 386ed6f9dc6SVladimir Kondratiev case NL80211_IFTYPE_STATION: 387ed6f9dc6SVladimir Kondratiev case NL80211_IFTYPE_P2P_CLIENT: 388ed6f9dc6SVladimir Kondratiev case NL80211_IFTYPE_MONITOR: 389c33407a8SVladimir Kondratiev wil_info(wil, "fw error recovery requested (try %d)...\n", 390fc219eedSVladimir Kondratiev wil->recovery_count); 391c33407a8SVladimir Kondratiev if (!no_fw_recovery) 392c33407a8SVladimir Kondratiev wil->recovery_state = fw_recovery_running; 393c33407a8SVladimir Kondratiev if (0 != wil_wait_for_recovery(wil)) 394c33407a8SVladimir Kondratiev break; 395c33407a8SVladimir Kondratiev 39673d839aeSVladimir Kondratiev __wil_down(wil); 39773d839aeSVladimir Kondratiev __wil_up(wil); 398ed6f9dc6SVladimir Kondratiev break; 399ed6f9dc6SVladimir Kondratiev case NL80211_IFTYPE_AP: 400ed6f9dc6SVladimir Kondratiev case NL80211_IFTYPE_P2P_GO: 401e240537bSVladimir Kondratiev wil_info(wil, "No recovery for AP-like interface\n"); 402ed6f9dc6SVladimir Kondratiev /* recovery in these modes is done by upper layers */ 403ed6f9dc6SVladimir Kondratiev break; 404ed6f9dc6SVladimir Kondratiev default: 405e240537bSVladimir Kondratiev wil_err(wil, "No recovery - unknown interface type %d\n", 406e240537bSVladimir Kondratiev wdev->iftype); 407ed6f9dc6SVladimir Kondratiev break; 408ed6f9dc6SVladimir Kondratiev } 4099c3bde56SVladimir Kondratiev mutex_unlock(&wil->mutex); 410ed6f9dc6SVladimir Kondratiev } 411ed6f9dc6SVladimir Kondratiev 4129a177384SVladimir Kondratiev static int wil_find_free_vring(struct wil6210_priv *wil) 4139a177384SVladimir Kondratiev { 4149a177384SVladimir Kondratiev int i; 4158fe59627SVladimir Kondratiev 4169a177384SVladimir Kondratiev for (i = 0; i < WIL6210_MAX_TX_RINGS; i++) { 4179a177384SVladimir Kondratiev if (!wil->vring_tx[i].va) 4189a177384SVladimir Kondratiev return i; 4199a177384SVladimir Kondratiev } 4209a177384SVladimir Kondratiev return -EINVAL; 4219a177384SVladimir Kondratiev } 4229a177384SVladimir Kondratiev 4230916d9f2SMaya Erez int wil_tx_init(struct wil6210_priv *wil, int cid) 4240916d9f2SMaya Erez { 4250916d9f2SMaya Erez int rc = -EINVAL, ringid; 4260916d9f2SMaya Erez 4270916d9f2SMaya Erez if (cid < 0) { 4280916d9f2SMaya Erez wil_err(wil, "No connection pending\n"); 4290916d9f2SMaya Erez goto out; 4300916d9f2SMaya Erez } 4310916d9f2SMaya Erez ringid = wil_find_free_vring(wil); 4320916d9f2SMaya Erez if (ringid < 0) { 4330916d9f2SMaya Erez wil_err(wil, "No free vring found\n"); 4340916d9f2SMaya Erez goto out; 4350916d9f2SMaya Erez } 4360916d9f2SMaya Erez 4370916d9f2SMaya Erez wil_dbg_wmi(wil, "Configure for connection CID %d vring %d\n", 4380916d9f2SMaya Erez cid, ringid); 4390916d9f2SMaya Erez 4400916d9f2SMaya Erez rc = wil_vring_init_tx(wil, ringid, 1 << tx_ring_order, cid, 0); 4410916d9f2SMaya Erez if (rc) 4420916d9f2SMaya Erez wil_err(wil, "wil_vring_init_tx for CID %d vring %d failed\n", 4430916d9f2SMaya Erez cid, ringid); 4440916d9f2SMaya Erez 4450916d9f2SMaya Erez out: 4460916d9f2SMaya Erez return rc; 4470916d9f2SMaya Erez } 4480916d9f2SMaya Erez 44941d6b093SVladimir Kondratiev int wil_bcast_init(struct wil6210_priv *wil) 45041d6b093SVladimir Kondratiev { 45141d6b093SVladimir Kondratiev int ri = wil->bcast_vring, rc; 45241d6b093SVladimir Kondratiev 45341d6b093SVladimir Kondratiev if ((ri >= 0) && wil->vring_tx[ri].va) 45441d6b093SVladimir Kondratiev return 0; 45541d6b093SVladimir Kondratiev 45641d6b093SVladimir Kondratiev ri = wil_find_free_vring(wil); 45741d6b093SVladimir Kondratiev if (ri < 0) 45841d6b093SVladimir Kondratiev return ri; 45941d6b093SVladimir Kondratiev 46041d6b093SVladimir Kondratiev wil->bcast_vring = ri; 461230d8442SVladimir Kondratiev rc = wil_vring_init_bcast(wil, ri, 1 << bcast_ring_order); 462230d8442SVladimir Kondratiev if (rc) 463230d8442SVladimir Kondratiev wil->bcast_vring = -1; 46441d6b093SVladimir Kondratiev 46541d6b093SVladimir Kondratiev return rc; 46641d6b093SVladimir Kondratiev } 46741d6b093SVladimir Kondratiev 46841d6b093SVladimir Kondratiev void wil_bcast_fini(struct wil6210_priv *wil) 46941d6b093SVladimir Kondratiev { 47041d6b093SVladimir Kondratiev int ri = wil->bcast_vring; 47141d6b093SVladimir Kondratiev 47241d6b093SVladimir Kondratiev if (ri < 0) 47341d6b093SVladimir Kondratiev return; 47441d6b093SVladimir Kondratiev 47541d6b093SVladimir Kondratiev wil->bcast_vring = -1; 47641d6b093SVladimir Kondratiev wil_vring_fini_tx(wil, ri); 47741d6b093SVladimir Kondratiev } 47841d6b093SVladimir Kondratiev 4792be7d22fSVladimir Kondratiev int wil_priv_init(struct wil6210_priv *wil) 4802be7d22fSVladimir Kondratiev { 481ec81b5adSDedy Lansky uint i; 482ec81b5adSDedy Lansky 4837743882dSVladimir Kondratiev wil_dbg_misc(wil, "%s()\n", __func__); 4842be7d22fSVladimir Kondratiev 4853df2cd36SVladimir Kondratiev memset(wil->sta, 0, sizeof(wil->sta)); 486ec81b5adSDedy Lansky for (i = 0; i < WIL6210_MAX_CID; i++) 487ec81b5adSDedy Lansky spin_lock_init(&wil->sta[i].tid_rx_lock); 4883df2cd36SVladimir Kondratiev 489875e9439SMaya Erez for (i = 0; i < WIL6210_MAX_TX_RINGS; i++) 490875e9439SMaya Erez spin_lock_init(&wil->vring_tx_data[i].lock); 491875e9439SMaya Erez 4922be7d22fSVladimir Kondratiev mutex_init(&wil->mutex); 4932be7d22fSVladimir Kondratiev mutex_init(&wil->wmi_mutex); 49440822a90SVladimir Kondratiev mutex_init(&wil->probe_client_mutex); 4954332cac1SLior David mutex_init(&wil->p2p_wdev_mutex); 496349214c1SMaya Erez mutex_init(&wil->halp.lock); 4972be7d22fSVladimir Kondratiev 4982be7d22fSVladimir Kondratiev init_completion(&wil->wmi_ready); 49959502647SDedy Lansky init_completion(&wil->wmi_call); 500349214c1SMaya Erez init_completion(&wil->halp.comp); 5012be7d22fSVladimir Kondratiev 50241d6b093SVladimir Kondratiev wil->bcast_vring = -1; 5032be7d22fSVladimir Kondratiev setup_timer(&wil->connect_timer, wil_connect_timer_fn, (ulong)wil); 504047e5d74SVladimir Kondratiev setup_timer(&wil->scan_timer, wil_scan_timer_fn, (ulong)wil); 505e6d68341SDedy Lansky setup_timer(&wil->p2p.discovery_timer, wil_p2p_discovery_timer_fn, 506e6d68341SDedy Lansky (ulong)wil); 5072be7d22fSVladimir Kondratiev 5082be7d22fSVladimir Kondratiev INIT_WORK(&wil->disconnect_worker, wil_disconnect_worker); 5092be7d22fSVladimir Kondratiev INIT_WORK(&wil->wmi_event_worker, wmi_event_worker); 510ed6f9dc6SVladimir Kondratiev INIT_WORK(&wil->fw_error_worker, wil_fw_error_worker); 51140822a90SVladimir Kondratiev INIT_WORK(&wil->probe_client_worker, wil_probe_client_worker); 5122be7d22fSVladimir Kondratiev 5132be7d22fSVladimir Kondratiev INIT_LIST_HEAD(&wil->pending_wmi_ev); 51440822a90SVladimir Kondratiev INIT_LIST_HEAD(&wil->probe_client_pending); 5152be7d22fSVladimir Kondratiev spin_lock_init(&wil->wmi_ev_lock); 516c33407a8SVladimir Kondratiev init_waitqueue_head(&wil->wq); 5172be7d22fSVladimir Kondratiev 5182be7d22fSVladimir Kondratiev wil->wmi_wq = create_singlethread_workqueue(WIL_NAME "_wmi"); 5192be7d22fSVladimir Kondratiev if (!wil->wmi_wq) 5202be7d22fSVladimir Kondratiev return -EAGAIN; 5212be7d22fSVladimir Kondratiev 5223277213fSVladimir Kondratiev wil->wq_service = create_singlethread_workqueue(WIL_NAME "_service"); 5233277213fSVladimir Kondratiev if (!wil->wq_service) 5243277213fSVladimir Kondratiev goto out_wmi_wq; 5252be7d22fSVladimir Kondratiev 526fc219eedSVladimir Kondratiev wil->last_fw_recovery = jiffies; 5271f80af2eSVladimir Shulman wil->tx_interframe_timeout = WIL6210_ITR_TX_INTERFRAME_TIMEOUT_DEFAULT; 5281f80af2eSVladimir Shulman wil->rx_interframe_timeout = WIL6210_ITR_RX_INTERFRAME_TIMEOUT_DEFAULT; 5291f80af2eSVladimir Shulman wil->tx_max_burst_duration = WIL6210_ITR_TX_MAX_BURST_DURATION_DEFAULT; 5301f80af2eSVladimir Shulman wil->rx_max_burst_duration = WIL6210_ITR_RX_MAX_BURST_DURATION_DEFAULT; 531fc219eedSVladimir Kondratiev 532ab954628SVladimir Kondratiev if (rx_ring_overflow_thrsh == WIL6210_RX_HIGH_TRSH_INIT) 533ab954628SVladimir Kondratiev rx_ring_overflow_thrsh = WIL6210_RX_HIGH_TRSH_DEFAULT; 5342be7d22fSVladimir Kondratiev return 0; 5353277213fSVladimir Kondratiev 5363277213fSVladimir Kondratiev out_wmi_wq: 5373277213fSVladimir Kondratiev destroy_workqueue(wil->wmi_wq); 5383277213fSVladimir Kondratiev 5393277213fSVladimir Kondratiev return -EAGAIN; 5402be7d22fSVladimir Kondratiev } 5412be7d22fSVladimir Kondratiev 542b516fcc5SVladimir Kondratiev /** 543b516fcc5SVladimir Kondratiev * wil6210_disconnect - disconnect one connection 544b516fcc5SVladimir Kondratiev * @wil: driver context 545b516fcc5SVladimir Kondratiev * @bssid: peer to disconnect, NULL to disconnect all 5464821e6d8SVladimir Kondratiev * @reason_code: Reason code for the Disassociation frame 547b516fcc5SVladimir Kondratiev * @from_event: whether is invoked from FW event handler 548b516fcc5SVladimir Kondratiev * 549b516fcc5SVladimir Kondratiev * Disconnect and release associated resources. If invoked not from the 550b516fcc5SVladimir Kondratiev * FW event handler, issue WMI command(s) to trigger MAC disconnect. 551b516fcc5SVladimir Kondratiev */ 552b516fcc5SVladimir Kondratiev void wil6210_disconnect(struct wil6210_priv *wil, const u8 *bssid, 5534821e6d8SVladimir Kondratiev u16 reason_code, bool from_event) 5542be7d22fSVladimir Kondratiev { 5559cf10d62SVladimir Kondratiev wil_dbg_misc(wil, "%s()\n", __func__); 5569cf10d62SVladimir Kondratiev 5572be7d22fSVladimir Kondratiev del_timer_sync(&wil->connect_timer); 5584821e6d8SVladimir Kondratiev _wil6210_disconnect(wil, bssid, reason_code, from_event); 5592be7d22fSVladimir Kondratiev } 5602be7d22fSVladimir Kondratiev 5612be7d22fSVladimir Kondratiev void wil_priv_deinit(struct wil6210_priv *wil) 5622be7d22fSVladimir Kondratiev { 5639cf10d62SVladimir Kondratiev wil_dbg_misc(wil, "%s()\n", __func__); 5649cf10d62SVladimir Kondratiev 565c33407a8SVladimir Kondratiev wil_set_recovery_state(wil, fw_recovery_idle); 566047e5d74SVladimir Kondratiev del_timer_sync(&wil->scan_timer); 567e6d68341SDedy Lansky del_timer_sync(&wil->p2p.discovery_timer); 5682be7d22fSVladimir Kondratiev cancel_work_sync(&wil->disconnect_worker); 569ed6f9dc6SVladimir Kondratiev cancel_work_sync(&wil->fw_error_worker); 570e6d68341SDedy Lansky cancel_work_sync(&wil->p2p.discovery_expired_work); 571097638a0SVladimir Kondratiev mutex_lock(&wil->mutex); 5724821e6d8SVladimir Kondratiev wil6210_disconnect(wil, NULL, WLAN_REASON_DEAUTH_LEAVING, false); 573097638a0SVladimir Kondratiev mutex_unlock(&wil->mutex); 5742be7d22fSVladimir Kondratiev wmi_event_flush(wil); 57540822a90SVladimir Kondratiev wil_probe_client_flush(wil); 57640822a90SVladimir Kondratiev cancel_work_sync(&wil->probe_client_worker); 5773277213fSVladimir Kondratiev destroy_workqueue(wil->wq_service); 5782be7d22fSVladimir Kondratiev destroy_workqueue(wil->wmi_wq); 5792be7d22fSVladimir Kondratiev } 5802be7d22fSVladimir Kondratiev 581151a9706SVladimir Kondratiev static inline void wil_halt_cpu(struct wil6210_priv *wil) 582151a9706SVladimir Kondratiev { 583b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_USER_CPU_0, BIT_USER_USER_CPU_MAN_RST); 584b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_MAC_CPU_0, BIT_USER_MAC_CPU_MAN_RST); 585151a9706SVladimir Kondratiev } 586151a9706SVladimir Kondratiev 587151a9706SVladimir Kondratiev static inline void wil_release_cpu(struct wil6210_priv *wil) 588151a9706SVladimir Kondratiev { 589151a9706SVladimir Kondratiev /* Start CPU */ 590b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_USER_CPU_0, 1); 591151a9706SVladimir Kondratiev } 592151a9706SVladimir Kondratiev 5931f1a361aSLior David static void wil_set_oob_mode(struct wil6210_priv *wil, bool enable) 5941f1a361aSLior David { 5951f1a361aSLior David wil_info(wil, "%s: enable=%d\n", __func__, enable); 596349214c1SMaya Erez if (enable) 5971f1a361aSLior David wil_s(wil, RGF_USER_USAGE_6, BIT_USER_OOB_MODE); 598349214c1SMaya Erez else 5991f1a361aSLior David wil_c(wil, RGF_USER_USAGE_6, BIT_USER_OOB_MODE); 6001f1a361aSLior David } 6011f1a361aSLior David 602bbb2adc7SVladimir Kondratiev static int wil_target_reset(struct wil6210_priv *wil) 6032be7d22fSVladimir Kondratiev { 60498a65b59SVladimir Kondratiev int delay = 0; 605bb6c8dccSVladimir Kondratiev u32 x, x1 = 0; 60636b10a72SVladimir Kondratiev 6071aeda13bSVladimir Kondratiev wil_dbg_misc(wil, "Resetting \"%s\"...\n", wil->hw_name); 6086508281bSVladimir Kondratiev 6096508281bSVladimir Kondratiev /* Clear MAC link up */ 610b9eeb512SVladimir Kondratiev wil_s(wil, RGF_HP_CTRL, BIT(15)); 611b9eeb512SVladimir Kondratiev wil_s(wil, RGF_USER_CLKS_CTL_SW_RST_MASK_0, BIT_HPAL_PERST_FROM_PAD); 612b9eeb512SVladimir Kondratiev wil_s(wil, RGF_USER_CLKS_CTL_SW_RST_MASK_0, BIT_CAR_PERST_RST); 613151a9706SVladimir Kondratiev 614151a9706SVladimir Kondratiev wil_halt_cpu(wil); 6152be7d22fSVladimir Kondratiev 6162cd0f021SVladimir Kondratiev /* clear all boot loader "ready" bits */ 617b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_BL + 618f1ad8c93SVladimir Kondratiev offsetof(struct bl_dedicated_registers_v0, boot_loader_ready), 0); 619cce47711SVladimir Kondratiev /* Clear Fw Download notification */ 620b9eeb512SVladimir Kondratiev wil_c(wil, RGF_USER_USAGE_6, BIT(0)); 621cce47711SVladimir Kondratiev 622b9eeb512SVladimir Kondratiev wil_s(wil, RGF_CAF_OSC_CONTROL, BIT_CAF_OSC_XTAL_EN); 62348516298SVladimir Kondratiev /* XTAL stabilization should take about 3ms */ 62448516298SVladimir Kondratiev usleep_range(5000, 7000); 625b9eeb512SVladimir Kondratiev x = wil_r(wil, RGF_CAF_PLL_LOCK_STATUS); 62648516298SVladimir Kondratiev if (!(x & BIT_CAF_OSC_DIG_XTAL_STABLE)) { 62748516298SVladimir Kondratiev wil_err(wil, "Xtal stabilization timeout\n" 62848516298SVladimir Kondratiev "RGF_CAF_PLL_LOCK_STATUS = 0x%08x\n", x); 62948516298SVladimir Kondratiev return -ETIME; 63048516298SVladimir Kondratiev } 63148516298SVladimir Kondratiev /* switch 10k to XTAL*/ 632b9eeb512SVladimir Kondratiev wil_c(wil, RGF_USER_SPARROW_M_4, BIT_SPARROW_M_4_SEL_SLEEP_OR_REF); 63348516298SVladimir Kondratiev /* 40 MHz */ 634b9eeb512SVladimir Kondratiev wil_c(wil, RGF_USER_CLKS_CTL_0, BIT_USER_CLKS_CAR_AHB_SW_SEL); 63548516298SVladimir Kondratiev 636b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_0, 0x3ff81f); 637b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_1, 0xf); 6386508281bSVladimir Kondratiev 639b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0xFE000000); 640b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_1, 0x0000003F); 641b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0x000000f0); 642b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0xFFE7FE00); 6432be7d22fSVladimir Kondratiev 644b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_0, 0x0); 645b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_1, 0x0); 6466508281bSVladimir Kondratiev 647b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0); 648b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0); 649b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_1, 0); 650b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0); 6512be7d22fSVladimir Kondratiev 652b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0x00000003); 653b9eeb512SVladimir Kondratiev /* reset A2 PCIE AHB */ 654b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0x00008000); 6556508281bSVladimir Kondratiev 656b9eeb512SVladimir Kondratiev wil_w(wil, RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0); 6572be7d22fSVladimir Kondratiev 6582cd0f021SVladimir Kondratiev /* wait until device ready. typical time is 20..80 msec */ 65936b10a72SVladimir Kondratiev do { 660520d68e7SVladimir Kondratiev msleep(RST_DELAY); 661b9eeb512SVladimir Kondratiev x = wil_r(wil, RGF_USER_BL + 662b9eeb512SVladimir Kondratiev offsetof(struct bl_dedicated_registers_v0, 663f1ad8c93SVladimir Kondratiev boot_loader_ready)); 664bb6c8dccSVladimir Kondratiev if (x1 != x) { 665bb6c8dccSVladimir Kondratiev wil_dbg_misc(wil, "BL.ready 0x%08x => 0x%08x\n", x1, x); 666bb6c8dccSVladimir Kondratiev x1 = x; 667bb6c8dccSVladimir Kondratiev } 668520d68e7SVladimir Kondratiev if (delay++ > RST_COUNT) { 6692cd0f021SVladimir Kondratiev wil_err(wil, "Reset not completed, bl.ready 0x%08x\n", 67048516298SVladimir Kondratiev x); 671bbb2adc7SVladimir Kondratiev return -ETIME; 67236b10a72SVladimir Kondratiev } 673f1ad8c93SVladimir Kondratiev } while (x != BL_READY); 67436b10a72SVladimir Kondratiev 675b9eeb512SVladimir Kondratiev wil_c(wil, RGF_USER_CLKS_CTL_0, BIT_USER_CLKS_RST_PWGD); 676972072aaSVladimir Kondratiev 677e3351277SVladimir Kondratiev /* enable fix for HW bug related to the SA/DA swap in AP Rx */ 678b9eeb512SVladimir Kondratiev wil_s(wil, RGF_DMA_OFUL_NID_0, BIT_DMA_OFUL_NID_0_RX_EXT_TR_EN | 679e3351277SVladimir Kondratiev BIT_DMA_OFUL_NID_0_RX_EXT_A3_SRC); 680e3351277SVladimir Kondratiev 681520d68e7SVladimir Kondratiev wil_dbg_misc(wil, "Reset completed in %d ms\n", delay * RST_DELAY); 682bbb2adc7SVladimir Kondratiev return 0; 683151a9706SVladimir Kondratiev } 6842be7d22fSVladimir Kondratiev 6852be7d22fSVladimir Kondratiev void wil_mbox_ring_le2cpus(struct wil6210_mbox_ring *r) 6862be7d22fSVladimir Kondratiev { 6872be7d22fSVladimir Kondratiev le32_to_cpus(&r->base); 6882be7d22fSVladimir Kondratiev le16_to_cpus(&r->entry_size); 6892be7d22fSVladimir Kondratiev le16_to_cpus(&r->size); 6902be7d22fSVladimir Kondratiev le32_to_cpus(&r->tail); 6912be7d22fSVladimir Kondratiev le32_to_cpus(&r->head); 6922be7d22fSVladimir Kondratiev } 6932be7d22fSVladimir Kondratiev 6942cd0f021SVladimir Kondratiev static int wil_get_bl_info(struct wil6210_priv *wil) 6952cd0f021SVladimir Kondratiev { 6962cd0f021SVladimir Kondratiev struct net_device *ndev = wil_to_ndev(wil); 697b42f1196SHamad Kadmany struct wiphy *wiphy = wil_to_wiphy(wil); 698f1ad8c93SVladimir Kondratiev union { 699f1ad8c93SVladimir Kondratiev struct bl_dedicated_registers_v0 bl0; 700f1ad8c93SVladimir Kondratiev struct bl_dedicated_registers_v1 bl1; 701f1ad8c93SVladimir Kondratiev } bl; 702f1ad8c93SVladimir Kondratiev u32 bl_ver; 703f1ad8c93SVladimir Kondratiev u8 *mac; 704f1ad8c93SVladimir Kondratiev u16 rf_status; 7052cd0f021SVladimir Kondratiev 706f1ad8c93SVladimir Kondratiev wil_memcpy_fromio_32(&bl, wil->csr + HOSTADDR(RGF_USER_BL), 70719c871ceSVladimir Kondratiev sizeof(bl)); 70819c871ceSVladimir Kondratiev bl_ver = le32_to_cpu(bl.bl0.boot_loader_struct_version); 70919c871ceSVladimir Kondratiev mac = bl.bl0.mac_address; 71019c871ceSVladimir Kondratiev 71119c871ceSVladimir Kondratiev if (bl_ver == 0) { 712f1ad8c93SVladimir Kondratiev le32_to_cpus(&bl.bl0.rf_type); 713f1ad8c93SVladimir Kondratiev le32_to_cpus(&bl.bl0.baseband_type); 714f1ad8c93SVladimir Kondratiev rf_status = 0; /* actually, unknown */ 715f1ad8c93SVladimir Kondratiev wil_info(wil, 716f1ad8c93SVladimir Kondratiev "Boot Loader struct v%d: MAC = %pM RF = 0x%08x bband = 0x%08x\n", 717f1ad8c93SVladimir Kondratiev bl_ver, mac, 718f1ad8c93SVladimir Kondratiev bl.bl0.rf_type, bl.bl0.baseband_type); 719f1ad8c93SVladimir Kondratiev wil_info(wil, "Boot Loader build unknown for struct v0\n"); 72019c871ceSVladimir Kondratiev } else { 721f1ad8c93SVladimir Kondratiev le16_to_cpus(&bl.bl1.rf_type); 722f1ad8c93SVladimir Kondratiev rf_status = le16_to_cpu(bl.bl1.rf_status); 723f1ad8c93SVladimir Kondratiev le32_to_cpus(&bl.bl1.baseband_type); 724f1ad8c93SVladimir Kondratiev le16_to_cpus(&bl.bl1.bl_version_subminor); 725f1ad8c93SVladimir Kondratiev le16_to_cpus(&bl.bl1.bl_version_build); 726f1ad8c93SVladimir Kondratiev wil_info(wil, 727f1ad8c93SVladimir Kondratiev "Boot Loader struct v%d: MAC = %pM RF = 0x%04x (status 0x%04x) bband = 0x%08x\n", 728f1ad8c93SVladimir Kondratiev bl_ver, mac, 729f1ad8c93SVladimir Kondratiev bl.bl1.rf_type, rf_status, 730f1ad8c93SVladimir Kondratiev bl.bl1.baseband_type); 731f1ad8c93SVladimir Kondratiev wil_info(wil, "Boot Loader build %d.%d.%d.%d\n", 732f1ad8c93SVladimir Kondratiev bl.bl1.bl_version_major, bl.bl1.bl_version_minor, 733f1ad8c93SVladimir Kondratiev bl.bl1.bl_version_subminor, bl.bl1.bl_version_build); 7342cd0f021SVladimir Kondratiev } 7352cd0f021SVladimir Kondratiev 736f1ad8c93SVladimir Kondratiev if (!is_valid_ether_addr(mac)) { 737f1ad8c93SVladimir Kondratiev wil_err(wil, "BL: Invalid MAC %pM\n", mac); 738f1ad8c93SVladimir Kondratiev return -EINVAL; 739f1ad8c93SVladimir Kondratiev } 740f1ad8c93SVladimir Kondratiev 741f1ad8c93SVladimir Kondratiev ether_addr_copy(ndev->perm_addr, mac); 742b42f1196SHamad Kadmany ether_addr_copy(wiphy->perm_addr, mac); 7432cd0f021SVladimir Kondratiev if (!is_valid_ether_addr(ndev->dev_addr)) 744f1ad8c93SVladimir Kondratiev ether_addr_copy(ndev->dev_addr, mac); 745f1ad8c93SVladimir Kondratiev 746f1ad8c93SVladimir Kondratiev if (rf_status) {/* bad RF cable? */ 747f1ad8c93SVladimir Kondratiev wil_err(wil, "RF communication error 0x%04x", 748f1ad8c93SVladimir Kondratiev rf_status); 749f1ad8c93SVladimir Kondratiev return -EAGAIN; 750f1ad8c93SVladimir Kondratiev } 7512cd0f021SVladimir Kondratiev 7522cd0f021SVladimir Kondratiev return 0; 7532cd0f021SVladimir Kondratiev } 7542cd0f021SVladimir Kondratiev 755409ead54SVladimir Kondratiev static void wil_bl_crash_info(struct wil6210_priv *wil, bool is_err) 756409ead54SVladimir Kondratiev { 757409ead54SVladimir Kondratiev u32 bl_assert_code, bl_assert_blink, bl_magic_number; 758409ead54SVladimir Kondratiev u32 bl_ver = wil_r(wil, RGF_USER_BL + 759409ead54SVladimir Kondratiev offsetof(struct bl_dedicated_registers_v0, 760409ead54SVladimir Kondratiev boot_loader_struct_version)); 761409ead54SVladimir Kondratiev 762409ead54SVladimir Kondratiev if (bl_ver < 2) 763409ead54SVladimir Kondratiev return; 764409ead54SVladimir Kondratiev 765409ead54SVladimir Kondratiev bl_assert_code = wil_r(wil, RGF_USER_BL + 766409ead54SVladimir Kondratiev offsetof(struct bl_dedicated_registers_v1, 767409ead54SVladimir Kondratiev bl_assert_code)); 768409ead54SVladimir Kondratiev bl_assert_blink = wil_r(wil, RGF_USER_BL + 769409ead54SVladimir Kondratiev offsetof(struct bl_dedicated_registers_v1, 770409ead54SVladimir Kondratiev bl_assert_blink)); 771409ead54SVladimir Kondratiev bl_magic_number = wil_r(wil, RGF_USER_BL + 772409ead54SVladimir Kondratiev offsetof(struct bl_dedicated_registers_v1, 773409ead54SVladimir Kondratiev bl_magic_number)); 774409ead54SVladimir Kondratiev 775409ead54SVladimir Kondratiev if (is_err) { 776409ead54SVladimir Kondratiev wil_err(wil, 777409ead54SVladimir Kondratiev "BL assert code 0x%08x blink 0x%08x magic 0x%08x\n", 778409ead54SVladimir Kondratiev bl_assert_code, bl_assert_blink, bl_magic_number); 779409ead54SVladimir Kondratiev } else { 780409ead54SVladimir Kondratiev wil_dbg_misc(wil, 781409ead54SVladimir Kondratiev "BL assert code 0x%08x blink 0x%08x magic 0x%08x\n", 782409ead54SVladimir Kondratiev bl_assert_code, bl_assert_blink, bl_magic_number); 783409ead54SVladimir Kondratiev } 784409ead54SVladimir Kondratiev } 785409ead54SVladimir Kondratiev 7862be7d22fSVladimir Kondratiev static int wil_wait_for_fw_ready(struct wil6210_priv *wil) 7872be7d22fSVladimir Kondratiev { 7882be7d22fSVladimir Kondratiev ulong to = msecs_to_jiffies(1000); 7892be7d22fSVladimir Kondratiev ulong left = wait_for_completion_timeout(&wil->wmi_ready, to); 7908fe59627SVladimir Kondratiev 7912be7d22fSVladimir Kondratiev if (0 == left) { 7922be7d22fSVladimir Kondratiev wil_err(wil, "Firmware not ready\n"); 7932be7d22fSVladimir Kondratiev return -ETIME; 7942be7d22fSVladimir Kondratiev } else { 79515e23124SVladimir Kondratiev wil_info(wil, "FW ready after %d ms. HW version 0x%08x\n", 79615e23124SVladimir Kondratiev jiffies_to_msecs(to-left), wil->hw_version); 7972be7d22fSVladimir Kondratiev } 7982be7d22fSVladimir Kondratiev return 0; 7992be7d22fSVladimir Kondratiev } 8002be7d22fSVladimir Kondratiev 8012be7d22fSVladimir Kondratiev /* 8022be7d22fSVladimir Kondratiev * We reset all the structures, and we reset the UMAC. 8032be7d22fSVladimir Kondratiev * After calling this routine, you're expected to reload 8042be7d22fSVladimir Kondratiev * the firmware. 8052be7d22fSVladimir Kondratiev */ 8062cd0f021SVladimir Kondratiev int wil_reset(struct wil6210_priv *wil, bool load_fw) 8072be7d22fSVladimir Kondratiev { 8082be7d22fSVladimir Kondratiev int rc; 8092be7d22fSVladimir Kondratiev 8109cf10d62SVladimir Kondratiev wil_dbg_misc(wil, "%s()\n", __func__); 8119cf10d62SVladimir Kondratiev 812097638a0SVladimir Kondratiev WARN_ON(!mutex_is_locked(&wil->mutex)); 8139419b6a2SVladimir Kondratiev WARN_ON(test_bit(wil_status_napi_en, wil->status)); 814097638a0SVladimir Kondratiev 815bfc2dc7aSVladimir Kondratiev if (debug_fw) { 816bfc2dc7aSVladimir Kondratiev static const u8 mac[ETH_ALEN] = { 817bfc2dc7aSVladimir Kondratiev 0x00, 0xde, 0xad, 0x12, 0x34, 0x56, 818bfc2dc7aSVladimir Kondratiev }; 819bfc2dc7aSVladimir Kondratiev struct net_device *ndev = wil_to_ndev(wil); 820bfc2dc7aSVladimir Kondratiev 821bfc2dc7aSVladimir Kondratiev ether_addr_copy(ndev->perm_addr, mac); 822bfc2dc7aSVladimir Kondratiev ether_addr_copy(ndev->dev_addr, ndev->perm_addr); 823bfc2dc7aSVladimir Kondratiev return 0; 824bfc2dc7aSVladimir Kondratiev } 825bfc2dc7aSVladimir Kondratiev 82667131a1dSVladimir Kondratiev if (wil->hw_version == HW_VER_UNKNOWN) 82767131a1dSVladimir Kondratiev return -ENODEV; 82867131a1dSVladimir Kondratiev 8295f0823efSMaya Erez if (wil->platform_ops.notify) { 8305f0823efSMaya Erez rc = wil->platform_ops.notify(wil->platform_handle, 8315f0823efSMaya Erez WIL_PLATFORM_EVT_PRE_RESET); 8325f0823efSMaya Erez if (rc) 8335f0823efSMaya Erez wil_err(wil, 8345f0823efSMaya Erez "%s: PRE_RESET platform notify failed, rc %d\n", 8355f0823efSMaya Erez __func__, rc); 8365f0823efSMaya Erez } 8375f0823efSMaya Erez 838f13e0630SHamad Kadmany set_bit(wil_status_resetting, wil->status); 839f13e0630SHamad Kadmany 840097638a0SVladimir Kondratiev cancel_work_sync(&wil->disconnect_worker); 8414821e6d8SVladimir Kondratiev wil6210_disconnect(wil, NULL, WLAN_REASON_DEAUTH_LEAVING, false); 84241d6b093SVladimir Kondratiev wil_bcast_fini(wil); 843097638a0SVladimir Kondratiev 84410d599adSMaya Erez /* Disable device led before reset*/ 84510d599adSMaya Erez wmi_led_cfg(wil, false); 84610d599adSMaya Erez 847452133a7SMaya Erez /* prevent NAPI from being scheduled and prevent wmi commands */ 848452133a7SMaya Erez mutex_lock(&wil->wmi_mutex); 8499419b6a2SVladimir Kondratiev bitmap_zero(wil->status, wil_status_last); 850452133a7SMaya Erez mutex_unlock(&wil->wmi_mutex); 8510fef1818SVladimir Kondratiev 852ed6f9dc6SVladimir Kondratiev if (wil->scan_request) { 8531d76250bSAvraham Stern struct cfg80211_scan_info info = { 8541d76250bSAvraham Stern .aborted = true, 8551d76250bSAvraham Stern }; 8561d76250bSAvraham Stern 857ed6f9dc6SVladimir Kondratiev wil_dbg_misc(wil, "Abort scan_request 0x%p\n", 858ed6f9dc6SVladimir Kondratiev wil->scan_request); 859047e5d74SVladimir Kondratiev del_timer_sync(&wil->scan_timer); 8601d76250bSAvraham Stern cfg80211_scan_done(wil->scan_request, &info); 861ed6f9dc6SVladimir Kondratiev wil->scan_request = NULL; 862ed6f9dc6SVladimir Kondratiev } 863ed6f9dc6SVladimir Kondratiev 864e4dbb093SVladimir Kondratiev wil_mask_irq(wil); 8652be7d22fSVladimir Kondratiev 866e08b5906SVladimir Kondratiev wmi_event_flush(wil); 867e08b5906SVladimir Kondratiev 8683277213fSVladimir Kondratiev flush_workqueue(wil->wq_service); 869e08b5906SVladimir Kondratiev flush_workqueue(wil->wmi_wq); 870e08b5906SVladimir Kondratiev 871409ead54SVladimir Kondratiev wil_bl_crash_info(wil, false); 872bbb2adc7SVladimir Kondratiev rc = wil_target_reset(wil); 8738bf6adb9SVladimir Kondratiev wil_rx_fini(wil); 874409ead54SVladimir Kondratiev if (rc) { 875409ead54SVladimir Kondratiev wil_bl_crash_info(wil, true); 876bbb2adc7SVladimir Kondratiev return rc; 877409ead54SVladimir Kondratiev } 878bbb2adc7SVladimir Kondratiev 8792cd0f021SVladimir Kondratiev rc = wil_get_bl_info(wil); 880f1ad8c93SVladimir Kondratiev if (rc == -EAGAIN && !load_fw) /* ignore RF error if not going up */ 881f1ad8c93SVladimir Kondratiev rc = 0; 8822cd0f021SVladimir Kondratiev if (rc) 8832cd0f021SVladimir Kondratiev return rc; 8842cd0f021SVladimir Kondratiev 8851f1a361aSLior David wil_set_oob_mode(wil, oob_mode); 8862cd0f021SVladimir Kondratiev if (load_fw) { 8872cd0f021SVladimir Kondratiev wil_info(wil, "Use firmware <%s> + board <%s>\n", WIL_FW_NAME, 8882cd0f021SVladimir Kondratiev WIL_FW2_NAME); 8892cd0f021SVladimir Kondratiev 890151a9706SVladimir Kondratiev wil_halt_cpu(wil); 891151a9706SVladimir Kondratiev /* Loading f/w from the file */ 892151a9706SVladimir Kondratiev rc = wil_request_firmware(wil, WIL_FW_NAME); 893151a9706SVladimir Kondratiev if (rc) 894151a9706SVladimir Kondratiev return rc; 8952cd0f021SVladimir Kondratiev rc = wil_request_firmware(wil, WIL_FW2_NAME); 8962cd0f021SVladimir Kondratiev if (rc) 8972cd0f021SVladimir Kondratiev return rc; 898151a9706SVladimir Kondratiev 8992cd0f021SVladimir Kondratiev /* Mark FW as loaded from host */ 900b9eeb512SVladimir Kondratiev wil_s(wil, RGF_USER_USAGE_6, 1); 9012cd0f021SVladimir Kondratiev 9022cd0f021SVladimir Kondratiev /* clear any interrupts which on-card-firmware 9032cd0f021SVladimir Kondratiev * may have set 9042cd0f021SVladimir Kondratiev */ 905151a9706SVladimir Kondratiev wil6210_clear_irq(wil); 9062cd0f021SVladimir Kondratiev /* CAF_ICR - clear and mask */ 9072cd0f021SVladimir Kondratiev /* it is W1C, clear by writing back same value */ 908b9eeb512SVladimir Kondratiev wil_s(wil, RGF_CAF_ICR + offsetof(struct RGF_ICR, ICR), 0); 909b9eeb512SVladimir Kondratiev wil_w(wil, RGF_CAF_ICR + offsetof(struct RGF_ICR, IMV), ~0); 910151a9706SVladimir Kondratiev 911151a9706SVladimir Kondratiev wil_release_cpu(wil); 912151a9706SVladimir Kondratiev } 9138bf6adb9SVladimir Kondratiev 9142be7d22fSVladimir Kondratiev /* init after reset */ 91502beaf1aSVladimir Kondratiev wil->ap_isolate = 0; 91616735d02SWolfram Sang reinit_completion(&wil->wmi_ready); 91759502647SDedy Lansky reinit_completion(&wil->wmi_call); 918349214c1SMaya Erez reinit_completion(&wil->halp.comp); 9192be7d22fSVladimir Kondratiev 9202cd0f021SVladimir Kondratiev if (load_fw) { 92178366f69SVladimir Kondratiev wil_configure_interrupt_moderation(wil); 922e4dbb093SVladimir Kondratiev wil_unmask_irq(wil); 9232be7d22fSVladimir Kondratiev 9242be7d22fSVladimir Kondratiev /* we just started MAC, wait for FW ready */ 9252be7d22fSVladimir Kondratiev rc = wil_wait_for_fw_ready(wil); 9265f0823efSMaya Erez if (rc) 9275f0823efSMaya Erez return rc; 9285f0823efSMaya Erez 9295f0823efSMaya Erez /* check FW is responsive */ 930cec94d8cSVladimir Kondratiev rc = wmi_echo(wil); 9315f0823efSMaya Erez if (rc) { 9325f0823efSMaya Erez wil_err(wil, "%s: wmi_echo failed, rc %d\n", 9335f0823efSMaya Erez __func__, rc); 9345f0823efSMaya Erez return rc; 9355f0823efSMaya Erez } 9365f0823efSMaya Erez 9375f0823efSMaya Erez if (wil->platform_ops.notify) { 9385f0823efSMaya Erez rc = wil->platform_ops.notify(wil->platform_handle, 9395f0823efSMaya Erez WIL_PLATFORM_EVT_FW_RDY); 9405f0823efSMaya Erez if (rc) { 9415f0823efSMaya Erez wil_err(wil, 9425f0823efSMaya Erez "%s: FW_RDY notify failed, rc %d\n", 9435f0823efSMaya Erez __func__, rc); 9445f0823efSMaya Erez rc = 0; 9455f0823efSMaya Erez } 9465f0823efSMaya Erez } 9472cd0f021SVladimir Kondratiev } 9482be7d22fSVladimir Kondratiev 9492be7d22fSVladimir Kondratiev return rc; 9502be7d22fSVladimir Kondratiev } 9512be7d22fSVladimir Kondratiev 952ed6f9dc6SVladimir Kondratiev void wil_fw_error_recovery(struct wil6210_priv *wil) 953ed6f9dc6SVladimir Kondratiev { 954ed6f9dc6SVladimir Kondratiev wil_dbg_misc(wil, "starting fw error recovery\n"); 955f13e0630SHamad Kadmany 956f13e0630SHamad Kadmany if (test_bit(wil_status_resetting, wil->status)) { 957f13e0630SHamad Kadmany wil_info(wil, "Reset already in progress\n"); 958f13e0630SHamad Kadmany return; 959f13e0630SHamad Kadmany } 960f13e0630SHamad Kadmany 961c33407a8SVladimir Kondratiev wil->recovery_state = fw_recovery_pending; 962ed6f9dc6SVladimir Kondratiev schedule_work(&wil->fw_error_worker); 963ed6f9dc6SVladimir Kondratiev } 9642be7d22fSVladimir Kondratiev 96573d839aeSVladimir Kondratiev int __wil_up(struct wil6210_priv *wil) 9662be7d22fSVladimir Kondratiev { 9672be7d22fSVladimir Kondratiev struct net_device *ndev = wil_to_ndev(wil); 9682be7d22fSVladimir Kondratiev struct wireless_dev *wdev = wil->wdev; 9692be7d22fSVladimir Kondratiev int rc; 9702be7d22fSVladimir Kondratiev 971097638a0SVladimir Kondratiev WARN_ON(!mutex_is_locked(&wil->mutex)); 972097638a0SVladimir Kondratiev 9732cd0f021SVladimir Kondratiev rc = wil_reset(wil, true); 9742be7d22fSVladimir Kondratiev if (rc) 9752be7d22fSVladimir Kondratiev return rc; 9762be7d22fSVladimir Kondratiev 977e31b2562SVladimir Kondratiev /* Rx VRING. After MAC and beacon */ 978d3762b40SVladimir Kondratiev rc = wil_rx_init(wil, 1 << rx_ring_order); 979e31b2562SVladimir Kondratiev if (rc) 980e31b2562SVladimir Kondratiev return rc; 981e31b2562SVladimir Kondratiev 9822be7d22fSVladimir Kondratiev switch (wdev->iftype) { 9832be7d22fSVladimir Kondratiev case NL80211_IFTYPE_STATION: 9847743882dSVladimir Kondratiev wil_dbg_misc(wil, "type: STATION\n"); 9852be7d22fSVladimir Kondratiev ndev->type = ARPHRD_ETHER; 9862be7d22fSVladimir Kondratiev break; 9872be7d22fSVladimir Kondratiev case NL80211_IFTYPE_AP: 9887743882dSVladimir Kondratiev wil_dbg_misc(wil, "type: AP\n"); 9892be7d22fSVladimir Kondratiev ndev->type = ARPHRD_ETHER; 9902be7d22fSVladimir Kondratiev break; 9912be7d22fSVladimir Kondratiev case NL80211_IFTYPE_P2P_CLIENT: 9927743882dSVladimir Kondratiev wil_dbg_misc(wil, "type: P2P_CLIENT\n"); 9932be7d22fSVladimir Kondratiev ndev->type = ARPHRD_ETHER; 9942be7d22fSVladimir Kondratiev break; 9952be7d22fSVladimir Kondratiev case NL80211_IFTYPE_P2P_GO: 9967743882dSVladimir Kondratiev wil_dbg_misc(wil, "type: P2P_GO\n"); 9972be7d22fSVladimir Kondratiev ndev->type = ARPHRD_ETHER; 9982be7d22fSVladimir Kondratiev break; 9992be7d22fSVladimir Kondratiev case NL80211_IFTYPE_MONITOR: 10007743882dSVladimir Kondratiev wil_dbg_misc(wil, "type: Monitor\n"); 10012be7d22fSVladimir Kondratiev ndev->type = ARPHRD_IEEE80211_RADIOTAP; 10022be7d22fSVladimir Kondratiev /* ARPHRD_IEEE80211 or ARPHRD_IEEE80211_RADIOTAP ? */ 10032be7d22fSVladimir Kondratiev break; 10042be7d22fSVladimir Kondratiev default: 10052be7d22fSVladimir Kondratiev return -EOPNOTSUPP; 10062be7d22fSVladimir Kondratiev } 10072be7d22fSVladimir Kondratiev 10082be7d22fSVladimir Kondratiev /* MAC address - pre-requisite for other commands */ 10092be7d22fSVladimir Kondratiev wmi_set_mac_address(wil, ndev->dev_addr); 10102be7d22fSVladimir Kondratiev 101173d839aeSVladimir Kondratiev wil_dbg_misc(wil, "NAPI enable\n"); 1012e0287c4aSVladimir Kondratiev napi_enable(&wil->napi_rx); 1013e0287c4aSVladimir Kondratiev napi_enable(&wil->napi_tx); 10149419b6a2SVladimir Kondratiev set_bit(wil_status_napi_en, wil->status); 1015e0287c4aSVladimir Kondratiev 1016f772ebfbSVladimir Kondratiev if (wil->platform_ops.bus_request) 1017f772ebfbSVladimir Kondratiev wil->platform_ops.bus_request(wil->platform_handle, 1018f772ebfbSVladimir Kondratiev WIL_MAX_BUS_REQUEST_KBPS); 1019f772ebfbSVladimir Kondratiev 10202be7d22fSVladimir Kondratiev return 0; 10212be7d22fSVladimir Kondratiev } 10222be7d22fSVladimir Kondratiev 10232be7d22fSVladimir Kondratiev int wil_up(struct wil6210_priv *wil) 10242be7d22fSVladimir Kondratiev { 10252be7d22fSVladimir Kondratiev int rc; 10262be7d22fSVladimir Kondratiev 10279cf10d62SVladimir Kondratiev wil_dbg_misc(wil, "%s()\n", __func__); 10289cf10d62SVladimir Kondratiev 10292be7d22fSVladimir Kondratiev mutex_lock(&wil->mutex); 10302be7d22fSVladimir Kondratiev rc = __wil_up(wil); 10312be7d22fSVladimir Kondratiev mutex_unlock(&wil->mutex); 10322be7d22fSVladimir Kondratiev 10332be7d22fSVladimir Kondratiev return rc; 10342be7d22fSVladimir Kondratiev } 10352be7d22fSVladimir Kondratiev 103673d839aeSVladimir Kondratiev int __wil_down(struct wil6210_priv *wil) 10372be7d22fSVladimir Kondratiev { 103878771d76SVladimir Kondratiev int rc; 1039f172b563SDedy Lansky 1040097638a0SVladimir Kondratiev WARN_ON(!mutex_is_locked(&wil->mutex)); 1041097638a0SVladimir Kondratiev 1042f772ebfbSVladimir Kondratiev if (wil->platform_ops.bus_request) 1043f772ebfbSVladimir Kondratiev wil->platform_ops.bus_request(wil->platform_handle, 0); 1044f772ebfbSVladimir Kondratiev 104573d839aeSVladimir Kondratiev wil_disable_irq(wil); 10469419b6a2SVladimir Kondratiev if (test_and_clear_bit(wil_status_napi_en, wil->status)) { 1047e0287c4aSVladimir Kondratiev napi_disable(&wil->napi_rx); 1048e0287c4aSVladimir Kondratiev napi_disable(&wil->napi_tx); 104973d839aeSVladimir Kondratiev wil_dbg_misc(wil, "NAPI disable\n"); 105073d839aeSVladimir Kondratiev } 105173d839aeSVladimir Kondratiev wil_enable_irq(wil); 1052e0287c4aSVladimir Kondratiev 1053280ab987SLior David (void)wil_p2p_stop_discovery(wil); 1054e6d68341SDedy Lansky 10552be7d22fSVladimir Kondratiev if (wil->scan_request) { 10561d76250bSAvraham Stern struct cfg80211_scan_info info = { 10571d76250bSAvraham Stern .aborted = true, 10581d76250bSAvraham Stern }; 10591d76250bSAvraham Stern 10602a91d7d0SVladimir Kondratiev wil_dbg_misc(wil, "Abort scan_request 0x%p\n", 10612a91d7d0SVladimir Kondratiev wil->scan_request); 1062047e5d74SVladimir Kondratiev del_timer_sync(&wil->scan_timer); 10631d76250bSAvraham Stern cfg80211_scan_done(wil->scan_request, &info); 10642be7d22fSVladimir Kondratiev wil->scan_request = NULL; 10652be7d22fSVladimir Kondratiev } 10662be7d22fSVladimir Kondratiev 10679419b6a2SVladimir Kondratiev if (test_bit(wil_status_fwconnected, wil->status) || 106878771d76SVladimir Kondratiev test_bit(wil_status_fwconnecting, wil->status)) { 1069f172b563SDedy Lansky 1070f172b563SDedy Lansky mutex_unlock(&wil->mutex); 107178771d76SVladimir Kondratiev rc = wmi_call(wil, WMI_DISCONNECT_CMDID, NULL, 0, 107278771d76SVladimir Kondratiev WMI_DISCONNECT_EVENTID, NULL, 0, 107378771d76SVladimir Kondratiev WIL6210_DISCONNECT_TO_MS); 1074f172b563SDedy Lansky mutex_lock(&wil->mutex); 107578771d76SVladimir Kondratiev if (rc) 107678771d76SVladimir Kondratiev wil_err(wil, "timeout waiting for disconnect\n"); 107778771d76SVladimir Kondratiev } 1078f172b563SDedy Lansky 10792cd0f021SVladimir Kondratiev wil_reset(wil, false); 10802be7d22fSVladimir Kondratiev 10812be7d22fSVladimir Kondratiev return 0; 10822be7d22fSVladimir Kondratiev } 10832be7d22fSVladimir Kondratiev 10842be7d22fSVladimir Kondratiev int wil_down(struct wil6210_priv *wil) 10852be7d22fSVladimir Kondratiev { 10862be7d22fSVladimir Kondratiev int rc; 10872be7d22fSVladimir Kondratiev 10889cf10d62SVladimir Kondratiev wil_dbg_misc(wil, "%s()\n", __func__); 10899cf10d62SVladimir Kondratiev 1090c33407a8SVladimir Kondratiev wil_set_recovery_state(wil, fw_recovery_idle); 10912be7d22fSVladimir Kondratiev mutex_lock(&wil->mutex); 10922be7d22fSVladimir Kondratiev rc = __wil_down(wil); 10932be7d22fSVladimir Kondratiev mutex_unlock(&wil->mutex); 10942be7d22fSVladimir Kondratiev 10952be7d22fSVladimir Kondratiev return rc; 10962be7d22fSVladimir Kondratiev } 10973df2cd36SVladimir Kondratiev 10983df2cd36SVladimir Kondratiev int wil_find_cid(struct wil6210_priv *wil, const u8 *mac) 10993df2cd36SVladimir Kondratiev { 11003df2cd36SVladimir Kondratiev int i; 11013df2cd36SVladimir Kondratiev int rc = -ENOENT; 11023df2cd36SVladimir Kondratiev 11033df2cd36SVladimir Kondratiev for (i = 0; i < ARRAY_SIZE(wil->sta); i++) { 11043df2cd36SVladimir Kondratiev if ((wil->sta[i].status != wil_sta_unused) && 1105108d1eb6SVladimir Kondratiev ether_addr_equal(wil->sta[i].addr, mac)) { 11063df2cd36SVladimir Kondratiev rc = i; 11073df2cd36SVladimir Kondratiev break; 11083df2cd36SVladimir Kondratiev } 11093df2cd36SVladimir Kondratiev } 11103df2cd36SVladimir Kondratiev 11113df2cd36SVladimir Kondratiev return rc; 11123df2cd36SVladimir Kondratiev } 1113349214c1SMaya Erez 1114349214c1SMaya Erez void wil_halp_vote(struct wil6210_priv *wil) 1115349214c1SMaya Erez { 1116349214c1SMaya Erez unsigned long rc; 1117349214c1SMaya Erez unsigned long to_jiffies = msecs_to_jiffies(WAIT_FOR_HALP_VOTE_MS); 1118349214c1SMaya Erez 1119349214c1SMaya Erez mutex_lock(&wil->halp.lock); 1120349214c1SMaya Erez 1121ef86f249SLior David wil_dbg_irq(wil, "%s: start, HALP ref_cnt (%d)\n", __func__, 1122349214c1SMaya Erez wil->halp.ref_cnt); 1123349214c1SMaya Erez 1124349214c1SMaya Erez if (++wil->halp.ref_cnt == 1) { 1125349214c1SMaya Erez wil6210_set_halp(wil); 1126349214c1SMaya Erez rc = wait_for_completion_timeout(&wil->halp.comp, to_jiffies); 1127f1b7764fSMaya Erez if (!rc) { 1128349214c1SMaya Erez wil_err(wil, "%s: HALP vote timed out\n", __func__); 1129f1b7764fSMaya Erez /* Mask HALP as done in case the interrupt is raised */ 1130f1b7764fSMaya Erez wil6210_mask_halp(wil); 1131f1b7764fSMaya Erez } else { 1132ef86f249SLior David wil_dbg_irq(wil, 1133349214c1SMaya Erez "%s: HALP vote completed after %d ms\n", 1134349214c1SMaya Erez __func__, 1135349214c1SMaya Erez jiffies_to_msecs(to_jiffies - rc)); 1136349214c1SMaya Erez } 1137f1b7764fSMaya Erez } 1138349214c1SMaya Erez 1139ef86f249SLior David wil_dbg_irq(wil, "%s: end, HALP ref_cnt (%d)\n", __func__, 1140349214c1SMaya Erez wil->halp.ref_cnt); 1141349214c1SMaya Erez 1142349214c1SMaya Erez mutex_unlock(&wil->halp.lock); 1143349214c1SMaya Erez } 1144349214c1SMaya Erez 1145349214c1SMaya Erez void wil_halp_unvote(struct wil6210_priv *wil) 1146349214c1SMaya Erez { 1147349214c1SMaya Erez WARN_ON(wil->halp.ref_cnt == 0); 1148349214c1SMaya Erez 1149349214c1SMaya Erez mutex_lock(&wil->halp.lock); 1150349214c1SMaya Erez 1151ef86f249SLior David wil_dbg_irq(wil, "%s: start, HALP ref_cnt (%d)\n", __func__, 1152349214c1SMaya Erez wil->halp.ref_cnt); 1153349214c1SMaya Erez 1154349214c1SMaya Erez if (--wil->halp.ref_cnt == 0) { 1155349214c1SMaya Erez wil6210_clear_halp(wil); 1156ef86f249SLior David wil_dbg_irq(wil, "%s: HALP unvote\n", __func__); 1157349214c1SMaya Erez } 1158349214c1SMaya Erez 1159ef86f249SLior David wil_dbg_irq(wil, "%s: end, HALP ref_cnt (%d)\n", __func__, 1160349214c1SMaya Erez wil->halp.ref_cnt); 1161349214c1SMaya Erez 1162349214c1SMaya Erez mutex_unlock(&wil->halp.lock); 1163349214c1SMaya Erez } 1164