1 /*
2  * Copyright (c) 2012-2015 Qualcomm Atheros, Inc.
3  *
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 
17 #include <linux/moduleparam.h>
18 #include <linux/if_arp.h>
19 #include <linux/etherdevice.h>
20 
21 #include "wil6210.h"
22 #include "txrx.h"
23 #include "wmi.h"
24 #include "boot_loader.h"
25 
26 #define WAIT_FOR_DISCONNECT_TIMEOUT_MS 2000
27 #define WAIT_FOR_DISCONNECT_INTERVAL_MS 10
28 
29 bool debug_fw; /* = false; */
30 module_param(debug_fw, bool, S_IRUGO);
31 MODULE_PARM_DESC(debug_fw, " do not perform card reset. For FW debug");
32 
33 bool no_fw_recovery;
34 module_param(no_fw_recovery, bool, S_IRUGO | S_IWUSR);
35 MODULE_PARM_DESC(no_fw_recovery, " disable automatic FW error recovery");
36 
37 /* if not set via modparam, will be set to default value of 1/8 of
38  * rx ring size during init flow
39  */
40 unsigned short rx_ring_overflow_thrsh = WIL6210_RX_HIGH_TRSH_INIT;
41 module_param(rx_ring_overflow_thrsh, ushort, S_IRUGO);
42 MODULE_PARM_DESC(rx_ring_overflow_thrsh,
43 		 " RX ring overflow threshold in descriptors.");
44 
45 /* We allow allocation of more than 1 page buffers to support large packets.
46  * It is suboptimal behavior performance wise in case MTU above page size.
47  */
48 unsigned int mtu_max = TXRX_BUF_LEN_DEFAULT - WIL_MAX_MPDU_OVERHEAD;
49 static int mtu_max_set(const char *val, const struct kernel_param *kp)
50 {
51 	int ret;
52 
53 	/* sets mtu_max directly. no need to restore it in case of
54 	 * illegal value since we assume this will fail insmod
55 	 */
56 	ret = param_set_uint(val, kp);
57 	if (ret)
58 		return ret;
59 
60 	if (mtu_max < 68 || mtu_max > WIL_MAX_ETH_MTU)
61 		ret = -EINVAL;
62 
63 	return ret;
64 }
65 
66 static const struct kernel_param_ops mtu_max_ops = {
67 	.set = mtu_max_set,
68 	.get = param_get_uint,
69 };
70 
71 module_param_cb(mtu_max, &mtu_max_ops, &mtu_max, S_IRUGO);
72 MODULE_PARM_DESC(mtu_max, " Max MTU value.");
73 
74 static uint rx_ring_order = WIL_RX_RING_SIZE_ORDER_DEFAULT;
75 static uint tx_ring_order = WIL_TX_RING_SIZE_ORDER_DEFAULT;
76 static uint bcast_ring_order = WIL_BCAST_RING_SIZE_ORDER_DEFAULT;
77 
78 static int ring_order_set(const char *val, const struct kernel_param *kp)
79 {
80 	int ret;
81 	uint x;
82 
83 	ret = kstrtouint(val, 0, &x);
84 	if (ret)
85 		return ret;
86 
87 	if ((x < WIL_RING_SIZE_ORDER_MIN) || (x > WIL_RING_SIZE_ORDER_MAX))
88 		return -EINVAL;
89 
90 	*((uint *)kp->arg) = x;
91 
92 	return 0;
93 }
94 
95 static const struct kernel_param_ops ring_order_ops = {
96 	.set = ring_order_set,
97 	.get = param_get_uint,
98 };
99 
100 module_param_cb(rx_ring_order, &ring_order_ops, &rx_ring_order, S_IRUGO);
101 MODULE_PARM_DESC(rx_ring_order, " Rx ring order; size = 1 << order");
102 module_param_cb(tx_ring_order, &ring_order_ops, &tx_ring_order, S_IRUGO);
103 MODULE_PARM_DESC(tx_ring_order, " Tx ring order; size = 1 << order");
104 module_param_cb(bcast_ring_order, &ring_order_ops, &bcast_ring_order, S_IRUGO);
105 MODULE_PARM_DESC(bcast_ring_order, " Bcast ring order; size = 1 << order");
106 
107 #define RST_DELAY (20) /* msec, for loop in @wil_target_reset */
108 #define RST_COUNT (1 + 1000/RST_DELAY) /* round up to be above 1 sec total */
109 
110 /*
111  * Due to a hardware issue,
112  * one has to read/write to/from NIC in 32-bit chunks;
113  * regular memcpy_fromio and siblings will
114  * not work on 64-bit platform - it uses 64-bit transactions
115  *
116  * Force 32-bit transactions to enable NIC on 64-bit platforms
117  *
118  * To avoid byte swap on big endian host, __raw_{read|write}l
119  * should be used - {read|write}l would swap bytes to provide
120  * little endian on PCI value in host endianness.
121  */
122 void wil_memcpy_fromio_32(void *dst, const volatile void __iomem *src,
123 			  size_t count)
124 {
125 	u32 *d = dst;
126 	const volatile u32 __iomem *s = src;
127 
128 	/* size_t is unsigned, if (count%4 != 0) it will wrap */
129 	for (count += 4; count > 4; count -= 4)
130 		*d++ = __raw_readl(s++);
131 }
132 
133 void wil_memcpy_toio_32(volatile void __iomem *dst, const void *src,
134 			size_t count)
135 {
136 	volatile u32 __iomem *d = dst;
137 	const u32 *s = src;
138 
139 	for (count += 4; count > 4; count -= 4)
140 		__raw_writel(*s++, d++);
141 }
142 
143 static void wil_disconnect_cid(struct wil6210_priv *wil, int cid,
144 			       u16 reason_code, bool from_event)
145 __acquires(&sta->tid_rx_lock) __releases(&sta->tid_rx_lock)
146 {
147 	uint i;
148 	struct net_device *ndev = wil_to_ndev(wil);
149 	struct wireless_dev *wdev = wil->wdev;
150 	struct wil_sta_info *sta = &wil->sta[cid];
151 
152 	might_sleep();
153 	wil_dbg_misc(wil, "%s(CID %d, status %d)\n", __func__, cid,
154 		     sta->status);
155 
156 	if (sta->status != wil_sta_unused) {
157 		if (!from_event)
158 			wmi_disconnect_sta(wil, sta->addr, reason_code);
159 
160 		switch (wdev->iftype) {
161 		case NL80211_IFTYPE_AP:
162 		case NL80211_IFTYPE_P2P_GO:
163 			/* AP-like interface */
164 			cfg80211_del_sta(ndev, sta->addr, GFP_KERNEL);
165 			break;
166 		default:
167 			break;
168 		}
169 		sta->status = wil_sta_unused;
170 	}
171 
172 	for (i = 0; i < WIL_STA_TID_NUM; i++) {
173 		struct wil_tid_ampdu_rx *r;
174 
175 		spin_lock_bh(&sta->tid_rx_lock);
176 
177 		r = sta->tid_rx[i];
178 		sta->tid_rx[i] = NULL;
179 		wil_tid_ampdu_rx_free(wil, r);
180 
181 		spin_unlock_bh(&sta->tid_rx_lock);
182 	}
183 	for (i = 0; i < ARRAY_SIZE(wil->vring_tx); i++) {
184 		if (wil->vring2cid_tid[i][0] == cid)
185 			wil_vring_fini_tx(wil, i);
186 	}
187 	memset(&sta->stats, 0, sizeof(sta->stats));
188 }
189 
190 static void _wil6210_disconnect(struct wil6210_priv *wil, const u8 *bssid,
191 				u16 reason_code, bool from_event)
192 {
193 	int cid = -ENOENT;
194 	struct net_device *ndev = wil_to_ndev(wil);
195 	struct wireless_dev *wdev = wil->wdev;
196 
197 	might_sleep();
198 	wil_dbg_misc(wil, "%s(bssid=%pM, reason=%d, ev%s)\n", __func__, bssid,
199 		     reason_code, from_event ? "+" : "-");
200 
201 	/* Cases are:
202 	 * - disconnect single STA, still connected
203 	 * - disconnect single STA, already disconnected
204 	 * - disconnect all
205 	 *
206 	 * For "disconnect all", there are 2 options:
207 	 * - bssid == NULL
208 	 * - bssid is our MAC address
209 	 */
210 	if (bssid && memcmp(ndev->dev_addr, bssid, ETH_ALEN)) {
211 		cid = wil_find_cid(wil, bssid);
212 		wil_dbg_misc(wil, "Disconnect %pM, CID=%d, reason=%d\n",
213 			     bssid, cid, reason_code);
214 		if (cid >= 0) /* disconnect 1 peer */
215 			wil_disconnect_cid(wil, cid, reason_code, from_event);
216 	} else { /* all */
217 		wil_dbg_misc(wil, "Disconnect all\n");
218 		for (cid = 0; cid < WIL6210_MAX_CID; cid++)
219 			wil_disconnect_cid(wil, cid, reason_code, from_event);
220 	}
221 
222 	/* link state */
223 	switch (wdev->iftype) {
224 	case NL80211_IFTYPE_STATION:
225 	case NL80211_IFTYPE_P2P_CLIENT:
226 		wil_bcast_fini(wil);
227 		netif_tx_stop_all_queues(ndev);
228 		netif_carrier_off(ndev);
229 
230 		if (test_bit(wil_status_fwconnected, wil->status)) {
231 			clear_bit(wil_status_fwconnected, wil->status);
232 			cfg80211_disconnected(ndev, reason_code,
233 					      NULL, 0, false, GFP_KERNEL);
234 		} else if (test_bit(wil_status_fwconnecting, wil->status)) {
235 			cfg80211_connect_result(ndev, bssid, NULL, 0, NULL, 0,
236 						WLAN_STATUS_UNSPECIFIED_FAILURE,
237 						GFP_KERNEL);
238 		}
239 		clear_bit(wil_status_fwconnecting, wil->status);
240 		break;
241 	default:
242 		break;
243 	}
244 }
245 
246 static void wil_disconnect_worker(struct work_struct *work)
247 {
248 	struct wil6210_priv *wil = container_of(work,
249 			struct wil6210_priv, disconnect_worker);
250 
251 	mutex_lock(&wil->mutex);
252 	_wil6210_disconnect(wil, NULL, WLAN_REASON_UNSPECIFIED, false);
253 	mutex_unlock(&wil->mutex);
254 }
255 
256 static void wil_connect_timer_fn(ulong x)
257 {
258 	struct wil6210_priv *wil = (void *)x;
259 
260 	wil_dbg_misc(wil, "Connect timeout\n");
261 
262 	/* reschedule to thread context - disconnect won't
263 	 * run from atomic context
264 	 */
265 	schedule_work(&wil->disconnect_worker);
266 }
267 
268 static void wil_scan_timer_fn(ulong x)
269 {
270 	struct wil6210_priv *wil = (void *)x;
271 
272 	clear_bit(wil_status_fwready, wil->status);
273 	wil_err(wil, "Scan timeout detected, start fw error recovery\n");
274 	wil_fw_error_recovery(wil);
275 }
276 
277 static int wil_wait_for_recovery(struct wil6210_priv *wil)
278 {
279 	if (wait_event_interruptible(wil->wq, wil->recovery_state !=
280 				     fw_recovery_pending)) {
281 		wil_err(wil, "Interrupt, canceling recovery\n");
282 		return -ERESTARTSYS;
283 	}
284 	if (wil->recovery_state != fw_recovery_running) {
285 		wil_info(wil, "Recovery cancelled\n");
286 		return -EINTR;
287 	}
288 	wil_info(wil, "Proceed with recovery\n");
289 	return 0;
290 }
291 
292 void wil_set_recovery_state(struct wil6210_priv *wil, int state)
293 {
294 	wil_dbg_misc(wil, "%s(%d -> %d)\n", __func__,
295 		     wil->recovery_state, state);
296 
297 	wil->recovery_state = state;
298 	wake_up_interruptible(&wil->wq);
299 }
300 
301 static void wil_fw_error_worker(struct work_struct *work)
302 {
303 	struct wil6210_priv *wil = container_of(work, struct wil6210_priv,
304 						fw_error_worker);
305 	struct wireless_dev *wdev = wil->wdev;
306 
307 	wil_dbg_misc(wil, "fw error worker\n");
308 
309 	if (!netif_running(wil_to_ndev(wil))) {
310 		wil_info(wil, "No recovery - interface is down\n");
311 		return;
312 	}
313 
314 	/* increment @recovery_count if less then WIL6210_FW_RECOVERY_TO
315 	 * passed since last recovery attempt
316 	 */
317 	if (time_is_after_jiffies(wil->last_fw_recovery +
318 				  WIL6210_FW_RECOVERY_TO))
319 		wil->recovery_count++;
320 	else
321 		wil->recovery_count = 1; /* fw was alive for a long time */
322 
323 	if (wil->recovery_count > WIL6210_FW_RECOVERY_RETRIES) {
324 		wil_err(wil, "too many recovery attempts (%d), giving up\n",
325 			wil->recovery_count);
326 		return;
327 	}
328 
329 	wil->last_fw_recovery = jiffies;
330 
331 	mutex_lock(&wil->mutex);
332 	switch (wdev->iftype) {
333 	case NL80211_IFTYPE_STATION:
334 	case NL80211_IFTYPE_P2P_CLIENT:
335 	case NL80211_IFTYPE_MONITOR:
336 		wil_info(wil, "fw error recovery requested (try %d)...\n",
337 			 wil->recovery_count);
338 		if (!no_fw_recovery)
339 			wil->recovery_state = fw_recovery_running;
340 		if (0 != wil_wait_for_recovery(wil))
341 			break;
342 
343 		__wil_down(wil);
344 		__wil_up(wil);
345 		break;
346 	case NL80211_IFTYPE_AP:
347 	case NL80211_IFTYPE_P2P_GO:
348 		wil_info(wil, "No recovery for AP-like interface\n");
349 		/* recovery in these modes is done by upper layers */
350 		break;
351 	default:
352 		wil_err(wil, "No recovery - unknown interface type %d\n",
353 			wdev->iftype);
354 		break;
355 	}
356 	mutex_unlock(&wil->mutex);
357 }
358 
359 static int wil_find_free_vring(struct wil6210_priv *wil)
360 {
361 	int i;
362 
363 	for (i = 0; i < WIL6210_MAX_TX_RINGS; i++) {
364 		if (!wil->vring_tx[i].va)
365 			return i;
366 	}
367 	return -EINVAL;
368 }
369 
370 int wil_bcast_init(struct wil6210_priv *wil)
371 {
372 	int ri = wil->bcast_vring, rc;
373 
374 	if ((ri >= 0) && wil->vring_tx[ri].va)
375 		return 0;
376 
377 	ri = wil_find_free_vring(wil);
378 	if (ri < 0)
379 		return ri;
380 
381 	wil->bcast_vring = ri;
382 	rc = wil_vring_init_bcast(wil, ri, 1 << bcast_ring_order);
383 	if (rc)
384 		wil->bcast_vring = -1;
385 
386 	return rc;
387 }
388 
389 void wil_bcast_fini(struct wil6210_priv *wil)
390 {
391 	int ri = wil->bcast_vring;
392 
393 	if (ri < 0)
394 		return;
395 
396 	wil->bcast_vring = -1;
397 	wil_vring_fini_tx(wil, ri);
398 }
399 
400 static void wil_connect_worker(struct work_struct *work)
401 {
402 	int rc;
403 	struct wil6210_priv *wil = container_of(work, struct wil6210_priv,
404 						connect_worker);
405 	struct net_device *ndev = wil_to_ndev(wil);
406 
407 	int cid = wil->pending_connect_cid;
408 	int ringid = wil_find_free_vring(wil);
409 
410 	if (cid < 0) {
411 		wil_err(wil, "No connection pending\n");
412 		return;
413 	}
414 
415 	wil_dbg_wmi(wil, "Configure for connection CID %d\n", cid);
416 
417 	rc = wil_vring_init_tx(wil, ringid, 1 << tx_ring_order, cid, 0);
418 	wil->pending_connect_cid = -1;
419 	if (rc == 0) {
420 		wil->sta[cid].status = wil_sta_connected;
421 		netif_tx_wake_all_queues(ndev);
422 	} else {
423 		wil->sta[cid].status = wil_sta_unused;
424 	}
425 }
426 
427 int wil_priv_init(struct wil6210_priv *wil)
428 {
429 	uint i;
430 
431 	wil_dbg_misc(wil, "%s()\n", __func__);
432 
433 	memset(wil->sta, 0, sizeof(wil->sta));
434 	for (i = 0; i < WIL6210_MAX_CID; i++)
435 		spin_lock_init(&wil->sta[i].tid_rx_lock);
436 
437 	mutex_init(&wil->mutex);
438 	mutex_init(&wil->wmi_mutex);
439 	mutex_init(&wil->back_rx_mutex);
440 	mutex_init(&wil->back_tx_mutex);
441 	mutex_init(&wil->probe_client_mutex);
442 
443 	init_completion(&wil->wmi_ready);
444 	init_completion(&wil->wmi_call);
445 
446 	wil->pending_connect_cid = -1;
447 	wil->bcast_vring = -1;
448 	setup_timer(&wil->connect_timer, wil_connect_timer_fn, (ulong)wil);
449 	setup_timer(&wil->scan_timer, wil_scan_timer_fn, (ulong)wil);
450 
451 	INIT_WORK(&wil->connect_worker, wil_connect_worker);
452 	INIT_WORK(&wil->disconnect_worker, wil_disconnect_worker);
453 	INIT_WORK(&wil->wmi_event_worker, wmi_event_worker);
454 	INIT_WORK(&wil->fw_error_worker, wil_fw_error_worker);
455 	INIT_WORK(&wil->back_rx_worker, wil_back_rx_worker);
456 	INIT_WORK(&wil->back_tx_worker, wil_back_tx_worker);
457 	INIT_WORK(&wil->probe_client_worker, wil_probe_client_worker);
458 
459 	INIT_LIST_HEAD(&wil->pending_wmi_ev);
460 	INIT_LIST_HEAD(&wil->back_rx_pending);
461 	INIT_LIST_HEAD(&wil->back_tx_pending);
462 	INIT_LIST_HEAD(&wil->probe_client_pending);
463 	spin_lock_init(&wil->wmi_ev_lock);
464 	init_waitqueue_head(&wil->wq);
465 
466 	wil->wmi_wq = create_singlethread_workqueue(WIL_NAME "_wmi");
467 	if (!wil->wmi_wq)
468 		return -EAGAIN;
469 
470 	wil->wq_service = create_singlethread_workqueue(WIL_NAME "_service");
471 	if (!wil->wq_service)
472 		goto out_wmi_wq;
473 
474 	wil->last_fw_recovery = jiffies;
475 	wil->tx_interframe_timeout = WIL6210_ITR_TX_INTERFRAME_TIMEOUT_DEFAULT;
476 	wil->rx_interframe_timeout = WIL6210_ITR_RX_INTERFRAME_TIMEOUT_DEFAULT;
477 	wil->tx_max_burst_duration = WIL6210_ITR_TX_MAX_BURST_DURATION_DEFAULT;
478 	wil->rx_max_burst_duration = WIL6210_ITR_RX_MAX_BURST_DURATION_DEFAULT;
479 
480 	if (rx_ring_overflow_thrsh == WIL6210_RX_HIGH_TRSH_INIT)
481 		rx_ring_overflow_thrsh = WIL6210_RX_HIGH_TRSH_DEFAULT;
482 	return 0;
483 
484 out_wmi_wq:
485 	destroy_workqueue(wil->wmi_wq);
486 
487 	return -EAGAIN;
488 }
489 
490 /**
491  * wil6210_disconnect - disconnect one connection
492  * @wil: driver context
493  * @bssid: peer to disconnect, NULL to disconnect all
494  * @reason_code: Reason code for the Disassociation frame
495  * @from_event: whether is invoked from FW event handler
496  *
497  * Disconnect and release associated resources. If invoked not from the
498  * FW event handler, issue WMI command(s) to trigger MAC disconnect.
499  */
500 void wil6210_disconnect(struct wil6210_priv *wil, const u8 *bssid,
501 			u16 reason_code, bool from_event)
502 {
503 	wil_dbg_misc(wil, "%s()\n", __func__);
504 
505 	del_timer_sync(&wil->connect_timer);
506 	_wil6210_disconnect(wil, bssid, reason_code, from_event);
507 }
508 
509 void wil_priv_deinit(struct wil6210_priv *wil)
510 {
511 	wil_dbg_misc(wil, "%s()\n", __func__);
512 
513 	wil_set_recovery_state(wil, fw_recovery_idle);
514 	del_timer_sync(&wil->scan_timer);
515 	cancel_work_sync(&wil->disconnect_worker);
516 	cancel_work_sync(&wil->fw_error_worker);
517 	mutex_lock(&wil->mutex);
518 	wil6210_disconnect(wil, NULL, WLAN_REASON_DEAUTH_LEAVING, false);
519 	mutex_unlock(&wil->mutex);
520 	wmi_event_flush(wil);
521 	wil_back_rx_flush(wil);
522 	cancel_work_sync(&wil->back_rx_worker);
523 	wil_back_tx_flush(wil);
524 	cancel_work_sync(&wil->back_tx_worker);
525 	wil_probe_client_flush(wil);
526 	cancel_work_sync(&wil->probe_client_worker);
527 	destroy_workqueue(wil->wq_service);
528 	destroy_workqueue(wil->wmi_wq);
529 }
530 
531 /* target operations */
532 /* register read */
533 #define R(a) ioread32(wil->csr + HOSTADDR(a))
534 /* register write. wmb() to make sure it is completed */
535 #define W(a, v) do { iowrite32(v, wil->csr + HOSTADDR(a)); wmb(); } while (0)
536 /* register set = read, OR, write */
537 #define S(a, v) W(a, R(a) | v)
538 /* register clear = read, AND with inverted, write */
539 #define C(a, v) W(a, R(a) & ~v)
540 
541 static inline void wil_halt_cpu(struct wil6210_priv *wil)
542 {
543 	W(RGF_USER_USER_CPU_0, BIT_USER_USER_CPU_MAN_RST);
544 	W(RGF_USER_MAC_CPU_0,  BIT_USER_MAC_CPU_MAN_RST);
545 }
546 
547 static inline void wil_release_cpu(struct wil6210_priv *wil)
548 {
549 	/* Start CPU */
550 	W(RGF_USER_USER_CPU_0, 1);
551 }
552 
553 static int wil_target_reset(struct wil6210_priv *wil)
554 {
555 	int delay = 0;
556 	u32 x, x1 = 0;
557 
558 	wil_dbg_misc(wil, "Resetting \"%s\"...\n", wil->hw_name);
559 
560 	/* Clear MAC link up */
561 	S(RGF_HP_CTRL, BIT(15));
562 	S(RGF_USER_CLKS_CTL_SW_RST_MASK_0, BIT_HPAL_PERST_FROM_PAD);
563 	S(RGF_USER_CLKS_CTL_SW_RST_MASK_0, BIT_CAR_PERST_RST);
564 
565 	wil_halt_cpu(wil);
566 
567 	/* clear all boot loader "ready" bits */
568 	W(RGF_USER_BL +
569 	  offsetof(struct bl_dedicated_registers_v0, boot_loader_ready), 0);
570 	/* Clear Fw Download notification */
571 	C(RGF_USER_USAGE_6, BIT(0));
572 
573 	S(RGF_CAF_OSC_CONTROL, BIT_CAF_OSC_XTAL_EN);
574 	/* XTAL stabilization should take about 3ms */
575 	usleep_range(5000, 7000);
576 	x = R(RGF_CAF_PLL_LOCK_STATUS);
577 	if (!(x & BIT_CAF_OSC_DIG_XTAL_STABLE)) {
578 		wil_err(wil, "Xtal stabilization timeout\n"
579 			"RGF_CAF_PLL_LOCK_STATUS = 0x%08x\n", x);
580 		return -ETIME;
581 	}
582 	/* switch 10k to XTAL*/
583 	C(RGF_USER_SPARROW_M_4, BIT_SPARROW_M_4_SEL_SLEEP_OR_REF);
584 	/* 40 MHz */
585 	C(RGF_USER_CLKS_CTL_0, BIT_USER_CLKS_CAR_AHB_SW_SEL);
586 
587 	W(RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_0, 0x3ff81f);
588 	W(RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_1, 0xf);
589 
590 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0xFE000000);
591 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_1, 0x0000003F);
592 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0x000000f0);
593 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0xFFE7FE00);
594 
595 	W(RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_0, 0x0);
596 	W(RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_1, 0x0);
597 
598 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0);
599 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0);
600 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_1, 0);
601 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0);
602 
603 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0x00000003);
604 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0x00008000); /* reset A2 PCIE AHB */
605 
606 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0);
607 
608 	/* wait until device ready. typical time is 20..80 msec */
609 	do {
610 		msleep(RST_DELAY);
611 		x = R(RGF_USER_BL + offsetof(struct bl_dedicated_registers_v0,
612 					     boot_loader_ready));
613 		if (x1 != x) {
614 			wil_dbg_misc(wil, "BL.ready 0x%08x => 0x%08x\n", x1, x);
615 			x1 = x;
616 		}
617 		if (delay++ > RST_COUNT) {
618 			wil_err(wil, "Reset not completed, bl.ready 0x%08x\n",
619 				x);
620 			return -ETIME;
621 		}
622 	} while (x != BL_READY);
623 
624 	C(RGF_USER_CLKS_CTL_0, BIT_USER_CLKS_RST_PWGD);
625 
626 	/* enable fix for HW bug related to the SA/DA swap in AP Rx */
627 	S(RGF_DMA_OFUL_NID_0, BIT_DMA_OFUL_NID_0_RX_EXT_TR_EN |
628 	  BIT_DMA_OFUL_NID_0_RX_EXT_A3_SRC);
629 
630 	wil_dbg_misc(wil, "Reset completed in %d ms\n", delay * RST_DELAY);
631 	return 0;
632 }
633 
634 void wil_mbox_ring_le2cpus(struct wil6210_mbox_ring *r)
635 {
636 	le32_to_cpus(&r->base);
637 	le16_to_cpus(&r->entry_size);
638 	le16_to_cpus(&r->size);
639 	le32_to_cpus(&r->tail);
640 	le32_to_cpus(&r->head);
641 }
642 
643 static int wil_get_bl_info(struct wil6210_priv *wil)
644 {
645 	struct net_device *ndev = wil_to_ndev(wil);
646 	union {
647 		struct bl_dedicated_registers_v0 bl0;
648 		struct bl_dedicated_registers_v1 bl1;
649 	} bl;
650 	u32 bl_ver;
651 	u8 *mac;
652 	u16 rf_status;
653 
654 	bl_ver = R(RGF_USER_BL + offsetof(struct bl_dedicated_registers_v0,
655 					  boot_loader_struct_version));
656 	switch (bl_ver) {
657 	case 0:
658 		wil_memcpy_fromio_32(&bl, wil->csr + HOSTADDR(RGF_USER_BL),
659 				     sizeof(bl.bl0));
660 		le32_to_cpus(&bl.bl0.boot_loader_ready);
661 		le32_to_cpus(&bl.bl0.boot_loader_struct_version);
662 		le32_to_cpus(&bl.bl0.rf_type);
663 		le32_to_cpus(&bl.bl0.baseband_type);
664 		mac = bl.bl0.mac_address;
665 		rf_status = 0; /* actually, unknown */
666 		wil_info(wil,
667 			 "Boot Loader struct v%d: MAC = %pM RF = 0x%08x bband = 0x%08x\n",
668 			 bl_ver, mac,
669 			 bl.bl0.rf_type, bl.bl0.baseband_type);
670 		wil_info(wil, "Boot Loader build unknown for struct v0\n");
671 		break;
672 	case 1:
673 		wil_memcpy_fromio_32(&bl, wil->csr + HOSTADDR(RGF_USER_BL),
674 				     sizeof(bl.bl1));
675 		le32_to_cpus(&bl.bl1.boot_loader_ready);
676 		le32_to_cpus(&bl.bl1.boot_loader_struct_version);
677 		le16_to_cpus(&bl.bl1.rf_type);
678 		rf_status = le16_to_cpu(bl.bl1.rf_status);
679 		le32_to_cpus(&bl.bl1.baseband_type);
680 		le16_to_cpus(&bl.bl1.bl_version_subminor);
681 		le16_to_cpus(&bl.bl1.bl_version_build);
682 		mac = bl.bl1.mac_address;
683 		wil_info(wil,
684 			 "Boot Loader struct v%d: MAC = %pM RF = 0x%04x (status 0x%04x) bband = 0x%08x\n",
685 			 bl_ver, mac,
686 			 bl.bl1.rf_type, rf_status,
687 			 bl.bl1.baseband_type);
688 		wil_info(wil, "Boot Loader build %d.%d.%d.%d\n",
689 			 bl.bl1.bl_version_major, bl.bl1.bl_version_minor,
690 			 bl.bl1.bl_version_subminor, bl.bl1.bl_version_build);
691 		break;
692 	default:
693 		wil_err(wil, "BL: unsupported struct version 0x%08x\n", bl_ver);
694 		return -EINVAL;
695 	}
696 
697 	if (!is_valid_ether_addr(mac)) {
698 		wil_err(wil, "BL: Invalid MAC %pM\n", mac);
699 		return -EINVAL;
700 	}
701 
702 	ether_addr_copy(ndev->perm_addr, mac);
703 	if (!is_valid_ether_addr(ndev->dev_addr))
704 		ether_addr_copy(ndev->dev_addr, mac);
705 
706 	if (rf_status) {/* bad RF cable? */
707 		wil_err(wil, "RF communication error 0x%04x",
708 			rf_status);
709 		return -EAGAIN;
710 	}
711 
712 	return 0;
713 }
714 
715 static int wil_wait_for_fw_ready(struct wil6210_priv *wil)
716 {
717 	ulong to = msecs_to_jiffies(1000);
718 	ulong left = wait_for_completion_timeout(&wil->wmi_ready, to);
719 
720 	if (0 == left) {
721 		wil_err(wil, "Firmware not ready\n");
722 		return -ETIME;
723 	} else {
724 		wil_info(wil, "FW ready after %d ms. HW version 0x%08x\n",
725 			 jiffies_to_msecs(to-left), wil->hw_version);
726 	}
727 	return 0;
728 }
729 
730 /*
731  * We reset all the structures, and we reset the UMAC.
732  * After calling this routine, you're expected to reload
733  * the firmware.
734  */
735 int wil_reset(struct wil6210_priv *wil, bool load_fw)
736 {
737 	int rc;
738 
739 	wil_dbg_misc(wil, "%s()\n", __func__);
740 
741 	if (wil->hw_version == HW_VER_UNKNOWN)
742 		return -ENODEV;
743 
744 	WARN_ON(!mutex_is_locked(&wil->mutex));
745 	WARN_ON(test_bit(wil_status_napi_en, wil->status));
746 
747 	if (debug_fw) {
748 		static const u8 mac[ETH_ALEN] = {
749 			0x00, 0xde, 0xad, 0x12, 0x34, 0x56,
750 		};
751 		struct net_device *ndev = wil_to_ndev(wil);
752 
753 		ether_addr_copy(ndev->perm_addr, mac);
754 		ether_addr_copy(ndev->dev_addr, ndev->perm_addr);
755 		return 0;
756 	}
757 
758 	cancel_work_sync(&wil->disconnect_worker);
759 	wil6210_disconnect(wil, NULL, WLAN_REASON_DEAUTH_LEAVING, false);
760 	wil_bcast_fini(wil);
761 
762 	/* prevent NAPI from being scheduled */
763 	bitmap_zero(wil->status, wil_status_last);
764 
765 	if (wil->scan_request) {
766 		wil_dbg_misc(wil, "Abort scan_request 0x%p\n",
767 			     wil->scan_request);
768 		del_timer_sync(&wil->scan_timer);
769 		cfg80211_scan_done(wil->scan_request, true);
770 		wil->scan_request = NULL;
771 	}
772 
773 	wil_mask_irq(wil);
774 
775 	wmi_event_flush(wil);
776 
777 	flush_workqueue(wil->wq_service);
778 	flush_workqueue(wil->wmi_wq);
779 
780 	rc = wil_target_reset(wil);
781 	wil_rx_fini(wil);
782 	if (rc)
783 		return rc;
784 
785 	rc = wil_get_bl_info(wil);
786 	if (rc == -EAGAIN && !load_fw) /* ignore RF error if not going up */
787 		rc = 0;
788 	if (rc)
789 		return rc;
790 
791 	if (load_fw) {
792 		wil_info(wil, "Use firmware <%s> + board <%s>\n", WIL_FW_NAME,
793 			 WIL_FW2_NAME);
794 
795 		wil_halt_cpu(wil);
796 		/* Loading f/w from the file */
797 		rc = wil_request_firmware(wil, WIL_FW_NAME);
798 		if (rc)
799 			return rc;
800 		rc = wil_request_firmware(wil, WIL_FW2_NAME);
801 		if (rc)
802 			return rc;
803 
804 		/* Mark FW as loaded from host */
805 		S(RGF_USER_USAGE_6, 1);
806 
807 		/* clear any interrupts which on-card-firmware
808 		 * may have set
809 		 */
810 		wil6210_clear_irq(wil);
811 		/* CAF_ICR - clear and mask */
812 		/* it is W1C, clear by writing back same value */
813 		S(RGF_CAF_ICR + offsetof(struct RGF_ICR, ICR), 0);
814 		W(RGF_CAF_ICR + offsetof(struct RGF_ICR, IMV), ~0);
815 
816 		wil_release_cpu(wil);
817 	}
818 
819 	/* init after reset */
820 	wil->pending_connect_cid = -1;
821 	wil->ap_isolate = 0;
822 	reinit_completion(&wil->wmi_ready);
823 	reinit_completion(&wil->wmi_call);
824 
825 	if (load_fw) {
826 		wil_configure_interrupt_moderation(wil);
827 		wil_unmask_irq(wil);
828 
829 		/* we just started MAC, wait for FW ready */
830 		rc = wil_wait_for_fw_ready(wil);
831 		if (rc == 0) /* check FW is responsive */
832 			rc = wmi_echo(wil);
833 	}
834 
835 	return rc;
836 }
837 
838 #undef R
839 #undef W
840 #undef S
841 #undef C
842 
843 void wil_fw_error_recovery(struct wil6210_priv *wil)
844 {
845 	wil_dbg_misc(wil, "starting fw error recovery\n");
846 	wil->recovery_state = fw_recovery_pending;
847 	schedule_work(&wil->fw_error_worker);
848 }
849 
850 int __wil_up(struct wil6210_priv *wil)
851 {
852 	struct net_device *ndev = wil_to_ndev(wil);
853 	struct wireless_dev *wdev = wil->wdev;
854 	int rc;
855 
856 	WARN_ON(!mutex_is_locked(&wil->mutex));
857 
858 	rc = wil_reset(wil, true);
859 	if (rc)
860 		return rc;
861 
862 	/* Rx VRING. After MAC and beacon */
863 	rc = wil_rx_init(wil, 1 << rx_ring_order);
864 	if (rc)
865 		return rc;
866 
867 	switch (wdev->iftype) {
868 	case NL80211_IFTYPE_STATION:
869 		wil_dbg_misc(wil, "type: STATION\n");
870 		ndev->type = ARPHRD_ETHER;
871 		break;
872 	case NL80211_IFTYPE_AP:
873 		wil_dbg_misc(wil, "type: AP\n");
874 		ndev->type = ARPHRD_ETHER;
875 		break;
876 	case NL80211_IFTYPE_P2P_CLIENT:
877 		wil_dbg_misc(wil, "type: P2P_CLIENT\n");
878 		ndev->type = ARPHRD_ETHER;
879 		break;
880 	case NL80211_IFTYPE_P2P_GO:
881 		wil_dbg_misc(wil, "type: P2P_GO\n");
882 		ndev->type = ARPHRD_ETHER;
883 		break;
884 	case NL80211_IFTYPE_MONITOR:
885 		wil_dbg_misc(wil, "type: Monitor\n");
886 		ndev->type = ARPHRD_IEEE80211_RADIOTAP;
887 		/* ARPHRD_IEEE80211 or ARPHRD_IEEE80211_RADIOTAP ? */
888 		break;
889 	default:
890 		return -EOPNOTSUPP;
891 	}
892 
893 	/* MAC address - pre-requisite for other commands */
894 	wmi_set_mac_address(wil, ndev->dev_addr);
895 
896 	wil_dbg_misc(wil, "NAPI enable\n");
897 	napi_enable(&wil->napi_rx);
898 	napi_enable(&wil->napi_tx);
899 	set_bit(wil_status_napi_en, wil->status);
900 
901 	if (wil->platform_ops.bus_request)
902 		wil->platform_ops.bus_request(wil->platform_handle,
903 					      WIL_MAX_BUS_REQUEST_KBPS);
904 
905 	return 0;
906 }
907 
908 int wil_up(struct wil6210_priv *wil)
909 {
910 	int rc;
911 
912 	wil_dbg_misc(wil, "%s()\n", __func__);
913 
914 	mutex_lock(&wil->mutex);
915 	rc = __wil_up(wil);
916 	mutex_unlock(&wil->mutex);
917 
918 	return rc;
919 }
920 
921 int __wil_down(struct wil6210_priv *wil)
922 {
923 	int iter = WAIT_FOR_DISCONNECT_TIMEOUT_MS /
924 			WAIT_FOR_DISCONNECT_INTERVAL_MS;
925 
926 	WARN_ON(!mutex_is_locked(&wil->mutex));
927 
928 	if (wil->platform_ops.bus_request)
929 		wil->platform_ops.bus_request(wil->platform_handle, 0);
930 
931 	wil_disable_irq(wil);
932 	if (test_and_clear_bit(wil_status_napi_en, wil->status)) {
933 		napi_disable(&wil->napi_rx);
934 		napi_disable(&wil->napi_tx);
935 		wil_dbg_misc(wil, "NAPI disable\n");
936 	}
937 	wil_enable_irq(wil);
938 
939 	if (wil->scan_request) {
940 		wil_dbg_misc(wil, "Abort scan_request 0x%p\n",
941 			     wil->scan_request);
942 		del_timer_sync(&wil->scan_timer);
943 		cfg80211_scan_done(wil->scan_request, true);
944 		wil->scan_request = NULL;
945 	}
946 
947 	if (test_bit(wil_status_fwconnected, wil->status) ||
948 	    test_bit(wil_status_fwconnecting, wil->status))
949 		wmi_send(wil, WMI_DISCONNECT_CMDID, NULL, 0);
950 
951 	/* make sure wil is idle (not connected) */
952 	mutex_unlock(&wil->mutex);
953 	while (iter--) {
954 		int idle = !test_bit(wil_status_fwconnected, wil->status) &&
955 			   !test_bit(wil_status_fwconnecting, wil->status);
956 		if (idle)
957 			break;
958 		msleep(WAIT_FOR_DISCONNECT_INTERVAL_MS);
959 	}
960 	mutex_lock(&wil->mutex);
961 
962 	if (!iter)
963 		wil_err(wil, "timeout waiting for idle FW/HW\n");
964 
965 	wil_reset(wil, false);
966 
967 	return 0;
968 }
969 
970 int wil_down(struct wil6210_priv *wil)
971 {
972 	int rc;
973 
974 	wil_dbg_misc(wil, "%s()\n", __func__);
975 
976 	wil_set_recovery_state(wil, fw_recovery_idle);
977 	mutex_lock(&wil->mutex);
978 	rc = __wil_down(wil);
979 	mutex_unlock(&wil->mutex);
980 
981 	return rc;
982 }
983 
984 int wil_find_cid(struct wil6210_priv *wil, const u8 *mac)
985 {
986 	int i;
987 	int rc = -ENOENT;
988 
989 	for (i = 0; i < ARRAY_SIZE(wil->sta); i++) {
990 		if ((wil->sta[i].status != wil_sta_unused) &&
991 		    ether_addr_equal(wil->sta[i].addr, mac)) {
992 			rc = i;
993 			break;
994 		}
995 	}
996 
997 	return rc;
998 }
999