blob: 0e95557e177f89c6dd65e5575cf3be51939cd918 [file] [log] [blame]
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -08001/*
Vladimir Kondratiev02525a72014-08-06 10:31:51 +03002 * Copyright (c) 2012-2014 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 Kondratievb6b1b0e2014-09-22 15:31:41 +030036static unsigned int itr_trsh = WIL6210_ITR_TRSH_DEFAULT;
37
38module_param(itr_trsh, uint, S_IRUGO);
39MODULE_PARM_DESC(itr_trsh, " Interrupt moderation threshold, usecs.");
40
Vladimir Kondratiev520d68e2014-08-06 10:31:53 +030041#define RST_DELAY (20) /* msec, for loop in @wil_target_reset */
42#define RST_COUNT (1 + 1000/RST_DELAY) /* round up to be above 1 sec total */
43
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -080044/*
45 * Due to a hardware issue,
46 * one has to read/write to/from NIC in 32-bit chunks;
47 * regular memcpy_fromio and siblings will
48 * not work on 64-bit platform - it uses 64-bit transactions
49 *
50 * Force 32-bit transactions to enable NIC on 64-bit platforms
51 *
52 * To avoid byte swap on big endian host, __raw_{read|write}l
53 * should be used - {read|write}l would swap bytes to provide
54 * little endian on PCI value in host endianness.
55 */
56void wil_memcpy_fromio_32(void *dst, const volatile void __iomem *src,
57 size_t count)
58{
59 u32 *d = dst;
60 const volatile u32 __iomem *s = src;
61
62 /* size_t is unsigned, if (count%4 != 0) it will wrap */
63 for (count += 4; count > 4; count -= 4)
64 *d++ = __raw_readl(s++);
65}
66
67void wil_memcpy_toio_32(volatile void __iomem *dst, const void *src,
68 size_t count)
69{
70 volatile u32 __iomem *d = dst;
71 const u32 *s = src;
72
73 for (count += 4; count > 4; count -= 4)
74 __raw_writel(*s++, d++);
75}
76
Vladimir Kondratiev91886b02014-02-27 16:20:50 +020077static void wil_disconnect_cid(struct wil6210_priv *wil, int cid)
78{
79 uint i;
Vladimir Kondratievfc58f682014-06-16 19:37:16 +030080 struct net_device *ndev = wil_to_ndev(wil);
81 struct wireless_dev *wdev = wil->wdev;
Vladimir Kondratiev91886b02014-02-27 16:20:50 +020082 struct wil_sta_info *sta = &wil->sta[cid];
Vladimir Kondratiev8fe59622014-09-10 16:34:34 +030083
Vladimir Kondratievfc58f682014-06-16 19:37:16 +030084 wil_dbg_misc(wil, "%s(CID %d, status %d)\n", __func__, cid,
85 sta->status);
Vladimir Kondratiev4d55a0a2014-02-27 16:20:54 +020086
Vladimir Kondratieve58c9f72014-03-17 15:34:06 +020087 sta->data_port_open = false;
Vladimir Kondratiev4d55a0a2014-02-27 16:20:54 +020088 if (sta->status != wil_sta_unused) {
89 wmi_disconnect_sta(wil, sta->addr, WLAN_REASON_DEAUTH_LEAVING);
Vladimir Kondratievfc58f682014-06-16 19:37:16 +030090 switch (wdev->iftype) {
91 case NL80211_IFTYPE_AP:
92 case NL80211_IFTYPE_P2P_GO:
93 /* AP-like interface */
94 cfg80211_del_sta(ndev, sta->addr, GFP_KERNEL);
95 break;
96 default:
97 break;
98 }
Vladimir Kondratiev4d55a0a2014-02-27 16:20:54 +020099 sta->status = wil_sta_unused;
100 }
101
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200102 for (i = 0; i < WIL_STA_TID_NUM; i++) {
Dedy Lanskyec81b5a2014-09-10 16:34:42 +0300103 struct wil_tid_ampdu_rx *r;
104 unsigned long flags;
105
106 spin_lock_irqsave(&sta->tid_rx_lock, flags);
107
108 r = sta->tid_rx[i];
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200109 sta->tid_rx[i] = NULL;
110 wil_tid_ampdu_rx_free(wil, r);
Dedy Lanskyec81b5a2014-09-10 16:34:42 +0300111
112 spin_unlock_irqrestore(&sta->tid_rx_lock, flags);
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200113 }
114 for (i = 0; i < ARRAY_SIZE(wil->vring_tx); i++) {
115 if (wil->vring2cid_tid[i][0] == cid)
116 wil_vring_fini_tx(wil, i);
117 }
118 memset(&sta->stats, 0, sizeof(sta->stats));
119}
120
Johannes Berg3b3a0162014-05-19 17:19:31 +0200121static void _wil6210_disconnect(struct wil6210_priv *wil, const u8 *bssid)
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800122{
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200123 int cid = -ENOENT;
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800124 struct net_device *ndev = wil_to_ndev(wil);
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200125 struct wireless_dev *wdev = wil->wdev;
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800126
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200127 might_sleep();
128 if (bssid) {
129 cid = wil_find_cid(wil, bssid);
130 wil_dbg_misc(wil, "%s(%pM, CID %d)\n", __func__, bssid, cid);
131 } else {
132 wil_dbg_misc(wil, "%s(all)\n", __func__);
133 }
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800134
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200135 if (cid >= 0) /* disconnect 1 peer */
136 wil_disconnect_cid(wil, cid);
137 else /* disconnect all */
138 for (cid = 0; cid < WIL6210_MAX_CID; cid++)
139 wil_disconnect_cid(wil, cid);
140
141 /* link state */
142 switch (wdev->iftype) {
143 case NL80211_IFTYPE_STATION:
144 case NL80211_IFTYPE_P2P_CLIENT:
145 wil_link_off(wil);
146 if (test_bit(wil_status_fwconnected, &wil->status)) {
147 clear_bit(wil_status_fwconnected, &wil->status);
148 cfg80211_disconnected(ndev,
149 WLAN_STATUS_UNSPECIFIED_FAILURE,
150 NULL, 0, GFP_KERNEL);
151 } else if (test_bit(wil_status_fwconnecting, &wil->status)) {
152 cfg80211_connect_result(ndev, bssid, NULL, 0, NULL, 0,
153 WLAN_STATUS_UNSPECIFIED_FAILURE,
154 GFP_KERNEL);
Vladimir Kondratievb4490f42014-02-27 16:20:44 +0200155 }
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200156 clear_bit(wil_status_fwconnecting, &wil->status);
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200157 break;
158 default:
Vladimir Kondratiev91886b02014-02-27 16:20:50 +0200159 break;
Vladimir Kondratievb4490f42014-02-27 16:20:44 +0200160 }
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800161}
162
163static void wil_disconnect_worker(struct work_struct *work)
164{
165 struct wil6210_priv *wil = container_of(work,
166 struct wil6210_priv, disconnect_worker);
167
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200168 mutex_lock(&wil->mutex);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800169 _wil6210_disconnect(wil, NULL);
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200170 mutex_unlock(&wil->mutex);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800171}
172
173static void wil_connect_timer_fn(ulong x)
174{
175 struct wil6210_priv *wil = (void *)x;
176
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200177 wil_dbg_misc(wil, "Connect timeout\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800178
179 /* reschedule to thread context - disconnect won't
180 * run from atomic context
181 */
182 schedule_work(&wil->disconnect_worker);
183}
184
Vladimir Kondratiev047e5d72014-05-27 14:45:48 +0300185static void wil_scan_timer_fn(ulong x)
186{
187 struct wil6210_priv *wil = (void *)x;
188
189 clear_bit(wil_status_fwready, &wil->status);
190 wil_err(wil, "Scan timeout detected, start fw error recovery\n");
191 schedule_work(&wil->fw_error_worker);
192}
193
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300194static int wil_wait_for_recovery(struct wil6210_priv *wil)
195{
196 if (wait_event_interruptible(wil->wq, wil->recovery_state !=
197 fw_recovery_pending)) {
198 wil_err(wil, "Interrupt, canceling recovery\n");
199 return -ERESTARTSYS;
200 }
201 if (wil->recovery_state != fw_recovery_running) {
202 wil_info(wil, "Recovery cancelled\n");
203 return -EINTR;
204 }
205 wil_info(wil, "Proceed with recovery\n");
206 return 0;
207}
208
209void wil_set_recovery_state(struct wil6210_priv *wil, int state)
210{
211 wil_dbg_misc(wil, "%s(%d -> %d)\n", __func__,
212 wil->recovery_state, state);
213
214 wil->recovery_state = state;
215 wake_up_interruptible(&wil->wq);
216}
217
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200218static void wil_fw_error_worker(struct work_struct *work)
219{
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300220 struct wil6210_priv *wil = container_of(work, struct wil6210_priv,
221 fw_error_worker);
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200222 struct wireless_dev *wdev = wil->wdev;
223
224 wil_dbg_misc(wil, "fw error worker\n");
225
Vladimir Kondratievcded9362014-10-28 16:50:06 +0200226 if (!netif_running(wil_to_ndev(wil))) {
227 wil_info(wil, "No recovery - interface is down\n");
228 return;
229 }
230
Vladimir Kondratievfc219ee2014-05-27 14:45:45 +0300231 /* increment @recovery_count if less then WIL6210_FW_RECOVERY_TO
232 * passed since last recovery attempt
233 */
234 if (time_is_after_jiffies(wil->last_fw_recovery +
235 WIL6210_FW_RECOVERY_TO))
236 wil->recovery_count++;
237 else
238 wil->recovery_count = 1; /* fw was alive for a long time */
239
240 if (wil->recovery_count > WIL6210_FW_RECOVERY_RETRIES) {
241 wil_err(wil, "too many recovery attempts (%d), giving up\n",
242 wil->recovery_count);
243 return;
244 }
245
246 wil->last_fw_recovery = jiffies;
247
Vladimir Kondratiev9c3bde52014-03-17 15:34:21 +0200248 mutex_lock(&wil->mutex);
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200249 switch (wdev->iftype) {
250 case NL80211_IFTYPE_STATION:
251 case NL80211_IFTYPE_P2P_CLIENT:
252 case NL80211_IFTYPE_MONITOR:
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300253 wil_info(wil, "fw error recovery requested (try %d)...\n",
Vladimir Kondratievfc219ee2014-05-27 14:45:45 +0300254 wil->recovery_count);
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300255 if (!no_fw_recovery)
256 wil->recovery_state = fw_recovery_running;
257 if (0 != wil_wait_for_recovery(wil))
258 break;
259
Vladimir Kondratiev73d839a2014-09-10 16:34:50 +0300260 __wil_down(wil);
261 __wil_up(wil);
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200262 break;
263 case NL80211_IFTYPE_AP:
264 case NL80211_IFTYPE_P2P_GO:
265 /* recovery in these modes is done by upper layers */
266 break;
267 default:
268 break;
269 }
Vladimir Kondratiev9c3bde52014-03-17 15:34:21 +0200270 mutex_unlock(&wil->mutex);
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200271}
272
Vladimir Kondratiev9a177382014-02-27 16:20:45 +0200273static int wil_find_free_vring(struct wil6210_priv *wil)
274{
275 int i;
Vladimir Kondratiev8fe59622014-09-10 16:34:34 +0300276
Vladimir Kondratiev9a177382014-02-27 16:20:45 +0200277 for (i = 0; i < WIL6210_MAX_TX_RINGS; i++) {
278 if (!wil->vring_tx[i].va)
279 return i;
280 }
281 return -EINVAL;
282}
283
Vladimir Kondratievd81079f2013-03-13 14:12:43 +0200284static void wil_connect_worker(struct work_struct *work)
285{
286 int rc;
287 struct wil6210_priv *wil = container_of(work, struct wil6210_priv,
288 connect_worker);
289 int cid = wil->pending_connect_cid;
Vladimir Kondratiev9a177382014-02-27 16:20:45 +0200290 int ringid = wil_find_free_vring(wil);
Vladimir Kondratievd81079f2013-03-13 14:12:43 +0200291
292 if (cid < 0) {
293 wil_err(wil, "No connection pending\n");
294 return;
295 }
296
297 wil_dbg_wmi(wil, "Configure for connection CID %d\n", cid);
298
Vladimir Kondratiev9a177382014-02-27 16:20:45 +0200299 rc = wil_vring_init_tx(wil, ringid, WIL6210_TX_RING_SIZE, cid, 0);
Vladimir Kondratievd81079f2013-03-13 14:12:43 +0200300 wil->pending_connect_cid = -1;
Vladimir Kondratiev3df2cd362014-02-27 16:20:43 +0200301 if (rc == 0) {
302 wil->sta[cid].status = wil_sta_connected;
Vladimir Kondratievd81079f2013-03-13 14:12:43 +0200303 wil_link_on(wil);
Vladimir Kondratiev3df2cd362014-02-27 16:20:43 +0200304 } else {
305 wil->sta[cid].status = wil_sta_unused;
306 }
Vladimir Kondratievd81079f2013-03-13 14:12:43 +0200307}
308
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800309int wil_priv_init(struct wil6210_priv *wil)
310{
Dedy Lanskyec81b5a2014-09-10 16:34:42 +0300311 uint i;
312
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200313 wil_dbg_misc(wil, "%s()\n", __func__);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800314
Vladimir Kondratiev3df2cd362014-02-27 16:20:43 +0200315 memset(wil->sta, 0, sizeof(wil->sta));
Dedy Lanskyec81b5a2014-09-10 16:34:42 +0300316 for (i = 0; i < WIL6210_MAX_CID; i++)
317 spin_lock_init(&wil->sta[i].tid_rx_lock);
Vladimir Kondratiev3df2cd362014-02-27 16:20:43 +0200318
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800319 mutex_init(&wil->mutex);
320 mutex_init(&wil->wmi_mutex);
321
322 init_completion(&wil->wmi_ready);
Dedy Lansky59502642014-09-10 16:34:46 +0300323 init_completion(&wil->wmi_call);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800324
325 wil->pending_connect_cid = -1;
326 setup_timer(&wil->connect_timer, wil_connect_timer_fn, (ulong)wil);
Vladimir Kondratiev047e5d72014-05-27 14:45:48 +0300327 setup_timer(&wil->scan_timer, wil_scan_timer_fn, (ulong)wil);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800328
Vladimir Kondratievd81079f2013-03-13 14:12:43 +0200329 INIT_WORK(&wil->connect_worker, wil_connect_worker);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800330 INIT_WORK(&wil->disconnect_worker, wil_disconnect_worker);
331 INIT_WORK(&wil->wmi_event_worker, wmi_event_worker);
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200332 INIT_WORK(&wil->fw_error_worker, wil_fw_error_worker);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800333
334 INIT_LIST_HEAD(&wil->pending_wmi_ev);
335 spin_lock_init(&wil->wmi_ev_lock);
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300336 init_waitqueue_head(&wil->wq);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800337
338 wil->wmi_wq = create_singlethread_workqueue(WIL_NAME"_wmi");
339 if (!wil->wmi_wq)
340 return -EAGAIN;
341
342 wil->wmi_wq_conn = create_singlethread_workqueue(WIL_NAME"_connect");
343 if (!wil->wmi_wq_conn) {
344 destroy_workqueue(wil->wmi_wq);
345 return -EAGAIN;
346 }
347
Vladimir Kondratievfc219ee2014-05-27 14:45:45 +0300348 wil->last_fw_recovery = jiffies;
Vladimir Kondratievb6b1b0e2014-09-22 15:31:41 +0300349 wil->itr_trsh = itr_trsh;
Vladimir Kondratievfc219ee2014-05-27 14:45:45 +0300350
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800351 return 0;
352}
353
Johannes Berg3b3a0162014-05-19 17:19:31 +0200354void wil6210_disconnect(struct wil6210_priv *wil, const u8 *bssid)
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800355{
Vladimir Kondratiev9cf10d62014-09-10 16:34:36 +0300356 wil_dbg_misc(wil, "%s()\n", __func__);
357
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800358 del_timer_sync(&wil->connect_timer);
359 _wil6210_disconnect(wil, bssid);
360}
361
362void wil_priv_deinit(struct wil6210_priv *wil)
363{
Vladimir Kondratiev9cf10d62014-09-10 16:34:36 +0300364 wil_dbg_misc(wil, "%s()\n", __func__);
365
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300366 wil_set_recovery_state(wil, fw_recovery_idle);
Vladimir Kondratiev047e5d72014-05-27 14:45:48 +0300367 del_timer_sync(&wil->scan_timer);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800368 cancel_work_sync(&wil->disconnect_worker);
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200369 cancel_work_sync(&wil->fw_error_worker);
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200370 mutex_lock(&wil->mutex);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800371 wil6210_disconnect(wil, NULL);
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200372 mutex_unlock(&wil->mutex);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800373 wmi_event_flush(wil);
374 destroy_workqueue(wil->wmi_wq_conn);
375 destroy_workqueue(wil->wmi_wq);
376}
377
Vladimir Kondratiev151a9702014-09-10 16:34:30 +0300378/* target operations */
379/* register read */
380#define R(a) ioread32(wil->csr + HOSTADDR(a))
381/* register write. wmb() to make sure it is completed */
382#define W(a, v) do { iowrite32(v, wil->csr + HOSTADDR(a)); wmb(); } while (0)
383/* register set = read, OR, write */
384#define S(a, v) W(a, R(a) | v)
385/* register clear = read, AND with inverted, write */
386#define C(a, v) W(a, R(a) & ~v)
387
388static inline void wil_halt_cpu(struct wil6210_priv *wil)
389{
390 W(RGF_USER_USER_CPU_0, BIT_USER_USER_CPU_MAN_RST);
391 W(RGF_USER_MAC_CPU_0, BIT_USER_MAC_CPU_MAN_RST);
392}
393
394static inline void wil_release_cpu(struct wil6210_priv *wil)
395{
396 /* Start CPU */
397 W(RGF_USER_USER_CPU_0, 1);
398}
399
Vladimir Kondratievbbb2adc2014-08-06 10:31:52 +0300400static int wil_target_reset(struct wil6210_priv *wil)
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800401{
Vladimir Kondratiev98a65b52014-03-17 15:34:12 +0200402 int delay = 0;
Vladimir Kondratiev48516292014-10-28 16:50:07 +0200403 u32 x;
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200404 u32 rev_id;
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300405 bool is_sparrow = (wil->board->board == WIL_BOARD_SPARROW);
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200406
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300407 wil_dbg_misc(wil, "Resetting \"%s\"...\n", wil->board->name);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800408
Vladimir Kondratiev17123992014-03-17 15:34:14 +0200409 wil->hw_version = R(RGF_USER_FW_REV_ID);
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200410 rev_id = wil->hw_version & 0xff;
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300411
412 /* Clear MAC link up */
413 S(RGF_HP_CTRL, BIT(15));
Vladimir Kondratiev151a9702014-09-10 16:34:30 +0300414 S(RGF_USER_CLKS_CTL_SW_RST_MASK_0, BIT_HPAL_PERST_FROM_PAD);
415 S(RGF_USER_CLKS_CTL_SW_RST_MASK_0, BIT_CAR_PERST_RST);
416
417 wil_halt_cpu(wil);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800418
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300419 if (is_sparrow) {
Vladimir Kondratiev48516292014-10-28 16:50:07 +0200420 S(RGF_CAF_OSC_CONTROL, BIT_CAF_OSC_XTAL_EN);
421 /* XTAL stabilization should take about 3ms */
422 usleep_range(5000, 7000);
423 x = R(RGF_CAF_PLL_LOCK_STATUS);
424 if (!(x & BIT_CAF_OSC_DIG_XTAL_STABLE)) {
425 wil_err(wil, "Xtal stabilization timeout\n"
426 "RGF_CAF_PLL_LOCK_STATUS = 0x%08x\n", x);
427 return -ETIME;
428 }
429 /* switch 10k to XTAL*/
430 C(RGF_USER_SPARROW_M_4, BIT_SPARROW_M_4_SEL_SLEEP_OR_REF);
431 /* 40 MHz */
432 C(RGF_USER_CLKS_CTL_0, BIT_USER_CLKS_CAR_AHB_SW_SEL);
433
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300434 W(RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_0, 0x3ff81f);
Vladimir Kondratiev151a9702014-09-10 16:34:30 +0300435 W(RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_1, 0xf);
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300436 }
437
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800438 W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0xFE000000);
439 W(RGF_USER_CLKS_CTL_SW_RST_VEC_1, 0x0000003F);
Vladimir Kondratiev151a9702014-09-10 16:34:30 +0300440 W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, is_sparrow ? 0x000000f0 : 0x00000170);
441 W(RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0xFFE7FE00);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800442
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300443 if (is_sparrow) {
444 W(RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_0, 0x0);
Vladimir Kondratiev151a9702014-09-10 16:34:30 +0300445 W(RGF_USER_CLKS_CTL_EXT_SW_RST_VEC_1, 0x0);
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300446 }
447
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800448 W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0);
449 W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0);
450 W(RGF_USER_CLKS_CTL_SW_RST_VEC_1, 0);
451 W(RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0);
452
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300453 if (is_sparrow) {
454 W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0x00000003);
455 /* reset A2 PCIE AHB */
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200456 W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0x00008000);
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300457 } else {
458 W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0x00000001);
459 if (rev_id == 1) {
460 /* reset A1 BOTH PCIE AHB & PCIE RGF */
461 W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0x00000080);
462 } else {
463 W(RGF_PCIE_LOS_COUNTER_CTL, BIT(6) | BIT(8));
464 W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0x00008000);
465 }
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200466 }
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300467
468 /* TODO: check order here!!! Erez code is different */
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800469 W(RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0);
470
Vladimir Kondratiev520d68e2014-08-06 10:31:53 +0300471 /* wait until device ready. typical time is 200..250 msec */
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200472 do {
Vladimir Kondratiev520d68e2014-08-06 10:31:53 +0300473 msleep(RST_DELAY);
Vladimir Kondratiev48516292014-10-28 16:50:07 +0200474 x = R(RGF_USER_HW_MACHINE_STATE);
Vladimir Kondratiev520d68e2014-08-06 10:31:53 +0300475 if (delay++ > RST_COUNT) {
Vladimir Kondratievd28bcc32014-03-17 15:34:23 +0200476 wil_err(wil, "Reset not completed, hw_state 0x%08x\n",
Vladimir Kondratiev48516292014-10-28 16:50:07 +0200477 x);
Vladimir Kondratievbbb2adc2014-08-06 10:31:52 +0300478 return -ETIME;
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200479 }
Vladimir Kondratiev48516292014-10-28 16:50:07 +0200480 } while (x != HW_MACHINE_BOOT_DONE);
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200481
Vladimir Kondratiev65082812014-07-14 09:49:37 +0300482 /* TODO: Erez check rev_id != 1 */
483 if (!is_sparrow && (rev_id != 1))
Vladimir Kondratiev17123992014-03-17 15:34:14 +0200484 W(RGF_PCIE_LOS_COUNTER_CTL, BIT(8));
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200485
Vladimir Kondratiev972072a2014-03-17 15:34:15 +0200486 C(RGF_USER_CLKS_CTL_0, BIT_USER_CLKS_RST_PWGD);
487
Vladimir Kondratiev520d68e2014-08-06 10:31:53 +0300488 wil_dbg_misc(wil, "Reset completed in %d ms\n", delay * RST_DELAY);
Vladimir Kondratievbbb2adc2014-08-06 10:31:52 +0300489 return 0;
Vladimir Kondratiev151a9702014-09-10 16:34:30 +0300490}
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800491
Vladimir Kondratievb6b1b0e2014-09-22 15:31:41 +0300492/**
493 * wil_set_itr_trsh: - apply interrupt coalescing params
494 */
495void wil_set_itr_trsh(struct wil6210_priv *wil)
496{
497 /* disable, use usec resolution */
498 W(RGF_DMA_ITR_CNT_CRL, BIT_DMA_ITR_CNT_CRL_EXT_TICK);
499
500 /* disable interrupt moderation for monitor
501 * to get better timestamp precision
502 */
503 if (wil->wdev->iftype == NL80211_IFTYPE_MONITOR)
504 return;
505
506 wil_info(wil, "set ITR_TRSH = %d usec\n", wil->itr_trsh);
507 W(RGF_DMA_ITR_CNT_TRSH, wil->itr_trsh);
508 W(RGF_DMA_ITR_CNT_CRL, BIT_DMA_ITR_CNT_CRL_EN |
509 BIT_DMA_ITR_CNT_CRL_EXT_TICK); /* start it */
510}
511
Vladimir Kondratiev36b10a72014-03-17 15:34:10 +0200512#undef R
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800513#undef W
514#undef S
Vladimir Kondratiev972072a2014-03-17 15:34:15 +0200515#undef C
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800516
517void wil_mbox_ring_le2cpus(struct wil6210_mbox_ring *r)
518{
519 le32_to_cpus(&r->base);
520 le16_to_cpus(&r->entry_size);
521 le16_to_cpus(&r->size);
522 le32_to_cpus(&r->tail);
523 le32_to_cpus(&r->head);
524}
525
526static int wil_wait_for_fw_ready(struct wil6210_priv *wil)
527{
528 ulong to = msecs_to_jiffies(1000);
529 ulong left = wait_for_completion_timeout(&wil->wmi_ready, to);
Vladimir Kondratiev8fe59622014-09-10 16:34:34 +0300530
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800531 if (0 == left) {
532 wil_err(wil, "Firmware not ready\n");
533 return -ETIME;
534 } else {
Vladimir Kondratiev15e23122014-04-08 11:36:16 +0300535 wil_info(wil, "FW ready after %d ms. HW version 0x%08x\n",
536 jiffies_to_msecs(to-left), wil->hw_version);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800537 }
538 return 0;
539}
540
541/*
542 * We reset all the structures, and we reset the UMAC.
543 * After calling this routine, you're expected to reload
544 * the firmware.
545 */
546int wil_reset(struct wil6210_priv *wil)
547{
548 int rc;
549
Vladimir Kondratiev9cf10d62014-09-10 16:34:36 +0300550 wil_dbg_misc(wil, "%s()\n", __func__);
551
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200552 WARN_ON(!mutex_is_locked(&wil->mutex));
Vladimir Kondratiev73d839a2014-09-10 16:34:50 +0300553 WARN_ON(test_bit(wil_status_napi_en, &wil->status));
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200554
555 cancel_work_sync(&wil->disconnect_worker);
556 wil6210_disconnect(wil, NULL);
557
Vladimir Kondratiev0fef1812014-03-17 15:34:18 +0200558 wil->status = 0; /* prevent NAPI from being scheduled */
Vladimir Kondratiev0fef1812014-03-17 15:34:18 +0200559
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200560 if (wil->scan_request) {
561 wil_dbg_misc(wil, "Abort scan_request 0x%p\n",
562 wil->scan_request);
Vladimir Kondratiev047e5d72014-05-27 14:45:48 +0300563 del_timer_sync(&wil->scan_timer);
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200564 cfg80211_scan_done(wil->scan_request, true);
565 wil->scan_request = NULL;
566 }
567
Vladimir Kondratieve4dbb092014-09-10 16:34:49 +0300568 wil_mask_irq(wil);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800569
Vladimir Kondratieve08b5902013-01-28 18:31:05 +0200570 wmi_event_flush(wil);
571
572 flush_workqueue(wil->wmi_wq_conn);
573 flush_workqueue(wil->wmi_wq);
574
Vladimir Kondratievbbb2adc2014-08-06 10:31:52 +0300575 rc = wil_target_reset(wil);
Vladimir Kondratiev8bf6adb2014-03-17 15:34:17 +0200576 wil_rx_fini(wil);
Vladimir Kondratievbbb2adc2014-08-06 10:31:52 +0300577 if (rc)
578 return rc;
579
Vladimir Kondratiev151a9702014-09-10 16:34:30 +0300580 if (!no_fw_load) {
581 wil_info(wil, "Use firmware <%s>\n", WIL_FW_NAME);
582 wil_halt_cpu(wil);
583 /* Loading f/w from the file */
584 rc = wil_request_firmware(wil, WIL_FW_NAME);
585 if (rc)
586 return rc;
587
588 /* clear any interrupts which on-card-firmware may have set */
589 wil6210_clear_irq(wil);
590 { /* CAF_ICR - clear and mask */
591 u32 a = HOSTADDR(RGF_CAF_ICR) +
592 offsetof(struct RGF_ICR, ICR);
593 u32 m = HOSTADDR(RGF_CAF_ICR) +
594 offsetof(struct RGF_ICR, IMV);
595 u32 icr = ioread32(wil->csr + a);
596
597 iowrite32(icr, wil->csr + a); /* W1C */
598 iowrite32(~0, wil->csr + m);
599 wmb(); /* wait for completion */
600 }
601 wil_release_cpu(wil);
602 } else {
603 wil_info(wil, "Use firmware from on-card flash\n");
604 }
Vladimir Kondratiev8bf6adb2014-03-17 15:34:17 +0200605
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800606 /* init after reset */
607 wil->pending_connect_cid = -1;
Wolfram Sang16735d02013-11-14 14:32:02 -0800608 reinit_completion(&wil->wmi_ready);
Dedy Lansky59502642014-09-10 16:34:46 +0300609 reinit_completion(&wil->wmi_call);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800610
Vladimir Kondratieve4dbb092014-09-10 16:34:49 +0300611 wil_unmask_irq(wil);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800612
613 /* we just started MAC, wait for FW ready */
614 rc = wil_wait_for_fw_ready(wil);
615
616 return rc;
617}
618
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200619void wil_fw_error_recovery(struct wil6210_priv *wil)
620{
621 wil_dbg_misc(wil, "starting fw error recovery\n");
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300622 wil->recovery_state = fw_recovery_pending;
Vladimir Kondratieved6f9dc2014-03-17 15:34:19 +0200623 schedule_work(&wil->fw_error_worker);
624}
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800625
626void wil_link_on(struct wil6210_priv *wil)
627{
628 struct net_device *ndev = wil_to_ndev(wil);
629
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200630 wil_dbg_misc(wil, "%s()\n", __func__);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800631
632 netif_carrier_on(ndev);
Vladimir Kondratiev55f8f682014-06-16 19:37:23 +0300633 wil_dbg_misc(wil, "netif_tx_wake : link on\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800634 netif_tx_wake_all_queues(ndev);
635}
636
637void wil_link_off(struct wil6210_priv *wil)
638{
639 struct net_device *ndev = wil_to_ndev(wil);
640
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200641 wil_dbg_misc(wil, "%s()\n", __func__);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800642
643 netif_tx_stop_all_queues(ndev);
Vladimir Kondratiev55f8f682014-06-16 19:37:23 +0300644 wil_dbg_misc(wil, "netif_tx_stop : link off\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800645 netif_carrier_off(ndev);
646}
647
Vladimir Kondratiev73d839a2014-09-10 16:34:50 +0300648int __wil_up(struct wil6210_priv *wil)
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800649{
650 struct net_device *ndev = wil_to_ndev(wil);
651 struct wireless_dev *wdev = wil->wdev;
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800652 int rc;
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800653
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200654 WARN_ON(!mutex_is_locked(&wil->mutex));
655
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800656 rc = wil_reset(wil);
657 if (rc)
658 return rc;
659
Vladimir Kondratieve31b2562013-06-09 09:12:55 +0300660 /* Rx VRING. After MAC and beacon */
661 rc = wil_rx_init(wil);
662 if (rc)
663 return rc;
664
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800665 switch (wdev->iftype) {
666 case NL80211_IFTYPE_STATION:
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200667 wil_dbg_misc(wil, "type: STATION\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800668 ndev->type = ARPHRD_ETHER;
669 break;
670 case NL80211_IFTYPE_AP:
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200671 wil_dbg_misc(wil, "type: AP\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800672 ndev->type = ARPHRD_ETHER;
673 break;
674 case NL80211_IFTYPE_P2P_CLIENT:
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200675 wil_dbg_misc(wil, "type: P2P_CLIENT\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800676 ndev->type = ARPHRD_ETHER;
677 break;
678 case NL80211_IFTYPE_P2P_GO:
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200679 wil_dbg_misc(wil, "type: P2P_GO\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800680 ndev->type = ARPHRD_ETHER;
681 break;
682 case NL80211_IFTYPE_MONITOR:
Vladimir Kondratiev77438822013-01-28 18:31:06 +0200683 wil_dbg_misc(wil, "type: Monitor\n");
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800684 ndev->type = ARPHRD_IEEE80211_RADIOTAP;
685 /* ARPHRD_IEEE80211 or ARPHRD_IEEE80211_RADIOTAP ? */
686 break;
687 default:
688 return -EOPNOTSUPP;
689 }
690
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800691 /* MAC address - pre-requisite for other commands */
692 wmi_set_mac_address(wil, ndev->dev_addr);
693
Vladimir Kondratiev73d839a2014-09-10 16:34:50 +0300694 wil_dbg_misc(wil, "NAPI enable\n");
Vladimir Kondratieve0287c42013-05-12 14:43:36 +0300695 napi_enable(&wil->napi_rx);
696 napi_enable(&wil->napi_tx);
Vladimir Kondratiev0fef1812014-03-17 15:34:18 +0200697 set_bit(wil_status_napi_en, &wil->status);
Vladimir Kondratieve0287c42013-05-12 14:43:36 +0300698
Vladimir Kondratievf772ebf2014-09-10 16:34:35 +0300699 if (wil->platform_ops.bus_request)
700 wil->platform_ops.bus_request(wil->platform_handle,
701 WIL_MAX_BUS_REQUEST_KBPS);
702
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800703 return 0;
704}
705
706int wil_up(struct wil6210_priv *wil)
707{
708 int rc;
709
Vladimir Kondratiev9cf10d62014-09-10 16:34:36 +0300710 wil_dbg_misc(wil, "%s()\n", __func__);
711
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800712 mutex_lock(&wil->mutex);
713 rc = __wil_up(wil);
714 mutex_unlock(&wil->mutex);
715
716 return rc;
717}
718
Vladimir Kondratiev73d839a2014-09-10 16:34:50 +0300719int __wil_down(struct wil6210_priv *wil)
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800720{
Dedy Lanskyf172b562014-09-10 16:34:38 +0300721 int iter = WAIT_FOR_DISCONNECT_TIMEOUT_MS /
722 WAIT_FOR_DISCONNECT_INTERVAL_MS;
723
Vladimir Kondratiev097638a2014-03-17 15:34:25 +0200724 WARN_ON(!mutex_is_locked(&wil->mutex));
725
Vladimir Kondratievf772ebf2014-09-10 16:34:35 +0300726 if (wil->platform_ops.bus_request)
727 wil->platform_ops.bus_request(wil->platform_handle, 0);
728
Vladimir Kondratiev73d839a2014-09-10 16:34:50 +0300729 wil_disable_irq(wil);
730 if (test_and_clear_bit(wil_status_napi_en, &wil->status)) {
731 napi_disable(&wil->napi_rx);
732 napi_disable(&wil->napi_tx);
733 wil_dbg_misc(wil, "NAPI disable\n");
734 }
735 wil_enable_irq(wil);
Vladimir Kondratieve0287c42013-05-12 14:43:36 +0300736
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800737 if (wil->scan_request) {
Vladimir Kondratiev2a91d7d2014-06-16 19:37:11 +0300738 wil_dbg_misc(wil, "Abort scan_request 0x%p\n",
739 wil->scan_request);
Vladimir Kondratiev047e5d72014-05-27 14:45:48 +0300740 del_timer_sync(&wil->scan_timer);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800741 cfg80211_scan_done(wil->scan_request, true);
742 wil->scan_request = NULL;
743 }
744
Dedy Lanskyf172b562014-09-10 16:34:38 +0300745 if (test_bit(wil_status_fwconnected, &wil->status) ||
746 test_bit(wil_status_fwconnecting, &wil->status))
747 wmi_send(wil, WMI_DISCONNECT_CMDID, NULL, 0);
748
749 /* make sure wil is idle (not connected) */
750 mutex_unlock(&wil->mutex);
751 while (iter--) {
752 int idle = !test_bit(wil_status_fwconnected, &wil->status) &&
753 !test_bit(wil_status_fwconnecting, &wil->status);
754 if (idle)
755 break;
756 msleep(WAIT_FOR_DISCONNECT_INTERVAL_MS);
757 }
758 mutex_lock(&wil->mutex);
759
760 if (!iter)
761 wil_err(wil, "timeout waiting for idle FW/HW\n");
762
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800763 wil_rx_fini(wil);
764
765 return 0;
766}
767
768int wil_down(struct wil6210_priv *wil)
769{
770 int rc;
771
Vladimir Kondratiev9cf10d62014-09-10 16:34:36 +0300772 wil_dbg_misc(wil, "%s()\n", __func__);
773
Vladimir Kondratievc33407a2014-10-01 15:05:24 +0300774 wil_set_recovery_state(wil, fw_recovery_idle);
Vladimir Kondratiev2be7d222012-12-20 13:13:19 -0800775 mutex_lock(&wil->mutex);
776 rc = __wil_down(wil);
777 mutex_unlock(&wil->mutex);
778
779 return rc;
780}
Vladimir Kondratiev3df2cd362014-02-27 16:20:43 +0200781
782int wil_find_cid(struct wil6210_priv *wil, const u8 *mac)
783{
784 int i;
785 int rc = -ENOENT;
786
787 for (i = 0; i < ARRAY_SIZE(wil->sta); i++) {
788 if ((wil->sta[i].status != wil_sta_unused) &&
Vladimir Kondratiev108d1eb2014-02-27 16:20:53 +0200789 ether_addr_equal(wil->sta[i].addr, mac)) {
Vladimir Kondratiev3df2cd362014-02-27 16:20:43 +0200790 rc = i;
791 break;
792 }
793 }
794
795 return rc;
796}