2 * Copyright (c) 2012-2017 Qualcomm Atheros, Inc.
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.
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.
17 #include <linux/moduleparam.h>
18 #include <linux/if_arp.h>
19 #include <linux/etherdevice.h>
24 #include "boot_loader.h"
26 #define WAIT_FOR_HALP_VOTE_MS 100
27 #define WAIT_FOR_SCAN_ABORT_MS 1000
29 bool debug_fw
; /* = false; */
30 module_param(debug_fw
, bool, 0444);
31 MODULE_PARM_DESC(debug_fw
, " do not perform card reset. For FW debug");
34 module_param(oob_mode
, byte
, 0444);
35 MODULE_PARM_DESC(oob_mode
,
36 " enable out of the box (OOB) mode in FW, for diagnostics and certification");
39 module_param(no_fw_recovery
, bool, 0644);
40 MODULE_PARM_DESC(no_fw_recovery
, " disable automatic FW error recovery");
42 /* if not set via modparam, will be set to default value of 1/8 of
43 * rx ring size during init flow
45 unsigned short rx_ring_overflow_thrsh
= WIL6210_RX_HIGH_TRSH_INIT
;
46 module_param(rx_ring_overflow_thrsh
, ushort
, 0444);
47 MODULE_PARM_DESC(rx_ring_overflow_thrsh
,
48 " RX ring overflow threshold in descriptors.");
50 /* We allow allocation of more than 1 page buffers to support large packets.
51 * It is suboptimal behavior performance wise in case MTU above page size.
53 unsigned int mtu_max
= TXRX_BUF_LEN_DEFAULT
- WIL_MAX_MPDU_OVERHEAD
;
54 static int mtu_max_set(const char *val
, const struct kernel_param
*kp
)
58 /* sets mtu_max directly. no need to restore it in case of
59 * illegal value since we assume this will fail insmod
61 ret
= param_set_uint(val
, kp
);
65 if (mtu_max
< 68 || mtu_max
> WIL_MAX_ETH_MTU
)
71 static const struct kernel_param_ops mtu_max_ops
= {
73 .get
= param_get_uint
,
76 module_param_cb(mtu_max
, &mtu_max_ops
, &mtu_max
, 0444);
77 MODULE_PARM_DESC(mtu_max
, " Max MTU value.");
79 static uint rx_ring_order
= WIL_RX_RING_SIZE_ORDER_DEFAULT
;
80 static uint tx_ring_order
= WIL_TX_RING_SIZE_ORDER_DEFAULT
;
81 static uint bcast_ring_order
= WIL_BCAST_RING_SIZE_ORDER_DEFAULT
;
83 static int ring_order_set(const char *val
, const struct kernel_param
*kp
)
88 ret
= kstrtouint(val
, 0, &x
);
92 if ((x
< WIL_RING_SIZE_ORDER_MIN
) || (x
> WIL_RING_SIZE_ORDER_MAX
))
95 *((uint
*)kp
->arg
) = x
;
100 static const struct kernel_param_ops ring_order_ops
= {
101 .set
= ring_order_set
,
102 .get
= param_get_uint
,
105 module_param_cb(rx_ring_order
, &ring_order_ops
, &rx_ring_order
, 0444);
106 MODULE_PARM_DESC(rx_ring_order
, " Rx ring order; size = 1 << order");
107 module_param_cb(tx_ring_order
, &ring_order_ops
, &tx_ring_order
, 0444);
108 MODULE_PARM_DESC(tx_ring_order
, " Tx ring order; size = 1 << order");
109 module_param_cb(bcast_ring_order
, &ring_order_ops
, &bcast_ring_order
, 0444);
110 MODULE_PARM_DESC(bcast_ring_order
, " Bcast ring order; size = 1 << order");
112 #define RST_DELAY (20) /* msec, for loop in @wil_target_reset */
113 #define RST_COUNT (1 + 1000/RST_DELAY) /* round up to be above 1 sec total */
116 * Due to a hardware issue,
117 * one has to read/write to/from NIC in 32-bit chunks;
118 * regular memcpy_fromio and siblings will
119 * not work on 64-bit platform - it uses 64-bit transactions
121 * Force 32-bit transactions to enable NIC on 64-bit platforms
123 * To avoid byte swap on big endian host, __raw_{read|write}l
124 * should be used - {read|write}l would swap bytes to provide
125 * little endian on PCI value in host endianness.
127 void wil_memcpy_fromio_32(void *dst
, const volatile void __iomem
*src
,
131 const volatile u32 __iomem
*s
= src
;
133 for (; count
>= 4; count
-= 4)
134 *d
++ = __raw_readl(s
++);
136 if (unlikely(count
)) {
137 /* count can be 1..3 */
138 u32 tmp
= __raw_readl(s
);
140 memcpy(d
, &tmp
, count
);
144 void wil_memcpy_toio_32(volatile void __iomem
*dst
, const void *src
,
147 volatile u32 __iomem
*d
= dst
;
150 for (; count
>= 4; count
-= 4)
151 __raw_writel(*s
++, d
++);
153 if (unlikely(count
)) {
154 /* count can be 1..3 */
157 memcpy(&tmp
, s
, count
);
158 __raw_writel(tmp
, d
);
162 static void wil_disconnect_cid(struct wil6210_priv
*wil
, int cid
,
163 u16 reason_code
, bool from_event
)
164 __acquires(&sta
->tid_rx_lock
) __releases(&sta
->tid_rx_lock
)
167 struct net_device
*ndev
= wil_to_ndev(wil
);
168 struct wireless_dev
*wdev
= wil
->wdev
;
169 struct wil_sta_info
*sta
= &wil
->sta
[cid
];
172 wil_dbg_misc(wil
, "disconnect_cid: CID %d, status %d\n",
174 /* inform upper/lower layers */
175 if (sta
->status
!= wil_sta_unused
) {
177 bool del_sta
= (wdev
->iftype
== NL80211_IFTYPE_AP
) ?
178 disable_ap_sme
: false;
179 wmi_disconnect_sta(wil
, sta
->addr
, reason_code
,
183 switch (wdev
->iftype
) {
184 case NL80211_IFTYPE_AP
:
185 case NL80211_IFTYPE_P2P_GO
:
186 /* AP-like interface */
187 cfg80211_del_sta(ndev
, sta
->addr
, GFP_KERNEL
);
192 sta
->status
= wil_sta_unused
;
194 /* reorder buffers */
195 for (i
= 0; i
< WIL_STA_TID_NUM
; i
++) {
196 struct wil_tid_ampdu_rx
*r
;
198 spin_lock_bh(&sta
->tid_rx_lock
);
201 sta
->tid_rx
[i
] = NULL
;
202 wil_tid_ampdu_rx_free(wil
, r
);
204 spin_unlock_bh(&sta
->tid_rx_lock
);
207 memset(sta
->tid_crypto_rx
, 0, sizeof(sta
->tid_crypto_rx
));
208 memset(&sta
->group_crypto_rx
, 0, sizeof(sta
->group_crypto_rx
));
210 for (i
= 0; i
< ARRAY_SIZE(wil
->vring_tx
); i
++) {
211 if (wil
->vring2cid_tid
[i
][0] == cid
)
212 wil_vring_fini_tx(wil
, i
);
215 memset(&sta
->stats
, 0, sizeof(sta
->stats
));
218 static bool wil_is_connected(struct wil6210_priv
*wil
)
222 for (i
= 0; i
< ARRAY_SIZE(wil
->sta
); i
++) {
223 if (wil
->sta
[i
].status
== wil_sta_connected
)
230 static void _wil6210_disconnect(struct wil6210_priv
*wil
, const u8
*bssid
,
231 u16 reason_code
, bool from_event
)
234 struct net_device
*ndev
= wil_to_ndev(wil
);
235 struct wireless_dev
*wdev
= wil
->wdev
;
241 wil_info(wil
, "bssid=%pM, reason=%d, ev%s\n", bssid
,
242 reason_code
, from_event
? "+" : "-");
245 * - disconnect single STA, still connected
246 * - disconnect single STA, already disconnected
249 * For "disconnect all", there are 3 options:
251 * - bssid is broadcast address (ff:ff:ff:ff:ff:ff)
252 * - bssid is our MAC address
254 if (bssid
&& !is_broadcast_ether_addr(bssid
) &&
255 !ether_addr_equal_unaligned(ndev
->dev_addr
, bssid
)) {
256 cid
= wil_find_cid(wil
, bssid
);
257 wil_dbg_misc(wil
, "Disconnect %pM, CID=%d, reason=%d\n",
258 bssid
, cid
, reason_code
);
259 if (cid
>= 0) /* disconnect 1 peer */
260 wil_disconnect_cid(wil
, cid
, reason_code
, from_event
);
262 wil_dbg_misc(wil
, "Disconnect all\n");
263 for (cid
= 0; cid
< WIL6210_MAX_CID
; cid
++)
264 wil_disconnect_cid(wil
, cid
, reason_code
, from_event
);
268 switch (wdev
->iftype
) {
269 case NL80211_IFTYPE_STATION
:
270 case NL80211_IFTYPE_P2P_CLIENT
:
272 wil_update_net_queues_bh(wil
, NULL
, true);
273 netif_carrier_off(ndev
);
274 wil6210_bus_request(wil
, WIL_DEFAULT_BUS_REQUEST_KBPS
);
276 if (test_bit(wil_status_fwconnected
, wil
->status
)) {
277 clear_bit(wil_status_fwconnected
, wil
->status
);
278 cfg80211_disconnected(ndev
, reason_code
,
280 wil
->locally_generated_disc
,
282 wil
->locally_generated_disc
= false;
283 } else if (test_bit(wil_status_fwconnecting
, wil
->status
)) {
284 cfg80211_connect_result(ndev
, bssid
, NULL
, 0, NULL
, 0,
285 WLAN_STATUS_UNSPECIFIED_FAILURE
,
289 clear_bit(wil_status_fwconnecting
, wil
->status
);
291 case NL80211_IFTYPE_AP
:
292 case NL80211_IFTYPE_P2P_GO
:
293 if (!wil_is_connected(wil
)) {
294 wil_update_net_queues_bh(wil
, NULL
, true);
295 clear_bit(wil_status_fwconnected
, wil
->status
);
297 wil_update_net_queues_bh(wil
, NULL
, false);
305 static void wil_disconnect_worker(struct work_struct
*work
)
307 struct wil6210_priv
*wil
= container_of(work
,
308 struct wil6210_priv
, disconnect_worker
);
309 struct net_device
*ndev
= wil_to_ndev(wil
);
312 struct wmi_cmd_hdr wmi
;
313 struct wmi_disconnect_event evt
;
316 if (test_bit(wil_status_fwconnected
, wil
->status
))
317 /* connect succeeded after all */
320 if (!test_bit(wil_status_fwconnecting
, wil
->status
))
321 /* already disconnected */
324 rc
= wmi_call(wil
, WMI_DISCONNECT_CMDID
, NULL
, 0,
325 WMI_DISCONNECT_EVENTID
, &reply
, sizeof(reply
),
326 WIL6210_DISCONNECT_TO_MS
);
328 wil_err(wil
, "disconnect error %d\n", rc
);
332 wil_update_net_queues_bh(wil
, NULL
, true);
333 netif_carrier_off(ndev
);
334 cfg80211_connect_result(ndev
, NULL
, NULL
, 0, NULL
, 0,
335 WLAN_STATUS_UNSPECIFIED_FAILURE
, GFP_KERNEL
);
336 clear_bit(wil_status_fwconnecting
, wil
->status
);
339 static void wil_connect_timer_fn(ulong x
)
341 struct wil6210_priv
*wil
= (void *)x
;
344 wil_err(wil
, "Connect timeout detected, disconnect station\n");
346 /* reschedule to thread context - disconnect won't
347 * run from atomic context.
348 * queue on wmi_wq to prevent race with connect event.
350 q
= queue_work(wil
->wmi_wq
, &wil
->disconnect_worker
);
351 wil_dbg_wmi(wil
, "queue_work of disconnect_worker -> %d\n", q
);
354 static void wil_scan_timer_fn(ulong x
)
356 struct wil6210_priv
*wil
= (void *)x
;
358 clear_bit(wil_status_fwready
, wil
->status
);
359 wil_err(wil
, "Scan timeout detected, start fw error recovery\n");
360 wil_fw_error_recovery(wil
);
363 static int wil_wait_for_recovery(struct wil6210_priv
*wil
)
365 if (wait_event_interruptible(wil
->wq
, wil
->recovery_state
!=
366 fw_recovery_pending
)) {
367 wil_err(wil
, "Interrupt, canceling recovery\n");
370 if (wil
->recovery_state
!= fw_recovery_running
) {
371 wil_info(wil
, "Recovery cancelled\n");
374 wil_info(wil
, "Proceed with recovery\n");
378 void wil_set_recovery_state(struct wil6210_priv
*wil
, int state
)
380 wil_dbg_misc(wil
, "set_recovery_state: %d -> %d\n",
381 wil
->recovery_state
, state
);
383 wil
->recovery_state
= state
;
384 wake_up_interruptible(&wil
->wq
);
387 bool wil_is_recovery_blocked(struct wil6210_priv
*wil
)
389 return no_fw_recovery
&& (wil
->recovery_state
== fw_recovery_pending
);
392 static void wil_fw_error_worker(struct work_struct
*work
)
394 struct wil6210_priv
*wil
= container_of(work
, struct wil6210_priv
,
396 struct wireless_dev
*wdev
= wil
->wdev
;
397 struct net_device
*ndev
= wil_to_ndev(wil
);
399 wil_dbg_misc(wil
, "fw error worker\n");
401 if (!(ndev
->flags
& IFF_UP
)) {
402 wil_info(wil
, "No recovery - interface is down\n");
406 /* increment @recovery_count if less then WIL6210_FW_RECOVERY_TO
407 * passed since last recovery attempt
409 if (time_is_after_jiffies(wil
->last_fw_recovery
+
410 WIL6210_FW_RECOVERY_TO
))
411 wil
->recovery_count
++;
413 wil
->recovery_count
= 1; /* fw was alive for a long time */
415 if (wil
->recovery_count
> WIL6210_FW_RECOVERY_RETRIES
) {
416 wil_err(wil
, "too many recovery attempts (%d), giving up\n",
417 wil
->recovery_count
);
421 wil
->last_fw_recovery
= jiffies
;
423 wil_info(wil
, "fw error recovery requested (try %d)...\n",
424 wil
->recovery_count
);
426 wil
->recovery_state
= fw_recovery_running
;
427 if (wil_wait_for_recovery(wil
) != 0)
430 mutex_lock(&wil
->mutex
);
431 switch (wdev
->iftype
) {
432 case NL80211_IFTYPE_STATION
:
433 case NL80211_IFTYPE_P2P_CLIENT
:
434 case NL80211_IFTYPE_MONITOR
:
435 /* silent recovery, upper layers will see disconnect */
439 case NL80211_IFTYPE_AP
:
440 case NL80211_IFTYPE_P2P_GO
:
441 wil_info(wil
, "No recovery for AP-like interface\n");
442 /* recovery in these modes is done by upper layers */
445 wil_err(wil
, "No recovery - unknown interface type %d\n",
449 mutex_unlock(&wil
->mutex
);
452 static int wil_find_free_vring(struct wil6210_priv
*wil
)
456 for (i
= 0; i
< WIL6210_MAX_TX_RINGS
; i
++) {
457 if (!wil
->vring_tx
[i
].va
)
463 int wil_tx_init(struct wil6210_priv
*wil
, int cid
)
465 int rc
= -EINVAL
, ringid
;
468 wil_err(wil
, "No connection pending\n");
471 ringid
= wil_find_free_vring(wil
);
473 wil_err(wil
, "No free vring found\n");
477 wil_dbg_wmi(wil
, "Configure for connection CID %d vring %d\n",
480 rc
= wil_vring_init_tx(wil
, ringid
, 1 << tx_ring_order
, cid
, 0);
482 wil_err(wil
, "wil_vring_init_tx for CID %d vring %d failed\n",
489 int wil_bcast_init(struct wil6210_priv
*wil
)
491 int ri
= wil
->bcast_vring
, rc
;
493 if ((ri
>= 0) && wil
->vring_tx
[ri
].va
)
496 ri
= wil_find_free_vring(wil
);
500 wil
->bcast_vring
= ri
;
501 rc
= wil_vring_init_bcast(wil
, ri
, 1 << bcast_ring_order
);
503 wil
->bcast_vring
= -1;
508 void wil_bcast_fini(struct wil6210_priv
*wil
)
510 int ri
= wil
->bcast_vring
;
515 wil
->bcast_vring
= -1;
516 wil_vring_fini_tx(wil
, ri
);
519 int wil_priv_init(struct wil6210_priv
*wil
)
523 wil_dbg_misc(wil
, "priv_init\n");
525 memset(wil
->sta
, 0, sizeof(wil
->sta
));
526 for (i
= 0; i
< WIL6210_MAX_CID
; i
++)
527 spin_lock_init(&wil
->sta
[i
].tid_rx_lock
);
529 for (i
= 0; i
< WIL6210_MAX_TX_RINGS
; i
++)
530 spin_lock_init(&wil
->vring_tx_data
[i
].lock
);
532 mutex_init(&wil
->mutex
);
533 mutex_init(&wil
->wmi_mutex
);
534 mutex_init(&wil
->probe_client_mutex
);
535 mutex_init(&wil
->p2p_wdev_mutex
);
536 mutex_init(&wil
->halp
.lock
);
538 init_completion(&wil
->wmi_ready
);
539 init_completion(&wil
->wmi_call
);
540 init_completion(&wil
->halp
.comp
);
542 wil
->bcast_vring
= -1;
543 setup_timer(&wil
->connect_timer
, wil_connect_timer_fn
, (ulong
)wil
);
544 setup_timer(&wil
->scan_timer
, wil_scan_timer_fn
, (ulong
)wil
);
545 setup_timer(&wil
->p2p
.discovery_timer
, wil_p2p_discovery_timer_fn
,
548 INIT_WORK(&wil
->disconnect_worker
, wil_disconnect_worker
);
549 INIT_WORK(&wil
->wmi_event_worker
, wmi_event_worker
);
550 INIT_WORK(&wil
->fw_error_worker
, wil_fw_error_worker
);
551 INIT_WORK(&wil
->probe_client_worker
, wil_probe_client_worker
);
552 INIT_WORK(&wil
->p2p
.delayed_listen_work
, wil_p2p_delayed_listen_work
);
554 INIT_LIST_HEAD(&wil
->pending_wmi_ev
);
555 INIT_LIST_HEAD(&wil
->probe_client_pending
);
556 spin_lock_init(&wil
->wmi_ev_lock
);
557 spin_lock_init(&wil
->net_queue_lock
);
558 wil
->net_queue_stopped
= 1;
559 init_waitqueue_head(&wil
->wq
);
561 wil
->wmi_wq
= create_singlethread_workqueue(WIL_NAME
"_wmi");
565 wil
->wq_service
= create_singlethread_workqueue(WIL_NAME
"_service");
566 if (!wil
->wq_service
)
569 wil
->last_fw_recovery
= jiffies
;
570 wil
->tx_interframe_timeout
= WIL6210_ITR_TX_INTERFRAME_TIMEOUT_DEFAULT
;
571 wil
->rx_interframe_timeout
= WIL6210_ITR_RX_INTERFRAME_TIMEOUT_DEFAULT
;
572 wil
->tx_max_burst_duration
= WIL6210_ITR_TX_MAX_BURST_DURATION_DEFAULT
;
573 wil
->rx_max_burst_duration
= WIL6210_ITR_RX_MAX_BURST_DURATION_DEFAULT
;
575 if (rx_ring_overflow_thrsh
== WIL6210_RX_HIGH_TRSH_INIT
)
576 rx_ring_overflow_thrsh
= WIL6210_RX_HIGH_TRSH_DEFAULT
;
578 wil
->ps_profile
= WMI_PS_PROFILE_TYPE_DEFAULT
;
580 wil
->wakeup_trigger
= WMI_WAKEUP_TRIGGER_UCAST
|
581 WMI_WAKEUP_TRIGGER_BCAST
;
582 memset(&wil
->suspend_stats
, 0, sizeof(wil
->suspend_stats
));
583 wil
->suspend_stats
.min_suspend_time
= ULONG_MAX
;
588 destroy_workqueue(wil
->wmi_wq
);
593 void wil6210_bus_request(struct wil6210_priv
*wil
, u32 kbps
)
595 if (wil
->platform_ops
.bus_request
) {
596 wil
->bus_request_kbps
= kbps
;
597 wil
->platform_ops
.bus_request(wil
->platform_handle
, kbps
);
602 * wil6210_disconnect - disconnect one connection
603 * @wil: driver context
604 * @bssid: peer to disconnect, NULL to disconnect all
605 * @reason_code: Reason code for the Disassociation frame
606 * @from_event: whether is invoked from FW event handler
608 * Disconnect and release associated resources. If invoked not from the
609 * FW event handler, issue WMI command(s) to trigger MAC disconnect.
611 void wil6210_disconnect(struct wil6210_priv
*wil
, const u8
*bssid
,
612 u16 reason_code
, bool from_event
)
614 wil_dbg_misc(wil
, "disconnect\n");
616 del_timer_sync(&wil
->connect_timer
);
617 _wil6210_disconnect(wil
, bssid
, reason_code
, from_event
);
620 void wil_priv_deinit(struct wil6210_priv
*wil
)
622 wil_dbg_misc(wil
, "priv_deinit\n");
624 wil_set_recovery_state(wil
, fw_recovery_idle
);
625 del_timer_sync(&wil
->scan_timer
);
626 del_timer_sync(&wil
->p2p
.discovery_timer
);
627 cancel_work_sync(&wil
->disconnect_worker
);
628 cancel_work_sync(&wil
->fw_error_worker
);
629 cancel_work_sync(&wil
->p2p
.discovery_expired_work
);
630 cancel_work_sync(&wil
->p2p
.delayed_listen_work
);
631 mutex_lock(&wil
->mutex
);
632 wil6210_disconnect(wil
, NULL
, WLAN_REASON_DEAUTH_LEAVING
, false);
633 mutex_unlock(&wil
->mutex
);
634 wmi_event_flush(wil
);
635 wil_probe_client_flush(wil
);
636 cancel_work_sync(&wil
->probe_client_worker
);
637 destroy_workqueue(wil
->wq_service
);
638 destroy_workqueue(wil
->wmi_wq
);
641 static inline void wil_halt_cpu(struct wil6210_priv
*wil
)
643 wil_w(wil
, RGF_USER_USER_CPU_0
, BIT_USER_USER_CPU_MAN_RST
);
644 wil_w(wil
, RGF_USER_MAC_CPU_0
, BIT_USER_MAC_CPU_MAN_RST
);
647 static inline void wil_release_cpu(struct wil6210_priv
*wil
)
650 wil_w(wil
, RGF_USER_USER_CPU_0
, 1);
653 static void wil_set_oob_mode(struct wil6210_priv
*wil
, u8 mode
)
655 wil_info(wil
, "oob_mode to %d\n", mode
);
658 wil_c(wil
, RGF_USER_USAGE_6
, BIT_USER_OOB_MODE
|
659 BIT_USER_OOB_R2_MODE
);
662 wil_c(wil
, RGF_USER_USAGE_6
, BIT_USER_OOB_R2_MODE
);
663 wil_s(wil
, RGF_USER_USAGE_6
, BIT_USER_OOB_MODE
);
666 wil_c(wil
, RGF_USER_USAGE_6
, BIT_USER_OOB_MODE
);
667 wil_s(wil
, RGF_USER_USAGE_6
, BIT_USER_OOB_R2_MODE
);
670 wil_err(wil
, "invalid oob_mode: %d\n", mode
);
674 static int wil_target_reset(struct wil6210_priv
*wil
)
679 wil_dbg_misc(wil
, "Resetting \"%s\"...\n", wil
->hw_name
);
681 /* Clear MAC link up */
682 wil_s(wil
, RGF_HP_CTRL
, BIT(15));
683 wil_s(wil
, RGF_USER_CLKS_CTL_SW_RST_MASK_0
, BIT_HPAL_PERST_FROM_PAD
);
684 wil_s(wil
, RGF_USER_CLKS_CTL_SW_RST_MASK_0
, BIT_CAR_PERST_RST
);
688 /* clear all boot loader "ready" bits */
689 wil_w(wil
, RGF_USER_BL
+
690 offsetof(struct bl_dedicated_registers_v0
, boot_loader_ready
), 0);
691 /* Clear Fw Download notification */
692 wil_c(wil
, RGF_USER_USAGE_6
, BIT(0));
694 wil_s(wil
, RGF_CAF_OSC_CONTROL
, BIT_CAF_OSC_XTAL_EN
);
695 /* XTAL stabilization should take about 3ms */
696 usleep_range(5000, 7000);
697 x
= wil_r(wil
, RGF_CAF_PLL_LOCK_STATUS
);
698 if (!(x
& BIT_CAF_OSC_DIG_XTAL_STABLE
)) {
699 wil_err(wil
, "Xtal stabilization timeout\n"
700 "RGF_CAF_PLL_LOCK_STATUS = 0x%08x\n", x
);
703 /* switch 10k to XTAL*/
704 wil_c(wil
, RGF_USER_SPARROW_M_4
, BIT_SPARROW_M_4_SEL_SLEEP_OR_REF
);
706 wil_c(wil
, RGF_USER_CLKS_CTL_0
, BIT_USER_CLKS_CAR_AHB_SW_SEL
);
708 wil_w(wil
, RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_0
, 0x3ff81f);
709 wil_w(wil
, RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_1
, 0xf);
711 wil_w(wil
, RGF_USER_CLKS_CTL_SW_RST_VEC_2
, 0xFE000000);
712 wil_w(wil
, RGF_USER_CLKS_CTL_SW_RST_VEC_1
, 0x0000003F);
713 wil_w(wil
, RGF_USER_CLKS_CTL_SW_RST_VEC_3
, 0x000000f0);
714 wil_w(wil
, RGF_USER_CLKS_CTL_SW_RST_VEC_0
, 0xFFE7FE00);
716 wil_w(wil
, RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_0
, 0x0);
717 wil_w(wil
, RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_1
, 0x0);
719 wil_w(wil
, RGF_USER_CLKS_CTL_SW_RST_VEC_3
, 0);
720 wil_w(wil
, RGF_USER_CLKS_CTL_SW_RST_VEC_2
, 0);
721 wil_w(wil
, RGF_USER_CLKS_CTL_SW_RST_VEC_1
, 0);
722 wil_w(wil
, RGF_USER_CLKS_CTL_SW_RST_VEC_0
, 0);
724 wil_w(wil
, RGF_USER_CLKS_CTL_SW_RST_VEC_3
, 0x00000003);
725 /* reset A2 PCIE AHB */
726 wil_w(wil
, RGF_USER_CLKS_CTL_SW_RST_VEC_2
, 0x00008000);
728 wil_w(wil
, RGF_USER_CLKS_CTL_SW_RST_VEC_0
, 0);
730 /* wait until device ready. typical time is 20..80 msec */
733 x
= wil_r(wil
, RGF_USER_BL
+
734 offsetof(struct bl_dedicated_registers_v0
,
737 wil_dbg_misc(wil
, "BL.ready 0x%08x => 0x%08x\n", x1
, x
);
740 if (delay
++ > RST_COUNT
) {
741 wil_err(wil
, "Reset not completed, bl.ready 0x%08x\n",
745 } while (x
!= BL_READY
);
747 wil_c(wil
, RGF_USER_CLKS_CTL_0
, BIT_USER_CLKS_RST_PWGD
);
749 /* enable fix for HW bug related to the SA/DA swap in AP Rx */
750 wil_s(wil
, RGF_DMA_OFUL_NID_0
, BIT_DMA_OFUL_NID_0_RX_EXT_TR_EN
|
751 BIT_DMA_OFUL_NID_0_RX_EXT_A3_SRC
);
753 wil_dbg_misc(wil
, "Reset completed in %d ms\n", delay
* RST_DELAY
);
757 static void wil_collect_fw_info(struct wil6210_priv
*wil
)
759 struct wiphy
*wiphy
= wil_to_wiphy(wil
);
763 rc
= wmi_get_mgmt_retry(wil
, &retry_short
);
765 wiphy
->retry_short
= retry_short
;
766 wil_dbg_misc(wil
, "FW retry_short: %d\n", retry_short
);
770 void wil_mbox_ring_le2cpus(struct wil6210_mbox_ring
*r
)
772 le32_to_cpus(&r
->base
);
773 le16_to_cpus(&r
->entry_size
);
774 le16_to_cpus(&r
->size
);
775 le32_to_cpus(&r
->tail
);
776 le32_to_cpus(&r
->head
);
779 static int wil_get_bl_info(struct wil6210_priv
*wil
)
781 struct net_device
*ndev
= wil_to_ndev(wil
);
782 struct wiphy
*wiphy
= wil_to_wiphy(wil
);
784 struct bl_dedicated_registers_v0 bl0
;
785 struct bl_dedicated_registers_v1 bl1
;
791 wil_memcpy_fromio_32(&bl
, wil
->csr
+ HOSTADDR(RGF_USER_BL
),
793 bl_ver
= le32_to_cpu(bl
.bl0
.boot_loader_struct_version
);
794 mac
= bl
.bl0
.mac_address
;
797 le32_to_cpus(&bl
.bl0
.rf_type
);
798 le32_to_cpus(&bl
.bl0
.baseband_type
);
799 rf_status
= 0; /* actually, unknown */
801 "Boot Loader struct v%d: MAC = %pM RF = 0x%08x bband = 0x%08x\n",
803 bl
.bl0
.rf_type
, bl
.bl0
.baseband_type
);
804 wil_info(wil
, "Boot Loader build unknown for struct v0\n");
806 le16_to_cpus(&bl
.bl1
.rf_type
);
807 rf_status
= le16_to_cpu(bl
.bl1
.rf_status
);
808 le32_to_cpus(&bl
.bl1
.baseband_type
);
809 le16_to_cpus(&bl
.bl1
.bl_version_subminor
);
810 le16_to_cpus(&bl
.bl1
.bl_version_build
);
812 "Boot Loader struct v%d: MAC = %pM RF = 0x%04x (status 0x%04x) bband = 0x%08x\n",
814 bl
.bl1
.rf_type
, rf_status
,
815 bl
.bl1
.baseband_type
);
816 wil_info(wil
, "Boot Loader build %d.%d.%d.%d\n",
817 bl
.bl1
.bl_version_major
, bl
.bl1
.bl_version_minor
,
818 bl
.bl1
.bl_version_subminor
, bl
.bl1
.bl_version_build
);
821 if (!is_valid_ether_addr(mac
)) {
822 wil_err(wil
, "BL: Invalid MAC %pM\n", mac
);
826 ether_addr_copy(ndev
->perm_addr
, mac
);
827 ether_addr_copy(wiphy
->perm_addr
, mac
);
828 if (!is_valid_ether_addr(ndev
->dev_addr
))
829 ether_addr_copy(ndev
->dev_addr
, mac
);
831 if (rf_status
) {/* bad RF cable? */
832 wil_err(wil
, "RF communication error 0x%04x",
840 static void wil_bl_crash_info(struct wil6210_priv
*wil
, bool is_err
)
842 u32 bl_assert_code
, bl_assert_blink
, bl_magic_number
;
843 u32 bl_ver
= wil_r(wil
, RGF_USER_BL
+
844 offsetof(struct bl_dedicated_registers_v0
,
845 boot_loader_struct_version
));
850 bl_assert_code
= wil_r(wil
, RGF_USER_BL
+
851 offsetof(struct bl_dedicated_registers_v1
,
853 bl_assert_blink
= wil_r(wil
, RGF_USER_BL
+
854 offsetof(struct bl_dedicated_registers_v1
,
856 bl_magic_number
= wil_r(wil
, RGF_USER_BL
+
857 offsetof(struct bl_dedicated_registers_v1
,
862 "BL assert code 0x%08x blink 0x%08x magic 0x%08x\n",
863 bl_assert_code
, bl_assert_blink
, bl_magic_number
);
866 "BL assert code 0x%08x blink 0x%08x magic 0x%08x\n",
867 bl_assert_code
, bl_assert_blink
, bl_magic_number
);
871 static int wil_wait_for_fw_ready(struct wil6210_priv
*wil
)
873 ulong to
= msecs_to_jiffies(1000);
874 ulong left
= wait_for_completion_timeout(&wil
->wmi_ready
, to
);
877 wil_err(wil
, "Firmware not ready\n");
880 wil_info(wil
, "FW ready after %d ms. HW version 0x%08x\n",
881 jiffies_to_msecs(to
-left
), wil
->hw_version
);
886 void wil_abort_scan(struct wil6210_priv
*wil
, bool sync
)
889 struct cfg80211_scan_info info
= {
893 lockdep_assert_held(&wil
->p2p_wdev_mutex
);
895 if (!wil
->scan_request
)
898 wil_dbg_misc(wil
, "Abort scan_request 0x%p\n", wil
->scan_request
);
899 del_timer_sync(&wil
->scan_timer
);
900 mutex_unlock(&wil
->p2p_wdev_mutex
);
901 rc
= wmi_abort_scan(wil
);
903 wait_event_interruptible_timeout(wil
->wq
, !wil
->scan_request
,
905 WAIT_FOR_SCAN_ABORT_MS
));
907 mutex_lock(&wil
->p2p_wdev_mutex
);
908 if (wil
->scan_request
) {
909 cfg80211_scan_done(wil
->scan_request
, &info
);
910 wil
->scan_request
= NULL
;
914 int wil_ps_update(struct wil6210_priv
*wil
, enum wmi_ps_profile_type ps_profile
)
918 if (!test_bit(WMI_FW_CAPABILITY_PS_CONFIG
, wil
->fw_capabilities
)) {
919 wil_err(wil
, "set_power_mgmt not supported\n");
923 rc
= wmi_ps_dev_profile_cfg(wil
, ps_profile
);
925 wil_err(wil
, "wmi_ps_dev_profile_cfg failed (%d)\n", rc
);
927 wil
->ps_profile
= ps_profile
;
933 * We reset all the structures, and we reset the UMAC.
934 * After calling this routine, you're expected to reload
937 int wil_reset(struct wil6210_priv
*wil
, bool load_fw
)
941 wil_dbg_misc(wil
, "reset\n");
943 WARN_ON(!mutex_is_locked(&wil
->mutex
));
944 WARN_ON(test_bit(wil_status_napi_en
, wil
->status
));
947 static const u8 mac
[ETH_ALEN
] = {
948 0x00, 0xde, 0xad, 0x12, 0x34, 0x56,
950 struct net_device
*ndev
= wil_to_ndev(wil
);
952 ether_addr_copy(ndev
->perm_addr
, mac
);
953 ether_addr_copy(ndev
->dev_addr
, ndev
->perm_addr
);
957 if (wil
->hw_version
== HW_VER_UNKNOWN
)
960 if (wil
->platform_ops
.notify
) {
961 rc
= wil
->platform_ops
.notify(wil
->platform_handle
,
962 WIL_PLATFORM_EVT_PRE_RESET
);
964 wil_err(wil
, "PRE_RESET platform notify failed, rc %d\n",
968 set_bit(wil_status_resetting
, wil
->status
);
970 cancel_work_sync(&wil
->disconnect_worker
);
971 wil6210_disconnect(wil
, NULL
, WLAN_REASON_DEAUTH_LEAVING
, false);
974 /* Disable device led before reset*/
975 wmi_led_cfg(wil
, false);
977 mutex_lock(&wil
->p2p_wdev_mutex
);
978 wil_abort_scan(wil
, false);
979 mutex_unlock(&wil
->p2p_wdev_mutex
);
981 /* prevent NAPI from being scheduled and prevent wmi commands */
982 mutex_lock(&wil
->wmi_mutex
);
983 bitmap_zero(wil
->status
, wil_status_last
);
984 mutex_unlock(&wil
->wmi_mutex
);
988 wmi_event_flush(wil
);
990 flush_workqueue(wil
->wq_service
);
991 flush_workqueue(wil
->wmi_wq
);
993 wil_bl_crash_info(wil
, false);
994 wil_disable_irq(wil
);
995 rc
= wil_target_reset(wil
);
996 wil6210_clear_irq(wil
);
1000 wil_bl_crash_info(wil
, true);
1004 rc
= wil_get_bl_info(wil
);
1005 if (rc
== -EAGAIN
&& !load_fw
) /* ignore RF error if not going up */
1010 wil_set_oob_mode(wil
, oob_mode
);
1012 wil_info(wil
, "Use firmware <%s> + board <%s>\n",
1013 wil
->wil_fw_name
, WIL_BOARD_FILE_NAME
);
1016 memset(wil
->fw_version
, 0, sizeof(wil
->fw_version
));
1017 /* Loading f/w from the file */
1018 rc
= wil_request_firmware(wil
, wil
->wil_fw_name
, true);
1021 rc
= wil_request_firmware(wil
, WIL_BOARD_FILE_NAME
, true);
1025 /* Mark FW as loaded from host */
1026 wil_s(wil
, RGF_USER_USAGE_6
, 1);
1028 /* clear any interrupts which on-card-firmware
1031 wil6210_clear_irq(wil
);
1032 /* CAF_ICR - clear and mask */
1033 /* it is W1C, clear by writing back same value */
1034 wil_s(wil
, RGF_CAF_ICR
+ offsetof(struct RGF_ICR
, ICR
), 0);
1035 wil_w(wil
, RGF_CAF_ICR
+ offsetof(struct RGF_ICR
, IMV
), ~0);
1037 wil_release_cpu(wil
);
1040 /* init after reset */
1041 wil
->ap_isolate
= 0;
1042 reinit_completion(&wil
->wmi_ready
);
1043 reinit_completion(&wil
->wmi_call
);
1044 reinit_completion(&wil
->halp
.comp
);
1047 wil_configure_interrupt_moderation(wil
);
1048 wil_unmask_irq(wil
);
1050 /* we just started MAC, wait for FW ready */
1051 rc
= wil_wait_for_fw_ready(wil
);
1055 /* check FW is responsive */
1058 wil_err(wil
, "wmi_echo failed, rc %d\n", rc
);
1062 if (wil
->ps_profile
!= WMI_PS_PROFILE_TYPE_DEFAULT
)
1063 wil_ps_update(wil
, wil
->ps_profile
);
1065 wil_collect_fw_info(wil
);
1067 if (wil
->platform_ops
.notify
) {
1068 rc
= wil
->platform_ops
.notify(wil
->platform_handle
,
1069 WIL_PLATFORM_EVT_FW_RDY
);
1071 wil_err(wil
, "FW_RDY notify failed, rc %d\n",
1081 void wil_fw_error_recovery(struct wil6210_priv
*wil
)
1083 wil_dbg_misc(wil
, "starting fw error recovery\n");
1085 if (test_bit(wil_status_resetting
, wil
->status
)) {
1086 wil_info(wil
, "Reset already in progress\n");
1090 wil
->recovery_state
= fw_recovery_pending
;
1091 schedule_work(&wil
->fw_error_worker
);
1094 int __wil_up(struct wil6210_priv
*wil
)
1096 struct net_device
*ndev
= wil_to_ndev(wil
);
1097 struct wireless_dev
*wdev
= wil
->wdev
;
1100 WARN_ON(!mutex_is_locked(&wil
->mutex
));
1102 rc
= wil_reset(wil
, true);
1106 /* Rx VRING. After MAC and beacon */
1107 rc
= wil_rx_init(wil
, 1 << rx_ring_order
);
1111 switch (wdev
->iftype
) {
1112 case NL80211_IFTYPE_STATION
:
1113 wil_dbg_misc(wil
, "type: STATION\n");
1114 ndev
->type
= ARPHRD_ETHER
;
1116 case NL80211_IFTYPE_AP
:
1117 wil_dbg_misc(wil
, "type: AP\n");
1118 ndev
->type
= ARPHRD_ETHER
;
1120 case NL80211_IFTYPE_P2P_CLIENT
:
1121 wil_dbg_misc(wil
, "type: P2P_CLIENT\n");
1122 ndev
->type
= ARPHRD_ETHER
;
1124 case NL80211_IFTYPE_P2P_GO
:
1125 wil_dbg_misc(wil
, "type: P2P_GO\n");
1126 ndev
->type
= ARPHRD_ETHER
;
1128 case NL80211_IFTYPE_MONITOR
:
1129 wil_dbg_misc(wil
, "type: Monitor\n");
1130 ndev
->type
= ARPHRD_IEEE80211_RADIOTAP
;
1131 /* ARPHRD_IEEE80211 or ARPHRD_IEEE80211_RADIOTAP ? */
1137 /* MAC address - pre-requisite for other commands */
1138 wmi_set_mac_address(wil
, ndev
->dev_addr
);
1140 wil_dbg_misc(wil
, "NAPI enable\n");
1141 napi_enable(&wil
->napi_rx
);
1142 napi_enable(&wil
->napi_tx
);
1143 set_bit(wil_status_napi_en
, wil
->status
);
1145 wil6210_bus_request(wil
, WIL_DEFAULT_BUS_REQUEST_KBPS
);
1150 int wil_up(struct wil6210_priv
*wil
)
1154 wil_dbg_misc(wil
, "up\n");
1156 mutex_lock(&wil
->mutex
);
1158 mutex_unlock(&wil
->mutex
);
1163 int __wil_down(struct wil6210_priv
*wil
)
1165 WARN_ON(!mutex_is_locked(&wil
->mutex
));
1167 set_bit(wil_status_resetting
, wil
->status
);
1169 wil6210_bus_request(wil
, 0);
1171 wil_disable_irq(wil
);
1172 if (test_and_clear_bit(wil_status_napi_en
, wil
->status
)) {
1173 napi_disable(&wil
->napi_rx
);
1174 napi_disable(&wil
->napi_tx
);
1175 wil_dbg_misc(wil
, "NAPI disable\n");
1177 wil_enable_irq(wil
);
1179 mutex_lock(&wil
->p2p_wdev_mutex
);
1180 wil_p2p_stop_radio_operations(wil
);
1181 wil_abort_scan(wil
, false);
1182 mutex_unlock(&wil
->p2p_wdev_mutex
);
1184 wil_reset(wil
, false);
1189 int wil_down(struct wil6210_priv
*wil
)
1193 wil_dbg_misc(wil
, "down\n");
1195 wil_set_recovery_state(wil
, fw_recovery_idle
);
1196 mutex_lock(&wil
->mutex
);
1197 rc
= __wil_down(wil
);
1198 mutex_unlock(&wil
->mutex
);
1203 int wil_find_cid(struct wil6210_priv
*wil
, const u8
*mac
)
1208 for (i
= 0; i
< ARRAY_SIZE(wil
->sta
); i
++) {
1209 if ((wil
->sta
[i
].status
!= wil_sta_unused
) &&
1210 ether_addr_equal(wil
->sta
[i
].addr
, mac
)) {
1219 void wil_halp_vote(struct wil6210_priv
*wil
)
1222 unsigned long to_jiffies
= msecs_to_jiffies(WAIT_FOR_HALP_VOTE_MS
);
1224 mutex_lock(&wil
->halp
.lock
);
1226 wil_dbg_irq(wil
, "halp_vote: start, HALP ref_cnt (%d)\n",
1229 if (++wil
->halp
.ref_cnt
== 1) {
1230 reinit_completion(&wil
->halp
.comp
);
1231 wil6210_set_halp(wil
);
1232 rc
= wait_for_completion_timeout(&wil
->halp
.comp
, to_jiffies
);
1234 wil_err(wil
, "HALP vote timed out\n");
1235 /* Mask HALP as done in case the interrupt is raised */
1236 wil6210_mask_halp(wil
);
1239 "halp_vote: HALP vote completed after %d ms\n",
1240 jiffies_to_msecs(to_jiffies
- rc
));
1244 wil_dbg_irq(wil
, "halp_vote: end, HALP ref_cnt (%d)\n",
1247 mutex_unlock(&wil
->halp
.lock
);
1250 void wil_halp_unvote(struct wil6210_priv
*wil
)
1252 WARN_ON(wil
->halp
.ref_cnt
== 0);
1254 mutex_lock(&wil
->halp
.lock
);
1256 wil_dbg_irq(wil
, "halp_unvote: start, HALP ref_cnt (%d)\n",
1259 if (--wil
->halp
.ref_cnt
== 0) {
1260 wil6210_clear_halp(wil
);
1261 wil_dbg_irq(wil
, "HALP unvote\n");
1264 wil_dbg_irq(wil
, "halp_unvote:end, HALP ref_cnt (%d)\n",
1267 mutex_unlock(&wil
->halp
.lock
);