blob: b04e0afdcb216724b1329085f038c4da2d335016 [file] [log] [blame]
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -08001/*
Vladimir Shulman1f80af22015-01-25 10:52:48 +02002 * Copyright (c) 2012-2015 Qualcomm Atheros, Inc.
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -08003 *
4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
7 *
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15 */
16
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -080017#include <linux/moduleparam.h>
18#include <linux/if_arp.h>
Vladimir Kondratiev108d1eb2014-02-27 16:20:53 +020019#include <linux/etherdevice.h>
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -080020
21#include "wil6210.h"
Vladimir Kondratievb4490f42014-02-27 16:20:44 +020022#include "txrx.h"
Dedy Lanskyf172b562014-09-10 16:34:38 +030023#include "wmi.h"
24
25#define WAIT_FOR_DISCONNECT_TIMEOUT_MS 2000
26#define WAIT_FOR_DISCONNECT_INTERVAL_MS 10
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -080027
Vladimir Kondratievc33407a2014-10-01 15:05:24 +030028bool no_fw_recovery;
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +020029module_param(no_fw_recovery, bool, S_IRUGO | S_IWUSR);
Vladimir Kondratievc33407a2014-10-01 15:05:24 +030030MODULE_PARM_DESC(no_fw_recovery, " disable automatic FW error recovery");
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +020031
Vladimir Kondratiev151a9702014-09-10 16:34:30 +030032static bool no_fw_load = true;
33module_param(no_fw_load, bool, S_IRUGO | S_IWUSR);
34MODULE_PARM_DESC(no_fw_load, " do not download FW, use one in on-card flash.");
35
Vladimir Kondratievab954622014-12-23 09:47:20 +020036/* if not set via modparam, will be set to default value of 1/8 of
37 * rx ring size during init flow
38 */
39unsigned short rx_ring_overflow_thrsh = WIL6210_RX_HIGH_TRSH_INIT;
40module_param(rx_ring_overflow_thrsh, ushort, S_IRUGO);
41MODULE_PARM_DESC(rx_ring_overflow_thrsh,
42 " RX ring overflow threshold in descriptors.");
Vladimir Kondratievb6b1b0e2014-09-22 15:31:41 +030043
Vladimir Kondratiev9a06bec2014-10-28 16:51:27 +020044/* We allow allocation of more than 1 page buffers to support large packets.
45 * It is suboptimal behavior performance wise in case MTU above page size.
46 */
Vladimir Kondratievc44690a2014-12-23 09:47:11 +020047unsigned int mtu_max = TXRX_BUF_LEN_DEFAULT - WIL_MAX_MPDU_OVERHEAD;
Vladimir Kondratiev9a06bec2014-10-28 16:51:27 +020048static int mtu_max_set(const char *val, const struct kernel_param *kp)
49{
50 int ret;
51
52 /* sets mtu_max directly. no need to restore it in case of
53 * illegal value since we assume this will fail insmod
54 */
55 ret = param_set_uint(val, kp);
56 if (ret)
57 return ret;
58
Vladimir Kondratiev4590d812014-12-23 09:47:12 +020059 if (mtu_max < 68 || mtu_max > WIL_MAX_ETH_MTU)
Vladimir Kondratiev9a06bec2014-10-28 16:51:27 +020060 ret = -EINVAL;
61
62 return ret;
63}
64
65static struct kernel_param_ops mtu_max_ops = {
66 .set = mtu_max_set,
67 .get = param_get_uint,
68};
69
70module_param_cb(mtu_max, &mtu_max_ops, &mtu_max, S_IRUGO);
71MODULE_PARM_DESC(mtu_max, " Max MTU value.");
72
Vladimir Kondratievd3762b42014-12-01 15:35:02 +020073static uint rx_ring_order = WIL_RX_RING_SIZE_ORDER_DEFAULT;
74static uint tx_ring_order = WIL_TX_RING_SIZE_ORDER_DEFAULT;
75
76static int ring_order_set(const char *val, const struct kernel_param *kp)
77{
78 int ret;
79 uint x;
80
81 ret = kstrtouint(val, 0, &x);
82 if (ret)
83 return ret;
84
85 if ((x < WIL_RING_SIZE_ORDER_MIN) || (x > WIL_RING_SIZE_ORDER_MAX))
86 return -EINVAL;
87
88 *((uint *)kp->arg) = x;
89
90 return 0;
91}
92
93static struct kernel_param_ops ring_order_ops = {
94 .set = ring_order_set,
95 .get = param_get_uint,
96};
97
98module_param_cb(rx_ring_order, &ring_order_ops, &rx_ring_order, S_IRUGO);
99MODULE_PARM_DESC(rx_ring_order, " Rx ring order; size = 1 << order");
100module_param_cb(tx_ring_order, &ring_order_ops, &tx_ring_order, S_IRUGO);
101MODULE_PARM_DESC(tx_ring_order, " Tx ring order; size = 1 << order");
102
Vladimir Kondratiev520d68e2014-08-06 10:31:53 +0300103#define RST_DELAY (20) /* msec, for loop in @wil_target_reset */
104#define RST_COUNT (1 + 1000/RST_DELAY) /* round up to be above 1 sec total */
105
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800106/*
107 * Due to a hardware issue,
108 * one has to read/write to/from NIC in 32-bit chunks;
109 * regular memcpy_fromio and siblings will
110 * not work on 64-bit platform - it uses 64-bit transactions
111 *
112 * Force 32-bit transactions to enable NIC on 64-bit platforms
113 *
114 * To avoid byte swap on big endian host, __raw_{read|write}l
115 * should be used - {read|write}l would swap bytes to provide
116 * little endian on PCI value in host endianness.
117 */
118void wil_memcpy_fromio_32(void *dst, const volatile void __iomem *src,
119 size_t count)
120{
121 u32 *d = dst;
122 const volatile u32 __iomem *s = src;
123
124 /* size_t is unsigned, if (count%4 != 0) it will wrap */
125 for (count += 4; count > 4; count -= 4)
126 *d++ = __raw_readl(s++);
127}
128
129void wil_memcpy_toio_32(volatile void __iomem *dst, const void *src,
130 size_t count)
131{
132 volatile u32 __iomem *d = dst;
133 const u32 *s = src;
134
135 for (count += 4; count > 4; count -= 4)
136 __raw_writel(*s++, d++);
137}
138
Vladimir Kondratievb516fcc2014-10-28 16:50:08 +0200139static void wil_disconnect_cid(struct wil6210_priv *wil, int cid,
Vladimir Kondratiev4821e6d2014-12-01 15:33:15 +0200140 u16 reason_code, bool from_event)
Vladimir Kondratievbd332732014-12-23 09:47:24 +0200141__acquires(&sta->tid_rx_lock) __releases(&sta->tid_rx_lock)
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200142{
143 uint i;
Vladimir Kondratievfc58f682014-06-16 19:37:16 +0300144 struct net_device *ndev = wil_to_ndev(wil);
145 struct wireless_dev *wdev = wil->wdev;
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200146 struct wil_sta_info *sta = &wil->sta[cid];
Vladimir Kondratiev8fe59622014-09-10 16:34:34 +0300147
Vladimir Kondratievbd332732014-12-23 09:47:24 +0200148 might_sleep();
Vladimir Kondratievfc58f682014-06-16 19:37:16 +0300149 wil_dbg_misc(wil, "%s(CID %d, status %d)\n", __func__, cid,
150 sta->status);
Vladimir Kondratiev4d55a0a2014-02-27 16:20:54 +0200151
Vladimir Kondratieve58c9f72014-03-17 15:34:06 +0200152 sta->data_port_open = false;
Vladimir Kondratiev4d55a0a2014-02-27 16:20:54 +0200153 if (sta->status != wil_sta_unused) {
Vladimir Kondratievb516fcc2014-10-28 16:50:08 +0200154 if (!from_event)
Vladimir Kondratiev4821e6d2014-12-01 15:33:15 +0200155 wmi_disconnect_sta(wil, sta->addr, reason_code);
Vladimir Kondratievb516fcc2014-10-28 16:50:08 +0200156
Vladimir Kondratievfc58f682014-06-16 19:37:16 +0300157 switch (wdev->iftype) {
158 case NL80211_IFTYPE_AP:
159 case NL80211_IFTYPE_P2P_GO:
160 /* AP-like interface */
161 cfg80211_del_sta(ndev, sta->addr, GFP_KERNEL);
162 break;
163 default:
164 break;
165 }
Vladimir Kondratiev4d55a0a2014-02-27 16:20:54 +0200166 sta->status = wil_sta_unused;
167 }
168
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200169 for (i = 0; i < WIL_STA_TID_NUM; i++) {
Dedy Lanskyec81b5a2014-09-10 16:34:42 +0300170 struct wil_tid_ampdu_rx *r;
Dedy Lanskyec81b5a2014-09-10 16:34:42 +0300171
Vladimir Kondratievbd332732014-12-23 09:47:24 +0200172 spin_lock_bh(&sta->tid_rx_lock);
Dedy Lanskyec81b5a2014-09-10 16:34:42 +0300173
174 r = sta->tid_rx[i];
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200175 sta->tid_rx[i] = NULL;
176 wil_tid_ampdu_rx_free(wil, r);
Dedy Lanskyec81b5a2014-09-10 16:34:42 +0300177
Vladimir Kondratievbd332732014-12-23 09:47:24 +0200178 spin_unlock_bh(&sta->tid_rx_lock);
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200179 }
180 for (i = 0; i < ARRAY_SIZE(wil->vring_tx); i++) {
181 if (wil->vring2cid_tid[i][0] == cid)
182 wil_vring_fini_tx(wil, i);
183 }
184 memset(&sta->stats, 0, sizeof(sta->stats));
185}
186
Vladimir Kondratievb516fcc2014-10-28 16:50:08 +0200187static void _wil6210_disconnect(struct wil6210_priv *wil, const u8 *bssid,
Vladimir Kondratiev4821e6d2014-12-01 15:33:15 +0200188 u16 reason_code, bool from_event)
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800189{
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200190 int cid = -ENOENT;
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800191 struct net_device *ndev = wil_to_ndev(wil);
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200192 struct wireless_dev *wdev = wil->wdev;
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800193
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200194 might_sleep();
Vladimir Kondratiev100106d2014-12-23 09:47:07 +0200195 wil_dbg_misc(wil, "%s(bssid=%pM, reason=%d, ev%s)\n", __func__, bssid,
196 reason_code, from_event ? "+" : "-");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800197
Vladimir Kondratiev100106d2014-12-23 09:47:07 +0200198 /* Cases are:
199 * - disconnect single STA, still connected
200 * - disconnect single STA, already disconnected
201 * - disconnect all
202 *
203 * For "disconnect all", there are 2 options:
204 * - bssid == NULL
205 * - bssid is our MAC address
206 */
207 if (bssid && memcmp(ndev->dev_addr, bssid, ETH_ALEN)) {
208 cid = wil_find_cid(wil, bssid);
209 wil_dbg_misc(wil, "Disconnect %pM, CID=%d, reason=%d\n",
210 bssid, cid, reason_code);
211 if (cid >= 0) /* disconnect 1 peer */
212 wil_disconnect_cid(wil, cid, reason_code, from_event);
213 } else { /* all */
214 wil_dbg_misc(wil, "Disconnect all\n");
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200215 for (cid = 0; cid < WIL6210_MAX_CID; cid++)
Vladimir Kondratiev4821e6d2014-12-01 15:33:15 +0200216 wil_disconnect_cid(wil, cid, reason_code, from_event);
Vladimir Kondratiev100106d2014-12-23 09:47:07 +0200217 }
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200218
219 /* link state */
220 switch (wdev->iftype) {
221 case NL80211_IFTYPE_STATION:
222 case NL80211_IFTYPE_P2P_CLIENT:
Dedy Lanskyc5e96c92015-01-25 10:52:43 +0200223 netif_tx_stop_all_queues(ndev);
224 netif_carrier_off(ndev);
225
Vladimir Kondratiev9419b6a2014-12-23 09:47:14 +0200226 if (test_bit(wil_status_fwconnected, wil->status)) {
227 clear_bit(wil_status_fwconnected, wil->status);
Vladimir Kondratiev4821e6d2014-12-01 15:33:15 +0200228 cfg80211_disconnected(ndev, reason_code,
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200229 NULL, 0, GFP_KERNEL);
Vladimir Kondratiev9419b6a2014-12-23 09:47:14 +0200230 } else if (test_bit(wil_status_fwconnecting, wil->status)) {
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200231 cfg80211_connect_result(ndev, bssid, NULL, 0, NULL, 0,
232 WLAN_STATUS_UNSPECIFIED_FAILURE,
233 GFP_KERNEL);
Vladimir Kondratievb4490f42014-02-27 16:20:44 +0200234 }
Vladimir Kondratiev9419b6a2014-12-23 09:47:14 +0200235 clear_bit(wil_status_fwconnecting, wil->status);
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200236 break;
237 default:
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200238 break;
Vladimir Kondratievb4490f42014-02-27 16:20:44 +0200239 }
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800240}
241
242static void wil_disconnect_worker(struct work_struct *work)
243{
244 struct wil6210_priv *wil = container_of(work,
245 struct wil6210_priv, disconnect_worker);
246
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200247 mutex_lock(&wil->mutex);
Vladimir Kondratiev4821e6d2014-12-01 15:33:15 +0200248 _wil6210_disconnect(wil, NULL, WLAN_REASON_UNSPECIFIED, false);
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200249 mutex_unlock(&wil->mutex);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800250}
251
252static void wil_connect_timer_fn(ulong x)
253{
254 struct wil6210_priv *wil = (void *)x;
255
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200256 wil_dbg_misc(wil, "Connect timeout\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800257
258 /* reschedule to thread context - disconnect won't
259 * run from atomic context
260 */
261 schedule_work(&wil->disconnect_worker);
262}
263
Vladimir Kondratiev047e5d72014-05-27 14:45:48 +0300264static void wil_scan_timer_fn(ulong x)
265{
266 struct wil6210_priv *wil = (void *)x;
267
Vladimir Kondratiev9419b6a2014-12-23 09:47:14 +0200268 clear_bit(wil_status_fwready, wil->status);
Vladimir Kondratiev047e5d72014-05-27 14:45:48 +0300269 wil_err(wil, "Scan timeout detected, start fw error recovery\n");
Vladimir Kondratiev60abbb62014-12-01 15:33:17 +0200270 wil->recovery_state = fw_recovery_pending;
Vladimir Kondratiev047e5d72014-05-27 14:45:48 +0300271 schedule_work(&wil->fw_error_worker);
272}
273
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300274static int wil_wait_for_recovery(struct wil6210_priv *wil)
275{
276 if (wait_event_interruptible(wil->wq, wil->recovery_state !=
277 fw_recovery_pending)) {
278 wil_err(wil, "Interrupt, canceling recovery\n");
279 return -ERESTARTSYS;
280 }
281 if (wil->recovery_state != fw_recovery_running) {
282 wil_info(wil, "Recovery cancelled\n");
283 return -EINTR;
284 }
285 wil_info(wil, "Proceed with recovery\n");
286 return 0;
287}
288
289void wil_set_recovery_state(struct wil6210_priv *wil, int state)
290{
291 wil_dbg_misc(wil, "%s(%d -> %d)\n", __func__,
292 wil->recovery_state, state);
293
294 wil->recovery_state = state;
295 wake_up_interruptible(&wil->wq);
296}
297
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200298static void wil_fw_error_worker(struct work_struct *work)
299{
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300300 struct wil6210_priv *wil = container_of(work, struct wil6210_priv,
301 fw_error_worker);
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200302 struct wireless_dev *wdev = wil->wdev;
303
304 wil_dbg_misc(wil, "fw error worker\n");
305
Vladimir Kondratievcded9362014-10-28 16:50:06 +0200306 if (!netif_running(wil_to_ndev(wil))) {
307 wil_info(wil, "No recovery - interface is down\n");
308 return;
309 }
310
Vladimir Kondratievfc219ee2014-05-27 14:45:45 +0300311 /* increment @recovery_count if less then WIL6210_FW_RECOVERY_TO
312 * passed since last recovery attempt
313 */
314 if (time_is_after_jiffies(wil->last_fw_recovery +
315 WIL6210_FW_RECOVERY_TO))
316 wil->recovery_count++;
317 else
318 wil->recovery_count = 1; /* fw was alive for a long time */
319
320 if (wil->recovery_count > WIL6210_FW_RECOVERY_RETRIES) {
321 wil_err(wil, "too many recovery attempts (%d), giving up\n",
322 wil->recovery_count);
323 return;
324 }
325
326 wil->last_fw_recovery = jiffies;
327
Vladimir Kondratiev9c3bde52014-03-17 15:34:21 +0200328 mutex_lock(&wil->mutex);
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200329 switch (wdev->iftype) {
330 case NL80211_IFTYPE_STATION:
331 case NL80211_IFTYPE_P2P_CLIENT:
332 case NL80211_IFTYPE_MONITOR:
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300333 wil_info(wil, "fw error recovery requested (try %d)...\n",
Vladimir Kondratievfc219ee2014-05-27 14:45:45 +0300334 wil->recovery_count);
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300335 if (!no_fw_recovery)
336 wil->recovery_state = fw_recovery_running;
337 if (0 != wil_wait_for_recovery(wil))
338 break;
339
Vladimir Kondratiev73d839a2014-09-10 16:34:50 +0300340 __wil_down(wil);
341 __wil_up(wil);
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200342 break;
343 case NL80211_IFTYPE_AP:
344 case NL80211_IFTYPE_P2P_GO:
Vladimir Kondratieve2405372014-10-28 16:50:09 +0200345 wil_info(wil, "No recovery for AP-like interface\n");
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200346 /* recovery in these modes is done by upper layers */
347 break;
348 default:
Vladimir Kondratieve2405372014-10-28 16:50:09 +0200349 wil_err(wil, "No recovery - unknown interface type %d\n",
350 wdev->iftype);
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200351 break;
352 }
Vladimir Kondratiev9c3bde52014-03-17 15:34:21 +0200353 mutex_unlock(&wil->mutex);
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200354}
355
Vladimir Kondratiev9a177382014-02-27 16:20:45 +0200356static int wil_find_free_vring(struct wil6210_priv *wil)
357{
358 int i;
Vladimir Kondratiev8fe59622014-09-10 16:34:34 +0300359
Vladimir Kondratiev9a177382014-02-27 16:20:45 +0200360 for (i = 0; i < WIL6210_MAX_TX_RINGS; i++) {
361 if (!wil->vring_tx[i].va)
362 return i;
363 }
364 return -EINVAL;
365}
366
Vladimir Kondratievd81079f2013-03-13 14:12:43 +0200367static void wil_connect_worker(struct work_struct *work)
368{
369 int rc;
370 struct wil6210_priv *wil = container_of(work, struct wil6210_priv,
371 connect_worker);
Dedy Lanskyc5e96c92015-01-25 10:52:43 +0200372 struct net_device *ndev = wil_to_ndev(wil);
373
Vladimir Kondratievd81079f2013-03-13 14:12:43 +0200374 int cid = wil->pending_connect_cid;
Vladimir Kondratiev9a177382014-02-27 16:20:45 +0200375 int ringid = wil_find_free_vring(wil);
Vladimir Kondratievd81079f2013-03-13 14:12:43 +0200376
377 if (cid < 0) {
378 wil_err(wil, "No connection pending\n");
379 return;
380 }
381
382 wil_dbg_wmi(wil, "Configure for connection CID %d\n", cid);
383
Vladimir Kondratievd3762b42014-12-01 15:35:02 +0200384 rc = wil_vring_init_tx(wil, ringid, 1 << tx_ring_order, cid, 0);
Vladimir Kondratievd81079f2013-03-13 14:12:43 +0200385 wil->pending_connect_cid = -1;
Vladimir Kondratiev3df2cd362014-02-27 16:20:43 +0200386 if (rc == 0) {
387 wil->sta[cid].status = wil_sta_connected;
Dedy Lanskyc5e96c92015-01-25 10:52:43 +0200388 netif_tx_wake_all_queues(ndev);
Vladimir Kondratiev3df2cd362014-02-27 16:20:43 +0200389 } else {
390 wil->sta[cid].status = wil_sta_unused;
391 }
Vladimir Kondratievd81079f2013-03-13 14:12:43 +0200392}
393
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800394int wil_priv_init(struct wil6210_priv *wil)
395{
Dedy Lanskyec81b5a2014-09-10 16:34:42 +0300396 uint i;
397
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200398 wil_dbg_misc(wil, "%s()\n", __func__);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800399
Vladimir Kondratiev3df2cd362014-02-27 16:20:43 +0200400 memset(wil->sta, 0, sizeof(wil->sta));
Dedy Lanskyec81b5a2014-09-10 16:34:42 +0300401 for (i = 0; i < WIL6210_MAX_CID; i++)
402 spin_lock_init(&wil->sta[i].tid_rx_lock);
Vladimir Kondratiev3df2cd362014-02-27 16:20:43 +0200403
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800404 mutex_init(&wil->mutex);
405 mutex_init(&wil->wmi_mutex);
Vladimir Kondratiev32772132014-12-23 09:47:03 +0200406 mutex_init(&wil->back_rx_mutex);
Vladimir Kondratiev3a124ed2014-12-23 09:47:04 +0200407 mutex_init(&wil->back_tx_mutex);
Vladimir Kondratiev40822a92015-01-25 10:52:50 +0200408 mutex_init(&wil->probe_client_mutex);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800409
410 init_completion(&wil->wmi_ready);
Dedy Lansky59502642014-09-10 16:34:46 +0300411 init_completion(&wil->wmi_call);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800412
413 wil->pending_connect_cid = -1;
414 setup_timer(&wil->connect_timer, wil_connect_timer_fn, (ulong)wil);
Vladimir Kondratiev047e5d72014-05-27 14:45:48 +0300415 setup_timer(&wil->scan_timer, wil_scan_timer_fn, (ulong)wil);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800416
Vladimir Kondratievd81079f2013-03-13 14:12:43 +0200417 INIT_WORK(&wil->connect_worker, wil_connect_worker);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800418 INIT_WORK(&wil->disconnect_worker, wil_disconnect_worker);
419 INIT_WORK(&wil->wmi_event_worker, wmi_event_worker);
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200420 INIT_WORK(&wil->fw_error_worker, wil_fw_error_worker);
Vladimir Kondratiev32772132014-12-23 09:47:03 +0200421 INIT_WORK(&wil->back_rx_worker, wil_back_rx_worker);
Vladimir Kondratiev3a124ed2014-12-23 09:47:04 +0200422 INIT_WORK(&wil->back_tx_worker, wil_back_tx_worker);
Vladimir Kondratiev40822a92015-01-25 10:52:50 +0200423 INIT_WORK(&wil->probe_client_worker, wil_probe_client_worker);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800424
425 INIT_LIST_HEAD(&wil->pending_wmi_ev);
Vladimir Kondratiev32772132014-12-23 09:47:03 +0200426 INIT_LIST_HEAD(&wil->back_rx_pending);
Vladimir Kondratiev3a124ed2014-12-23 09:47:04 +0200427 INIT_LIST_HEAD(&wil->back_tx_pending);
Vladimir Kondratiev40822a92015-01-25 10:52:50 +0200428 INIT_LIST_HEAD(&wil->probe_client_pending);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800429 spin_lock_init(&wil->wmi_ev_lock);
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300430 init_waitqueue_head(&wil->wq);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800431
Vladimir Kondratiev32772132014-12-23 09:47:03 +0200432 wil->wmi_wq = create_singlethread_workqueue(WIL_NAME "_wmi");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800433 if (!wil->wmi_wq)
434 return -EAGAIN;
435
Vladimir Kondratiev32772132014-12-23 09:47:03 +0200436 wil->wq_service = create_singlethread_workqueue(WIL_NAME "_service");
437 if (!wil->wq_service)
438 goto out_wmi_wq;
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800439
Vladimir Kondratievfc219ee2014-05-27 14:45:45 +0300440 wil->last_fw_recovery = jiffies;
Vladimir Shulman1f80af22015-01-25 10:52:48 +0200441 wil->tx_interframe_timeout = WIL6210_ITR_TX_INTERFRAME_TIMEOUT_DEFAULT;
442 wil->rx_interframe_timeout = WIL6210_ITR_RX_INTERFRAME_TIMEOUT_DEFAULT;
443 wil->tx_max_burst_duration = WIL6210_ITR_TX_MAX_BURST_DURATION_DEFAULT;
444 wil->rx_max_burst_duration = WIL6210_ITR_RX_MAX_BURST_DURATION_DEFAULT;
Vladimir Kondratievfc219ee2014-05-27 14:45:45 +0300445
Vladimir Kondratievab954622014-12-23 09:47:20 +0200446 if (rx_ring_overflow_thrsh == WIL6210_RX_HIGH_TRSH_INIT)
447 rx_ring_overflow_thrsh = WIL6210_RX_HIGH_TRSH_DEFAULT;
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800448 return 0;
Vladimir Kondratiev32772132014-12-23 09:47:03 +0200449
450out_wmi_wq:
451 destroy_workqueue(wil->wmi_wq);
452
453 return -EAGAIN;
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800454}
455
Vladimir Kondratievb516fcc2014-10-28 16:50:08 +0200456/**
457 * wil6210_disconnect - disconnect one connection
458 * @wil: driver context
459 * @bssid: peer to disconnect, NULL to disconnect all
Vladimir Kondratiev4821e6d2014-12-01 15:33:15 +0200460 * @reason_code: Reason code for the Disassociation frame
Vladimir Kondratievb516fcc2014-10-28 16:50:08 +0200461 * @from_event: whether is invoked from FW event handler
462 *
463 * Disconnect and release associated resources. If invoked not from the
464 * FW event handler, issue WMI command(s) to trigger MAC disconnect.
465 */
466void wil6210_disconnect(struct wil6210_priv *wil, const u8 *bssid,
Vladimir Kondratiev4821e6d2014-12-01 15:33:15 +0200467 u16 reason_code, bool from_event)
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800468{
Vladimir Kondratiev9cf10d62014-09-10 16:34:36 +0300469 wil_dbg_misc(wil, "%s()\n", __func__);
470
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800471 del_timer_sync(&wil->connect_timer);
Vladimir Kondratiev4821e6d2014-12-01 15:33:15 +0200472 _wil6210_disconnect(wil, bssid, reason_code, from_event);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800473}
474
475void wil_priv_deinit(struct wil6210_priv *wil)
476{
Vladimir Kondratiev9cf10d62014-09-10 16:34:36 +0300477 wil_dbg_misc(wil, "%s()\n", __func__);
478
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300479 wil_set_recovery_state(wil, fw_recovery_idle);
Vladimir Kondratiev047e5d72014-05-27 14:45:48 +0300480 del_timer_sync(&wil->scan_timer);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800481 cancel_work_sync(&wil->disconnect_worker);
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200482 cancel_work_sync(&wil->fw_error_worker);
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200483 mutex_lock(&wil->mutex);
Vladimir Kondratiev4821e6d2014-12-01 15:33:15 +0200484 wil6210_disconnect(wil, NULL, WLAN_REASON_DEAUTH_LEAVING, false);
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200485 mutex_unlock(&wil->mutex);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800486 wmi_event_flush(wil);
Vladimir Kondratiev32772132014-12-23 09:47:03 +0200487 wil_back_rx_flush(wil);
488 cancel_work_sync(&wil->back_rx_worker);
Vladimir Kondratiev3a124ed2014-12-23 09:47:04 +0200489 wil_back_tx_flush(wil);
490 cancel_work_sync(&wil->back_tx_worker);
Vladimir Kondratiev40822a92015-01-25 10:52:50 +0200491 wil_probe_client_flush(wil);
492 cancel_work_sync(&wil->probe_client_worker);
Vladimir Kondratiev32772132014-12-23 09:47:03 +0200493 destroy_workqueue(wil->wq_service);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800494 destroy_workqueue(wil->wmi_wq);
495}
496
Vladimir Kondratiev151a9702014-09-10 16:34:30 +0300497/* target operations */
498/* register read */
499#define R(a) ioread32(wil->csr + HOSTADDR(a))
500/* register write. wmb() to make sure it is completed */
501#define W(a, v) do { iowrite32(v, wil->csr + HOSTADDR(a)); wmb(); } while (0)
502/* register set = read, OR, write */
503#define S(a, v) W(a, R(a) | v)
504/* register clear = read, AND with inverted, write */
505#define C(a, v) W(a, R(a) & ~v)
506
507static inline void wil_halt_cpu(struct wil6210_priv *wil)
508{
509 W(RGF_USER_USER_CPU_0, BIT_USER_USER_CPU_MAN_RST);
510 W(RGF_USER_MAC_CPU_0, BIT_USER_MAC_CPU_MAN_RST);
511}
512
513static inline void wil_release_cpu(struct wil6210_priv *wil)
514{
515 /* Start CPU */
516 W(RGF_USER_USER_CPU_0, 1);
517}
518
Vladimir Kondratievbbb2adc2014-08-06 10:31:52 +0300519static int wil_target_reset(struct wil6210_priv *wil)
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800520{
Vladimir Kondratiev98a65b52014-03-17 15:34:12 +0200521 int delay = 0;
Vladimir Kondratiev48516292014-10-28 16:50:07 +0200522 u32 x;
Vladimir Kondratiev1aeda132014-12-23 09:47:18 +0200523 bool is_reset_v2 = test_bit(hw_capability_reset_v2,
524 wil->hw_capabilities);
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200525
Vladimir Kondratiev1aeda132014-12-23 09:47:18 +0200526 wil_dbg_misc(wil, "Resetting \"%s\"...\n", wil->hw_name);
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300527
528 /* Clear MAC link up */
529 S(RGF_HP_CTRL, BIT(15));
Vladimir Kondratiev151a9702014-09-10 16:34:30 +0300530 S(RGF_USER_CLKS_CTL_SW_RST_MASK_0, BIT_HPAL_PERST_FROM_PAD);
531 S(RGF_USER_CLKS_CTL_SW_RST_MASK_0, BIT_CAR_PERST_RST);
532
533 wil_halt_cpu(wil);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800534
Vladimir Kondratievcce477112014-12-01 15:36:31 +0200535 /* Clear Fw Download notification */
536 C(RGF_USER_USAGE_6, BIT(0));
537
Vladimir Kondratiev1aeda132014-12-23 09:47:18 +0200538 if (is_reset_v2) {
Vladimir Kondratiev48516292014-10-28 16:50:07 +0200539 S(RGF_CAF_OSC_CONTROL, BIT_CAF_OSC_XTAL_EN);
540 /* XTAL stabilization should take about 3ms */
541 usleep_range(5000, 7000);
542 x = R(RGF_CAF_PLL_LOCK_STATUS);
543 if (!(x & BIT_CAF_OSC_DIG_XTAL_STABLE)) {
544 wil_err(wil, "Xtal stabilization timeout\n"
545 "RGF_CAF_PLL_LOCK_STATUS = 0x%08x\n", x);
546 return -ETIME;
547 }
548 /* switch 10k to XTAL*/
549 C(RGF_USER_SPARROW_M_4, BIT_SPARROW_M_4_SEL_SLEEP_OR_REF);
550 /* 40 MHz */
551 C(RGF_USER_CLKS_CTL_0, BIT_USER_CLKS_CAR_AHB_SW_SEL);
552
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300553 W(RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_0, 0x3ff81f);
Vladimir Kondratiev151a9702014-09-10 16:34:30 +0300554 W(RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_1, 0xf);
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300555 }
556
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800557 W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0xFE000000);
558 W(RGF_USER_CLKS_CTL_SW_RST_VEC_1, 0x0000003F);
Vladimir Kondratiev1aeda132014-12-23 09:47:18 +0200559 W(RGF_USER_CLKS_CTL_SW_RST_VEC_3,
560 is_reset_v2 ? 0x000000f0 : 0x00000170);
Vladimir Kondratiev151a9702014-09-10 16:34:30 +0300561 W(RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0xFFE7FE00);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800562
Vladimir Kondratiev1aeda132014-12-23 09:47:18 +0200563 if (is_reset_v2) {
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300564 W(RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_0, 0x0);
Vladimir Kondratiev151a9702014-09-10 16:34:30 +0300565 W(RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_1, 0x0);
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300566 }
567
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800568 W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0);
569 W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0);
570 W(RGF_USER_CLKS_CTL_SW_RST_VEC_1, 0);
571 W(RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0);
572
Vladimir Kondratiev1aeda132014-12-23 09:47:18 +0200573 if (is_reset_v2) {
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300574 W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0x00000003);
575 /* reset A2 PCIE AHB */
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200576 W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0x00008000);
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300577 } else {
578 W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0x00000001);
Vladimir Kondratiev1aeda132014-12-23 09:47:18 +0200579 W(RGF_PCIE_LOS_COUNTER_CTL, BIT(6) | BIT(8));
580 W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0x00008000);
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200581 }
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300582
583 /* TODO: check order here!!! Erez code is different */
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800584 W(RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0);
585
Vladimir Kondratiev520d68e2014-08-06 10:31:53 +0300586 /* wait until device ready. typical time is 200..250 msec */
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200587 do {
Vladimir Kondratiev520d68e2014-08-06 10:31:53 +0300588 msleep(RST_DELAY);
Vladimir Kondratiev48516292014-10-28 16:50:07 +0200589 x = R(RGF_USER_HW_MACHINE_STATE);
Vladimir Kondratiev520d68e2014-08-06 10:31:53 +0300590 if (delay++ > RST_COUNT) {
Vladimir Kondratievd28bcc32014-03-17 15:34:23 +0200591 wil_err(wil, "Reset not completed, hw_state 0x%08x\n",
Vladimir Kondratiev48516292014-10-28 16:50:07 +0200592 x);
Vladimir Kondratievbbb2adc2014-08-06 10:31:52 +0300593 return -ETIME;
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200594 }
Vladimir Kondratiev48516292014-10-28 16:50:07 +0200595 } while (x != HW_MACHINE_BOOT_DONE);
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200596
Vladimir Kondratiev1aeda132014-12-23 09:47:18 +0200597 if (!is_reset_v2)
Vladimir Kondratiev17123992014-03-17 15:34:14 +0200598 W(RGF_PCIE_LOS_COUNTER_CTL, BIT(8));
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200599
Vladimir Kondratiev972072a2014-03-17 15:34:15 +0200600 C(RGF_USER_CLKS_CTL_0, BIT_USER_CLKS_RST_PWGD);
601
Vladimir Kondratiev520d68e2014-08-06 10:31:53 +0300602 wil_dbg_misc(wil, "Reset completed in %d ms\n", delay * RST_DELAY);
Vladimir Kondratievbbb2adc2014-08-06 10:31:52 +0300603 return 0;
Vladimir Kondratiev151a9702014-09-10 16:34:30 +0300604}
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800605
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200606#undef R
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800607#undef W
608#undef S
Vladimir Kondratiev972072a2014-03-17 15:34:15 +0200609#undef C
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800610
611void wil_mbox_ring_le2cpus(struct wil6210_mbox_ring *r)
612{
613 le32_to_cpus(&r->base);
614 le16_to_cpus(&r->entry_size);
615 le16_to_cpus(&r->size);
616 le32_to_cpus(&r->tail);
617 le32_to_cpus(&r->head);
618}
619
620static int wil_wait_for_fw_ready(struct wil6210_priv *wil)
621{
622 ulong to = msecs_to_jiffies(1000);
623 ulong left = wait_for_completion_timeout(&wil->wmi_ready, to);
Vladimir Kondratiev8fe59622014-09-10 16:34:34 +0300624
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800625 if (0 == left) {
626 wil_err(wil, "Firmware not ready\n");
627 return -ETIME;
628 } else {
Vladimir Kondratiev15e23122014-04-08 11:36:16 +0300629 wil_info(wil, "FW ready after %d ms. HW version 0x%08x\n",
630 jiffies_to_msecs(to-left), wil->hw_version);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800631 }
632 return 0;
633}
634
635/*
636 * We reset all the structures, and we reset the UMAC.
637 * After calling this routine, you're expected to reload
638 * the firmware.
639 */
640int wil_reset(struct wil6210_priv *wil)
641{
642 int rc;
643
Vladimir Kondratiev9cf10d62014-09-10 16:34:36 +0300644 wil_dbg_misc(wil, "%s()\n", __func__);
645
Vladimir Kondratiev1aeda132014-12-23 09:47:18 +0200646 if (wil->hw_version == HW_VER_UNKNOWN)
647 return -ENODEV;
648
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200649 WARN_ON(!mutex_is_locked(&wil->mutex));
Vladimir Kondratiev9419b6a2014-12-23 09:47:14 +0200650 WARN_ON(test_bit(wil_status_napi_en, wil->status));
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200651
652 cancel_work_sync(&wil->disconnect_worker);
Vladimir Kondratiev4821e6d2014-12-01 15:33:15 +0200653 wil6210_disconnect(wil, NULL, WLAN_REASON_DEAUTH_LEAVING, false);
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200654
Vladimir Kondratiev9419b6a2014-12-23 09:47:14 +0200655 /* prevent NAPI from being scheduled */
656 bitmap_zero(wil->status, wil_status_last);
Vladimir Kondratiev0fef1812014-03-17 15:34:18 +0200657
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200658 if (wil->scan_request) {
659 wil_dbg_misc(wil, "Abort scan_request 0x%p\n",
660 wil->scan_request);
Vladimir Kondratiev047e5d72014-05-27 14:45:48 +0300661 del_timer_sync(&wil->scan_timer);
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200662 cfg80211_scan_done(wil->scan_request, true);
663 wil->scan_request = NULL;
664 }
665
Vladimir Kondratieve4dbb092014-09-10 16:34:49 +0300666 wil_mask_irq(wil);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800667
Vladimir Kondratieve08b5902013-01-28 18:31:05 +0200668 wmi_event_flush(wil);
669
Vladimir Kondratiev32772132014-12-23 09:47:03 +0200670 flush_workqueue(wil->wq_service);
Vladimir Kondratieve08b5902013-01-28 18:31:05 +0200671 flush_workqueue(wil->wmi_wq);
672
Vladimir Kondratievbbb2adc2014-08-06 10:31:52 +0300673 rc = wil_target_reset(wil);
Vladimir Kondratiev8bf6adb2014-03-17 15:34:17 +0200674 wil_rx_fini(wil);
Vladimir Kondratievbbb2adc2014-08-06 10:31:52 +0300675 if (rc)
676 return rc;
677
Vladimir Kondratiev151a9702014-09-10 16:34:30 +0300678 if (!no_fw_load) {
679 wil_info(wil, "Use firmware <%s>\n", WIL_FW_NAME);
680 wil_halt_cpu(wil);
681 /* Loading f/w from the file */
682 rc = wil_request_firmware(wil, WIL_FW_NAME);
683 if (rc)
684 return rc;
685
686 /* clear any interrupts which on-card-firmware may have set */
687 wil6210_clear_irq(wil);
688 { /* CAF_ICR - clear and mask */
689 u32 a = HOSTADDR(RGF_CAF_ICR) +
690 offsetof(struct RGF_ICR, ICR);
691 u32 m = HOSTADDR(RGF_CAF_ICR) +
692 offsetof(struct RGF_ICR, IMV);
693 u32 icr = ioread32(wil->csr + a);
694
695 iowrite32(icr, wil->csr + a); /* W1C */
696 iowrite32(~0, wil->csr + m);
697 wmb(); /* wait for completion */
698 }
699 wil_release_cpu(wil);
700 } else {
701 wil_info(wil, "Use firmware from on-card flash\n");
702 }
Vladimir Kondratiev8bf6adb2014-03-17 15:34:17 +0200703
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800704 /* init after reset */
705 wil->pending_connect_cid = -1;
Wolfram Sang16735d02013-11-14 14:32:02 -0800706 reinit_completion(&wil->wmi_ready);
Dedy Lansky59502642014-09-10 16:34:46 +0300707 reinit_completion(&wil->wmi_call);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800708
Vladimir Kondratiev78366f62014-12-23 09:47:19 +0200709 wil_configure_interrupt_moderation(wil);
Vladimir Kondratieve4dbb092014-09-10 16:34:49 +0300710 wil_unmask_irq(wil);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800711
712 /* we just started MAC, wait for FW ready */
713 rc = wil_wait_for_fw_ready(wil);
714
715 return rc;
716}
717
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200718void wil_fw_error_recovery(struct wil6210_priv *wil)
719{
720 wil_dbg_misc(wil, "starting fw error recovery\n");
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300721 wil->recovery_state = fw_recovery_pending;
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200722 schedule_work(&wil->fw_error_worker);
723}
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800724
Vladimir Kondratiev73d839a2014-09-10 16:34:50 +0300725int __wil_up(struct wil6210_priv *wil)
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800726{
727 struct net_device *ndev = wil_to_ndev(wil);
728 struct wireless_dev *wdev = wil->wdev;
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800729 int rc;
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800730
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200731 WARN_ON(!mutex_is_locked(&wil->mutex));
732
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800733 rc = wil_reset(wil);
734 if (rc)
735 return rc;
736
Vladimir Kondratieve31b2562013-06-09 09:12:55 +0300737 /* Rx VRING. After MAC and beacon */
Vladimir Kondratievd3762b42014-12-01 15:35:02 +0200738 rc = wil_rx_init(wil, 1 << rx_ring_order);
Vladimir Kondratieve31b2562013-06-09 09:12:55 +0300739 if (rc)
740 return rc;
741
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800742 switch (wdev->iftype) {
743 case NL80211_IFTYPE_STATION:
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200744 wil_dbg_misc(wil, "type: STATION\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800745 ndev->type = ARPHRD_ETHER;
746 break;
747 case NL80211_IFTYPE_AP:
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200748 wil_dbg_misc(wil, "type: AP\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800749 ndev->type = ARPHRD_ETHER;
750 break;
751 case NL80211_IFTYPE_P2P_CLIENT:
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200752 wil_dbg_misc(wil, "type: P2P_CLIENT\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800753 ndev->type = ARPHRD_ETHER;
754 break;
755 case NL80211_IFTYPE_P2P_GO:
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200756 wil_dbg_misc(wil, "type: P2P_GO\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800757 ndev->type = ARPHRD_ETHER;
758 break;
759 case NL80211_IFTYPE_MONITOR:
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200760 wil_dbg_misc(wil, "type: Monitor\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800761 ndev->type = ARPHRD_IEEE80211_RADIOTAP;
762 /* ARPHRD_IEEE80211 or ARPHRD_IEEE80211_RADIOTAP ? */
763 break;
764 default:
765 return -EOPNOTSUPP;
766 }
767
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800768 /* MAC address - pre-requisite for other commands */
769 wmi_set_mac_address(wil, ndev->dev_addr);
770
Vladimir Kondratiev73d839a2014-09-10 16:34:50 +0300771 wil_dbg_misc(wil, "NAPI enable\n");
Vladimir Kondratieve0287c42013-05-12 14:43:36 +0300772 napi_enable(&wil->napi_rx);
773 napi_enable(&wil->napi_tx);
Vladimir Kondratiev9419b6a2014-12-23 09:47:14 +0200774 set_bit(wil_status_napi_en, wil->status);
Vladimir Kondratieve0287c42013-05-12 14:43:36 +0300775
Vladimir Kondratievf772ebf2014-09-10 16:34:35 +0300776 if (wil->platform_ops.bus_request)
777 wil->platform_ops.bus_request(wil->platform_handle,
778 WIL_MAX_BUS_REQUEST_KBPS);
779
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800780 return 0;
781}
782
783int wil_up(struct wil6210_priv *wil)
784{
785 int rc;
786
Vladimir Kondratiev9cf10d62014-09-10 16:34:36 +0300787 wil_dbg_misc(wil, "%s()\n", __func__);
788
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800789 mutex_lock(&wil->mutex);
790 rc = __wil_up(wil);
791 mutex_unlock(&wil->mutex);
792
793 return rc;
794}
795
Vladimir Kondratiev73d839a2014-09-10 16:34:50 +0300796int __wil_down(struct wil6210_priv *wil)
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800797{
Dedy Lanskyf172b562014-09-10 16:34:38 +0300798 int iter = WAIT_FOR_DISCONNECT_TIMEOUT_MS /
799 WAIT_FOR_DISCONNECT_INTERVAL_MS;
800
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200801 WARN_ON(!mutex_is_locked(&wil->mutex));
802
Vladimir Kondratievf772ebf2014-09-10 16:34:35 +0300803 if (wil->platform_ops.bus_request)
804 wil->platform_ops.bus_request(wil->platform_handle, 0);
805
Vladimir Kondratiev73d839a2014-09-10 16:34:50 +0300806 wil_disable_irq(wil);
Vladimir Kondratiev9419b6a2014-12-23 09:47:14 +0200807 if (test_and_clear_bit(wil_status_napi_en, wil->status)) {
Vladimir Kondratiev73d839a2014-09-10 16:34:50 +0300808 napi_disable(&wil->napi_rx);
809 napi_disable(&wil->napi_tx);
810 wil_dbg_misc(wil, "NAPI disable\n");
811 }
812 wil_enable_irq(wil);
Vladimir Kondratieve0287c42013-05-12 14:43:36 +0300813
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800814 if (wil->scan_request) {
Vladimir Kondratiev2a91d7d2014-06-16 19:37:11 +0300815 wil_dbg_misc(wil, "Abort scan_request 0x%p\n",
816 wil->scan_request);
Vladimir Kondratiev047e5d72014-05-27 14:45:48 +0300817 del_timer_sync(&wil->scan_timer);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800818 cfg80211_scan_done(wil->scan_request, true);
819 wil->scan_request = NULL;
820 }
821
Vladimir Kondratiev9419b6a2014-12-23 09:47:14 +0200822 if (test_bit(wil_status_fwconnected, wil->status) ||
823 test_bit(wil_status_fwconnecting, wil->status))
Dedy Lanskyf172b562014-09-10 16:34:38 +0300824 wmi_send(wil, WMI_DISCONNECT_CMDID, NULL, 0);
825
826 /* make sure wil is idle (not connected) */
827 mutex_unlock(&wil->mutex);
828 while (iter--) {
Vladimir Kondratiev9419b6a2014-12-23 09:47:14 +0200829 int idle = !test_bit(wil_status_fwconnected, wil->status) &&
830 !test_bit(wil_status_fwconnecting, wil->status);
Dedy Lanskyf172b562014-09-10 16:34:38 +0300831 if (idle)
832 break;
833 msleep(WAIT_FOR_DISCONNECT_INTERVAL_MS);
834 }
835 mutex_lock(&wil->mutex);
836
837 if (!iter)
838 wil_err(wil, "timeout waiting for idle FW/HW\n");
839
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800840 wil_rx_fini(wil);
841
842 return 0;
843}
844
845int wil_down(struct wil6210_priv *wil)
846{
847 int rc;
848
Vladimir Kondratiev9cf10d62014-09-10 16:34:36 +0300849 wil_dbg_misc(wil, "%s()\n", __func__);
850
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300851 wil_set_recovery_state(wil, fw_recovery_idle);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800852 mutex_lock(&wil->mutex);
853 rc = __wil_down(wil);
854 mutex_unlock(&wil->mutex);
855
856 return rc;
857}
Vladimir Kondratiev3df2cd362014-02-27 16:20:43 +0200858
859int wil_find_cid(struct wil6210_priv *wil, const u8 *mac)
860{
861 int i;
862 int rc = -ENOENT;
863
864 for (i = 0; i < ARRAY_SIZE(wil->sta); i++) {
865 if ((wil->sta[i].status != wil_sta_unused) &&
Vladimir Kondratiev108d1eb2014-02-27 16:20:53 +0200866 ether_addr_equal(wil->sta[i].addr, mac)) {
Vladimir Kondratiev3df2cd362014-02-27 16:20:43 +0200867 rc = i;
868 break;
869 }
870 }
871
872 return rc;
873}