Commit | Line | Data |
---|---|---|
b7d572e1 PF |
1 | /* |
2 | * Copyright (c) 2006 Damien Bergamini <damien.bergamini@free.fr> | |
3 | * Copyright (c) 2006 Sam Leffler, Errno Consulting | |
4 | * Copyright (c) 2007 Christoph Hellwig <hch@lst.de> | |
5 | * Copyright (c) 2008-2009 Weongyo Jeong <weongyo@freebsd.org> | |
6 | * Copyright (c) 2012 Pontus Fuchs <pontus.fuchs@gmail.com> | |
7 | * | |
8 | * Permission to use, copy, modify, and/or distribute this software for any | |
9 | * purpose with or without fee is hereby granted, provided that the above | |
10 | * copyright notice and this permission notice appear in all copies. | |
11 | * | |
12 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES | |
13 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF | |
14 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR | |
15 | * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES | |
16 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN | |
17 | * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF | |
18 | * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. | |
19 | */ | |
20 | ||
21 | /* | |
22 | * This driver is based on the uath driver written by Damien Bergamini for | |
23 | * OpenBSD, who did black-box analysis of the Windows binary driver to find | |
24 | * out how the hardware works. It contains a lot magic numbers because of | |
25 | * that and only has minimal functionality. | |
26 | */ | |
27 | #include <linux/compiler.h> | |
b7d572e1 PF |
28 | #include <linux/kernel.h> |
29 | #include <linux/module.h> | |
30 | #include <linux/list.h> | |
31 | #include <linux/completion.h> | |
32 | #include <linux/firmware.h> | |
33 | #include <linux/skbuff.h> | |
34 | #include <linux/usb.h> | |
35 | #include <net/mac80211.h> | |
36 | ||
37 | #include "ar5523.h" | |
38 | #include "ar5523_hw.h" | |
39 | ||
40 | /* | |
41 | * Various supported device vendors/products. | |
42 | * UB51: AR5005UG 802.11b/g, UB52: AR5005UX 802.11a/b/g | |
43 | */ | |
44 | ||
45 | static int ar5523_submit_rx_cmd(struct ar5523 *ar); | |
46 | static void ar5523_data_tx_pkt_put(struct ar5523 *ar); | |
47 | ||
48 | static void ar5523_read_reply(struct ar5523 *ar, struct ar5523_cmd_hdr *hdr, | |
49 | struct ar5523_tx_cmd *cmd) | |
50 | { | |
51 | int dlen, olen; | |
d01a303e | 52 | __be32 *rp; |
b7d572e1 | 53 | |
d01a303e | 54 | dlen = be32_to_cpu(hdr->len) - sizeof(*hdr); |
b7d572e1 PF |
55 | |
56 | if (dlen < 0) { | |
57 | WARN_ON(1); | |
58 | goto out; | |
59 | } | |
60 | ||
d01a303e PF |
61 | ar5523_dbg(ar, "Code = %d len = %d\n", be32_to_cpu(hdr->code) & 0xff, |
62 | dlen); | |
b7d572e1 | 63 | |
d01a303e | 64 | rp = (__be32 *)(hdr + 1); |
b7d572e1 PF |
65 | if (dlen >= sizeof(u32)) { |
66 | olen = be32_to_cpu(rp[0]); | |
67 | dlen -= sizeof(u32); | |
68 | if (olen == 0) { | |
69 | /* convention is 0 =>'s one word */ | |
70 | olen = sizeof(u32); | |
71 | } | |
72 | } else | |
73 | olen = 0; | |
74 | ||
75 | if (cmd->odata) { | |
76 | if (cmd->olen < olen) { | |
77 | ar5523_err(ar, "olen to small %d < %d\n", | |
78 | cmd->olen, olen); | |
79 | cmd->olen = 0; | |
80 | cmd->res = -EOVERFLOW; | |
81 | } else { | |
82 | cmd->olen = olen; | |
83 | memcpy(cmd->odata, &rp[1], olen); | |
84 | cmd->res = 0; | |
85 | } | |
86 | } | |
87 | ||
88 | out: | |
89 | complete(&cmd->done); | |
90 | } | |
91 | ||
92 | static void ar5523_cmd_rx_cb(struct urb *urb) | |
93 | { | |
94 | struct ar5523 *ar = urb->context; | |
95 | struct ar5523_tx_cmd *cmd = &ar->tx_cmd; | |
96 | struct ar5523_cmd_hdr *hdr = ar->rx_cmd_buf; | |
97 | int dlen; | |
d01a303e | 98 | u32 code, hdrlen; |
b7d572e1 PF |
99 | |
100 | if (urb->status) { | |
101 | if (urb->status != -ESHUTDOWN) | |
102 | ar5523_err(ar, "RX USB error %d.\n", urb->status); | |
103 | goto skip; | |
104 | } | |
105 | ||
106 | if (urb->actual_length < sizeof(struct ar5523_cmd_hdr)) { | |
107 | ar5523_err(ar, "RX USB to short.\n"); | |
108 | goto skip; | |
109 | } | |
110 | ||
111 | ar5523_dbg(ar, "%s code %02x priv %d\n", __func__, | |
112 | be32_to_cpu(hdr->code) & 0xff, hdr->priv); | |
113 | ||
d01a303e PF |
114 | code = be32_to_cpu(hdr->code); |
115 | hdrlen = be32_to_cpu(hdr->len); | |
b7d572e1 | 116 | |
d01a303e | 117 | switch (code & 0xff) { |
b7d572e1 PF |
118 | default: |
119 | /* reply to a read command */ | |
120 | if (hdr->priv != AR5523_CMD_ID) { | |
121 | ar5523_err(ar, "Unexpected command id: %02x\n", | |
d01a303e | 122 | code & 0xff); |
b7d572e1 PF |
123 | goto skip; |
124 | } | |
125 | ar5523_read_reply(ar, hdr, cmd); | |
126 | break; | |
127 | ||
128 | case WDCMSG_DEVICE_AVAIL: | |
129 | ar5523_dbg(ar, "WDCMSG_DEVICE_AVAIL\n"); | |
130 | cmd->res = 0; | |
131 | cmd->olen = 0; | |
132 | complete(&cmd->done); | |
133 | break; | |
134 | ||
135 | case WDCMSG_SEND_COMPLETE: | |
136 | ar5523_dbg(ar, "WDCMSG_SEND_COMPLETE: %d pending\n", | |
137 | atomic_read(&ar->tx_nr_pending)); | |
138 | if (!test_bit(AR5523_HW_UP, &ar->flags)) | |
139 | ar5523_dbg(ar, "Unexpected WDCMSG_SEND_COMPLETE\n"); | |
140 | else { | |
141 | mod_timer(&ar->tx_wd_timer, | |
142 | jiffies + AR5523_TX_WD_TIMEOUT); | |
143 | ar5523_data_tx_pkt_put(ar); | |
144 | ||
145 | } | |
146 | break; | |
147 | ||
148 | case WDCMSG_TARGET_START: | |
149 | /* This command returns a bogus id so it needs special | |
150 | handling */ | |
d01a303e | 151 | dlen = hdrlen - sizeof(*hdr); |
b7d572e1 PF |
152 | if (dlen != (int)sizeof(u32)) { |
153 | ar5523_err(ar, "Invalid reply to WDCMSG_TARGET_START"); | |
154 | return; | |
155 | } | |
156 | memcpy(cmd->odata, hdr + 1, sizeof(u32)); | |
157 | cmd->olen = sizeof(u32); | |
158 | cmd->res = 0; | |
159 | complete(&cmd->done); | |
160 | break; | |
161 | ||
162 | case WDCMSG_STATS_UPDATE: | |
163 | ar5523_dbg(ar, "WDCMSG_STATS_UPDATE\n"); | |
164 | break; | |
165 | } | |
166 | ||
167 | skip: | |
168 | ar5523_submit_rx_cmd(ar); | |
169 | } | |
170 | ||
171 | static int ar5523_alloc_rx_cmd(struct ar5523 *ar) | |
172 | { | |
173 | ar->rx_cmd_urb = usb_alloc_urb(0, GFP_KERNEL); | |
174 | if (!ar->rx_cmd_urb) | |
175 | return -ENOMEM; | |
176 | ||
177 | ar->rx_cmd_buf = usb_alloc_coherent(ar->dev, AR5523_MAX_RXCMDSZ, | |
178 | GFP_KERNEL, | |
179 | &ar->rx_cmd_urb->transfer_dma); | |
180 | if (!ar->rx_cmd_buf) { | |
181 | usb_free_urb(ar->rx_cmd_urb); | |
182 | return -ENOMEM; | |
183 | } | |
184 | return 0; | |
185 | } | |
186 | ||
187 | static void ar5523_cancel_rx_cmd(struct ar5523 *ar) | |
188 | { | |
189 | usb_kill_urb(ar->rx_cmd_urb); | |
190 | } | |
191 | ||
192 | static void ar5523_free_rx_cmd(struct ar5523 *ar) | |
193 | { | |
194 | usb_free_coherent(ar->dev, AR5523_MAX_RXCMDSZ, | |
195 | ar->rx_cmd_buf, ar->rx_cmd_urb->transfer_dma); | |
196 | usb_free_urb(ar->rx_cmd_urb); | |
197 | } | |
198 | ||
199 | static int ar5523_submit_rx_cmd(struct ar5523 *ar) | |
200 | { | |
201 | int error; | |
202 | ||
203 | usb_fill_bulk_urb(ar->rx_cmd_urb, ar->dev, | |
204 | ar5523_cmd_rx_pipe(ar->dev), ar->rx_cmd_buf, | |
205 | AR5523_MAX_RXCMDSZ, ar5523_cmd_rx_cb, ar); | |
206 | ar->rx_cmd_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | |
207 | ||
208 | error = usb_submit_urb(ar->rx_cmd_urb, GFP_ATOMIC); | |
209 | if (error) { | |
210 | if (error != -ENODEV) | |
211 | ar5523_err(ar, "error %d when submitting rx urb\n", | |
212 | error); | |
213 | return error; | |
214 | } | |
215 | return 0; | |
216 | } | |
217 | ||
218 | /* | |
219 | * Command submitted cb | |
220 | */ | |
221 | static void ar5523_cmd_tx_cb(struct urb *urb) | |
222 | { | |
223 | struct ar5523_tx_cmd *cmd = urb->context; | |
224 | struct ar5523 *ar = cmd->ar; | |
225 | ||
226 | if (urb->status) { | |
227 | ar5523_err(ar, "Failed to TX command. Status = %d\n", | |
228 | urb->status); | |
229 | cmd->res = urb->status; | |
230 | complete(&cmd->done); | |
231 | return; | |
232 | } | |
233 | ||
234 | if (!(cmd->flags & AR5523_CMD_FLAG_READ)) { | |
235 | cmd->res = 0; | |
236 | complete(&cmd->done); | |
237 | } | |
238 | } | |
239 | ||
240 | static int ar5523_cmd(struct ar5523 *ar, u32 code, const void *idata, | |
241 | int ilen, void *odata, int olen, int flags) | |
242 | { | |
243 | struct ar5523_cmd_hdr *hdr; | |
244 | struct ar5523_tx_cmd *cmd = &ar->tx_cmd; | |
245 | int xferlen, error; | |
246 | ||
247 | /* always bulk-out a multiple of 4 bytes */ | |
248 | xferlen = (sizeof(struct ar5523_cmd_hdr) + ilen + 3) & ~3; | |
249 | ||
250 | hdr = (struct ar5523_cmd_hdr *)cmd->buf_tx; | |
251 | memset(hdr, 0, sizeof(struct ar5523_cmd_hdr)); | |
252 | hdr->len = cpu_to_be32(xferlen); | |
253 | hdr->code = cpu_to_be32(code); | |
254 | hdr->priv = AR5523_CMD_ID; | |
255 | ||
256 | if (flags & AR5523_CMD_FLAG_MAGIC) | |
257 | hdr->magic = cpu_to_be32(1 << 24); | |
258 | memcpy(hdr + 1, idata, ilen); | |
259 | ||
260 | cmd->odata = odata; | |
261 | cmd->olen = olen; | |
262 | cmd->flags = flags; | |
263 | ||
264 | ar5523_dbg(ar, "do cmd %02x\n", code); | |
265 | ||
266 | usb_fill_bulk_urb(cmd->urb_tx, ar->dev, ar5523_cmd_tx_pipe(ar->dev), | |
267 | cmd->buf_tx, xferlen, ar5523_cmd_tx_cb, cmd); | |
268 | cmd->urb_tx->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | |
269 | ||
270 | error = usb_submit_urb(cmd->urb_tx, GFP_KERNEL); | |
271 | if (error) { | |
272 | ar5523_err(ar, "could not send command 0x%x, error=%d\n", | |
273 | code, error); | |
274 | return error; | |
275 | } | |
276 | ||
277 | if (!wait_for_completion_timeout(&cmd->done, 2 * HZ)) { | |
278 | cmd->odata = NULL; | |
279 | ar5523_err(ar, "timeout waiting for command %02x reply\n", | |
280 | code); | |
281 | cmd->res = -ETIMEDOUT; | |
282 | } | |
283 | return cmd->res; | |
284 | } | |
285 | ||
286 | static int ar5523_cmd_write(struct ar5523 *ar, u32 code, const void *data, | |
287 | int len, int flags) | |
288 | { | |
289 | flags &= ~AR5523_CMD_FLAG_READ; | |
290 | return ar5523_cmd(ar, code, data, len, NULL, 0, flags); | |
291 | } | |
292 | ||
293 | static int ar5523_cmd_read(struct ar5523 *ar, u32 code, const void *idata, | |
294 | int ilen, void *odata, int olen, int flags) | |
295 | { | |
296 | flags |= AR5523_CMD_FLAG_READ; | |
297 | return ar5523_cmd(ar, code, idata, ilen, odata, olen, flags); | |
298 | } | |
299 | ||
300 | static int ar5523_config(struct ar5523 *ar, u32 reg, u32 val) | |
301 | { | |
302 | struct ar5523_write_mac write; | |
303 | int error; | |
304 | ||
305 | write.reg = cpu_to_be32(reg); | |
306 | write.len = cpu_to_be32(0); /* 0 = single write */ | |
d01a303e | 307 | *(__be32 *)write.data = cpu_to_be32(val); |
b7d572e1 PF |
308 | |
309 | error = ar5523_cmd_write(ar, WDCMSG_TARGET_SET_CONFIG, &write, | |
310 | 3 * sizeof(u32), 0); | |
311 | if (error != 0) | |
312 | ar5523_err(ar, "could not write register 0x%02x\n", reg); | |
313 | return error; | |
314 | } | |
315 | ||
316 | static int ar5523_config_multi(struct ar5523 *ar, u32 reg, const void *data, | |
317 | int len) | |
318 | { | |
319 | struct ar5523_write_mac write; | |
320 | int error; | |
321 | ||
322 | write.reg = cpu_to_be32(reg); | |
323 | write.len = cpu_to_be32(len); | |
324 | memcpy(write.data, data, len); | |
325 | ||
326 | /* properly handle the case where len is zero (reset) */ | |
327 | error = ar5523_cmd_write(ar, WDCMSG_TARGET_SET_CONFIG, &write, | |
328 | (len == 0) ? sizeof(u32) : 2 * sizeof(u32) + len, 0); | |
329 | if (error != 0) | |
330 | ar5523_err(ar, "could not write %d bytes to register 0x%02x\n", | |
331 | len, reg); | |
332 | return error; | |
333 | } | |
334 | ||
335 | static int ar5523_get_status(struct ar5523 *ar, u32 which, void *odata, | |
336 | int olen) | |
337 | { | |
338 | int error; | |
d01a303e | 339 | __be32 which_be; |
b7d572e1 | 340 | |
d01a303e | 341 | which_be = cpu_to_be32(which); |
b7d572e1 | 342 | error = ar5523_cmd_read(ar, WDCMSG_TARGET_GET_STATUS, |
d01a303e | 343 | &which_be, sizeof(which_be), odata, olen, AR5523_CMD_FLAG_MAGIC); |
b7d572e1 | 344 | if (error != 0) |
d01a303e | 345 | ar5523_err(ar, "could not read EEPROM offset 0x%02x\n", which); |
b7d572e1 PF |
346 | return error; |
347 | } | |
348 | ||
349 | static int ar5523_get_capability(struct ar5523 *ar, u32 cap, u32 *val) | |
350 | { | |
351 | int error; | |
d01a303e | 352 | __be32 cap_be, val_be; |
b7d572e1 | 353 | |
d01a303e PF |
354 | cap_be = cpu_to_be32(cap); |
355 | error = ar5523_cmd_read(ar, WDCMSG_TARGET_GET_CAPABILITY, &cap_be, | |
356 | sizeof(cap_be), &val_be, sizeof(__be32), | |
357 | AR5523_CMD_FLAG_MAGIC); | |
b7d572e1 | 358 | if (error != 0) { |
d01a303e | 359 | ar5523_err(ar, "could not read capability %u\n", cap); |
b7d572e1 PF |
360 | return error; |
361 | } | |
d01a303e | 362 | *val = be32_to_cpu(val_be); |
b7d572e1 PF |
363 | return error; |
364 | } | |
365 | ||
366 | static int ar5523_get_devcap(struct ar5523 *ar) | |
367 | { | |
368 | #define GETCAP(x) do { \ | |
369 | error = ar5523_get_capability(ar, x, &cap); \ | |
370 | if (error != 0) \ | |
371 | return error; \ | |
372 | ar5523_info(ar, "Cap: " \ | |
373 | "%s=0x%08x\n", #x, cap); \ | |
374 | } while (0) | |
375 | int error; | |
376 | u32 cap; | |
377 | ||
378 | /* collect device capabilities */ | |
379 | GETCAP(CAP_TARGET_VERSION); | |
380 | GETCAP(CAP_TARGET_REVISION); | |
381 | GETCAP(CAP_MAC_VERSION); | |
382 | GETCAP(CAP_MAC_REVISION); | |
383 | GETCAP(CAP_PHY_REVISION); | |
384 | GETCAP(CAP_ANALOG_5GHz_REVISION); | |
385 | GETCAP(CAP_ANALOG_2GHz_REVISION); | |
386 | ||
387 | GETCAP(CAP_REG_DOMAIN); | |
388 | GETCAP(CAP_REG_CAP_BITS); | |
389 | GETCAP(CAP_WIRELESS_MODES); | |
390 | GETCAP(CAP_CHAN_SPREAD_SUPPORT); | |
391 | GETCAP(CAP_COMPRESS_SUPPORT); | |
392 | GETCAP(CAP_BURST_SUPPORT); | |
393 | GETCAP(CAP_FAST_FRAMES_SUPPORT); | |
394 | GETCAP(CAP_CHAP_TUNING_SUPPORT); | |
395 | GETCAP(CAP_TURBOG_SUPPORT); | |
396 | GETCAP(CAP_TURBO_PRIME_SUPPORT); | |
397 | GETCAP(CAP_DEVICE_TYPE); | |
398 | GETCAP(CAP_WME_SUPPORT); | |
399 | GETCAP(CAP_TOTAL_QUEUES); | |
400 | GETCAP(CAP_CONNECTION_ID_MAX); | |
401 | ||
402 | GETCAP(CAP_LOW_5GHZ_CHAN); | |
403 | GETCAP(CAP_HIGH_5GHZ_CHAN); | |
404 | GETCAP(CAP_LOW_2GHZ_CHAN); | |
405 | GETCAP(CAP_HIGH_2GHZ_CHAN); | |
406 | GETCAP(CAP_TWICE_ANTENNAGAIN_5G); | |
407 | GETCAP(CAP_TWICE_ANTENNAGAIN_2G); | |
408 | ||
409 | GETCAP(CAP_CIPHER_AES_CCM); | |
410 | GETCAP(CAP_CIPHER_TKIP); | |
411 | GETCAP(CAP_MIC_TKIP); | |
412 | return 0; | |
413 | } | |
414 | ||
415 | static int ar5523_set_ledsteady(struct ar5523 *ar, int lednum, int ledmode) | |
416 | { | |
417 | struct ar5523_cmd_ledsteady led; | |
418 | ||
419 | led.lednum = cpu_to_be32(lednum); | |
420 | led.ledmode = cpu_to_be32(ledmode); | |
421 | ||
422 | ar5523_dbg(ar, "set %s led %s (steady)\n", | |
423 | (lednum == UATH_LED_LINK) ? "link" : "activity", | |
424 | ledmode ? "on" : "off"); | |
425 | return ar5523_cmd_write(ar, WDCMSG_SET_LED_STEADY, &led, sizeof(led), | |
426 | 0); | |
427 | } | |
428 | ||
429 | static int ar5523_set_rxfilter(struct ar5523 *ar, u32 bits, u32 op) | |
430 | { | |
431 | struct ar5523_cmd_rx_filter rxfilter; | |
432 | ||
433 | rxfilter.bits = cpu_to_be32(bits); | |
434 | rxfilter.op = cpu_to_be32(op); | |
435 | ||
436 | ar5523_dbg(ar, "setting Rx filter=0x%x flags=0x%x\n", bits, op); | |
437 | return ar5523_cmd_write(ar, WDCMSG_RX_FILTER, &rxfilter, | |
438 | sizeof(rxfilter), 0); | |
439 | } | |
440 | ||
441 | static int ar5523_reset_tx_queues(struct ar5523 *ar) | |
442 | { | |
443 | __be32 qid = cpu_to_be32(0); | |
444 | ||
445 | ar5523_dbg(ar, "resetting Tx queue\n"); | |
446 | return ar5523_cmd_write(ar, WDCMSG_RELEASE_TX_QUEUE, | |
447 | &qid, sizeof(qid), 0); | |
448 | } | |
449 | ||
450 | static int ar5523_set_chan(struct ar5523 *ar) | |
451 | { | |
452 | struct ieee80211_conf *conf = &ar->hw->conf; | |
453 | ||
454 | struct ar5523_cmd_reset reset; | |
455 | ||
456 | memset(&reset, 0, sizeof(reset)); | |
457 | reset.flags |= cpu_to_be32(UATH_CHAN_2GHZ); | |
458 | reset.flags |= cpu_to_be32(UATH_CHAN_OFDM); | |
675a0b04 | 459 | reset.freq = cpu_to_be32(conf->chandef.chan->center_freq); |
b7d572e1 PF |
460 | reset.maxrdpower = cpu_to_be32(50); /* XXX */ |
461 | reset.channelchange = cpu_to_be32(1); | |
462 | reset.keeprccontent = cpu_to_be32(0); | |
463 | ||
464 | ar5523_dbg(ar, "set chan flags 0x%x freq %d\n", | |
465 | be32_to_cpu(reset.flags), | |
675a0b04 | 466 | conf->chandef.chan->center_freq); |
b7d572e1 PF |
467 | return ar5523_cmd_write(ar, WDCMSG_RESET, &reset, sizeof(reset), 0); |
468 | } | |
469 | ||
470 | static int ar5523_queue_init(struct ar5523 *ar) | |
471 | { | |
472 | struct ar5523_cmd_txq_setup qinfo; | |
473 | ||
474 | ar5523_dbg(ar, "setting up Tx queue\n"); | |
475 | qinfo.qid = cpu_to_be32(0); | |
476 | qinfo.len = cpu_to_be32(sizeof(qinfo.attr)); | |
477 | qinfo.attr.priority = cpu_to_be32(0); /* XXX */ | |
478 | qinfo.attr.aifs = cpu_to_be32(3); | |
479 | qinfo.attr.logcwmin = cpu_to_be32(4); | |
480 | qinfo.attr.logcwmax = cpu_to_be32(10); | |
481 | qinfo.attr.bursttime = cpu_to_be32(0); | |
482 | qinfo.attr.mode = cpu_to_be32(0); | |
483 | qinfo.attr.qflags = cpu_to_be32(1); /* XXX? */ | |
484 | return ar5523_cmd_write(ar, WDCMSG_SETUP_TX_QUEUE, &qinfo, | |
485 | sizeof(qinfo), 0); | |
486 | } | |
487 | ||
488 | static int ar5523_switch_chan(struct ar5523 *ar) | |
489 | { | |
490 | int error; | |
491 | ||
492 | error = ar5523_set_chan(ar); | |
493 | if (error) { | |
494 | ar5523_err(ar, "could not set chan, error %d\n", error); | |
495 | goto out_err; | |
496 | } | |
497 | ||
498 | /* reset Tx rings */ | |
499 | error = ar5523_reset_tx_queues(ar); | |
500 | if (error) { | |
501 | ar5523_err(ar, "could not reset Tx queues, error %d\n", | |
502 | error); | |
503 | goto out_err; | |
504 | } | |
505 | /* set Tx rings WME properties */ | |
506 | error = ar5523_queue_init(ar); | |
507 | if (error) | |
508 | ar5523_err(ar, "could not init wme, error %d\n", error); | |
509 | ||
510 | out_err: | |
511 | return error; | |
512 | } | |
513 | ||
514 | static void ar5523_rx_data_put(struct ar5523 *ar, | |
515 | struct ar5523_rx_data *data) | |
516 | { | |
517 | unsigned long flags; | |
518 | spin_lock_irqsave(&ar->rx_data_list_lock, flags); | |
519 | list_move(&data->list, &ar->rx_data_free); | |
520 | spin_unlock_irqrestore(&ar->rx_data_list_lock, flags); | |
521 | } | |
522 | ||
523 | static void ar5523_data_rx_cb(struct urb *urb) | |
524 | { | |
525 | struct ar5523_rx_data *data = urb->context; | |
526 | struct ar5523 *ar = data->ar; | |
527 | struct ar5523_rx_desc *desc; | |
528 | struct ar5523_chunk *chunk; | |
529 | struct ieee80211_hw *hw = ar->hw; | |
530 | struct ieee80211_rx_status *rx_status; | |
531 | u32 rxlen; | |
532 | int usblen = urb->actual_length; | |
533 | int hdrlen, pad; | |
534 | ||
535 | ar5523_dbg(ar, "%s\n", __func__); | |
536 | /* sync/async unlink faults aren't errors */ | |
537 | if (urb->status) { | |
538 | if (urb->status != -ESHUTDOWN) | |
539 | ar5523_err(ar, "%s: USB err: %d\n", __func__, | |
540 | urb->status); | |
541 | goto skip; | |
542 | } | |
543 | ||
544 | if (usblen < AR5523_MIN_RXBUFSZ) { | |
545 | ar5523_err(ar, "RX: wrong xfer size (usblen=%d)\n", usblen); | |
546 | goto skip; | |
547 | } | |
548 | ||
549 | chunk = (struct ar5523_chunk *) data->skb->data; | |
550 | ||
551 | if (((chunk->flags & UATH_CFLAGS_FINAL) == 0) || | |
552 | chunk->seqnum != 0) { | |
553 | ar5523_dbg(ar, "RX: No final flag. s: %d f: %02x l: %d\n", | |
554 | chunk->seqnum, chunk->flags, | |
555 | be16_to_cpu(chunk->length)); | |
556 | goto skip; | |
557 | } | |
558 | ||
559 | /* Rx descriptor is located at the end, 32-bit aligned */ | |
560 | desc = (struct ar5523_rx_desc *) | |
561 | (data->skb->data + usblen - sizeof(struct ar5523_rx_desc)); | |
562 | ||
563 | rxlen = be32_to_cpu(desc->len); | |
564 | if (rxlen > ar->rxbufsz) { | |
565 | ar5523_dbg(ar, "RX: Bad descriptor (len=%d)\n", | |
566 | be32_to_cpu(desc->len)); | |
567 | goto skip; | |
568 | } | |
569 | ||
570 | if (!rxlen) { | |
571 | ar5523_dbg(ar, "RX: rxlen is 0\n"); | |
572 | goto skip; | |
573 | } | |
574 | ||
575 | if (be32_to_cpu(desc->status) != 0) { | |
576 | ar5523_dbg(ar, "Bad RX status (0x%x len = %d). Skip\n", | |
577 | be32_to_cpu(desc->status), be32_to_cpu(desc->len)); | |
578 | goto skip; | |
579 | } | |
580 | ||
581 | skb_reserve(data->skb, sizeof(*chunk)); | |
582 | skb_put(data->skb, rxlen - sizeof(struct ar5523_rx_desc)); | |
583 | ||
584 | hdrlen = ieee80211_get_hdrlen_from_skb(data->skb); | |
585 | if (!IS_ALIGNED(hdrlen, 4)) { | |
586 | ar5523_dbg(ar, "eek, alignment workaround activated\n"); | |
587 | pad = ALIGN(hdrlen, 4) - hdrlen; | |
588 | memmove(data->skb->data + pad, data->skb->data, hdrlen); | |
589 | skb_pull(data->skb, pad); | |
590 | skb_put(data->skb, pad); | |
591 | } | |
592 | ||
593 | rx_status = IEEE80211_SKB_RXCB(data->skb); | |
594 | memset(rx_status, 0, sizeof(*rx_status)); | |
595 | rx_status->freq = be32_to_cpu(desc->channel); | |
675a0b04 | 596 | rx_status->band = hw->conf.chandef.chan->band; |
b7d572e1 PF |
597 | rx_status->signal = -95 + be32_to_cpu(desc->rssi); |
598 | ||
599 | ieee80211_rx_irqsafe(hw, data->skb); | |
600 | data->skb = NULL; | |
601 | ||
602 | skip: | |
603 | if (data->skb) { | |
604 | dev_kfree_skb_irq(data->skb); | |
605 | data->skb = NULL; | |
606 | } | |
607 | ||
608 | ar5523_rx_data_put(ar, data); | |
609 | if (atomic_inc_return(&ar->rx_data_free_cnt) >= | |
610 | AR5523_RX_DATA_REFILL_COUNT && | |
611 | test_bit(AR5523_HW_UP, &ar->flags)) | |
612 | queue_work(ar->wq, &ar->rx_refill_work); | |
613 | } | |
614 | ||
615 | static void ar5523_rx_refill_work(struct work_struct *work) | |
616 | { | |
617 | struct ar5523 *ar = container_of(work, struct ar5523, rx_refill_work); | |
618 | struct ar5523_rx_data *data; | |
619 | unsigned long flags; | |
620 | int error; | |
621 | ||
622 | ar5523_dbg(ar, "%s\n", __func__); | |
623 | do { | |
624 | spin_lock_irqsave(&ar->rx_data_list_lock, flags); | |
625 | ||
626 | if (!list_empty(&ar->rx_data_free)) | |
627 | data = (struct ar5523_rx_data *) ar->rx_data_free.next; | |
628 | else | |
629 | data = NULL; | |
630 | spin_unlock_irqrestore(&ar->rx_data_list_lock, flags); | |
631 | ||
632 | if (!data) | |
633 | goto done; | |
634 | ||
635 | data->skb = alloc_skb(ar->rxbufsz, GFP_KERNEL); | |
636 | if (!data->skb) { | |
637 | ar5523_err(ar, "could not allocate rx skbuff\n"); | |
638 | return; | |
639 | } | |
640 | ||
641 | usb_fill_bulk_urb(data->urb, ar->dev, | |
642 | ar5523_data_rx_pipe(ar->dev), data->skb->data, | |
643 | ar->rxbufsz, ar5523_data_rx_cb, data); | |
644 | ||
645 | spin_lock_irqsave(&ar->rx_data_list_lock, flags); | |
646 | list_move(&data->list, &ar->rx_data_used); | |
647 | spin_unlock_irqrestore(&ar->rx_data_list_lock, flags); | |
648 | atomic_dec(&ar->rx_data_free_cnt); | |
649 | ||
650 | error = usb_submit_urb(data->urb, GFP_KERNEL); | |
651 | if (error) { | |
652 | kfree_skb(data->skb); | |
653 | if (error != -ENODEV) | |
654 | ar5523_err(ar, "Err sending rx data urb %d\n", | |
655 | error); | |
656 | ar5523_rx_data_put(ar, data); | |
657 | atomic_inc(&ar->rx_data_free_cnt); | |
658 | return; | |
659 | } | |
660 | ||
661 | } while (true); | |
662 | done: | |
663 | return; | |
664 | } | |
665 | ||
666 | static void ar5523_cancel_rx_bufs(struct ar5523 *ar) | |
667 | { | |
668 | struct ar5523_rx_data *data; | |
669 | unsigned long flags; | |
670 | ||
671 | do { | |
672 | spin_lock_irqsave(&ar->rx_data_list_lock, flags); | |
673 | if (!list_empty(&ar->rx_data_used)) | |
674 | data = (struct ar5523_rx_data *) ar->rx_data_used.next; | |
675 | else | |
676 | data = NULL; | |
677 | spin_unlock_irqrestore(&ar->rx_data_list_lock, flags); | |
678 | ||
679 | if (!data) | |
680 | break; | |
681 | ||
682 | usb_kill_urb(data->urb); | |
683 | list_move(&data->list, &ar->rx_data_free); | |
684 | atomic_inc(&ar->rx_data_free_cnt); | |
685 | } while (data); | |
686 | } | |
687 | ||
688 | static void ar5523_free_rx_bufs(struct ar5523 *ar) | |
689 | { | |
690 | struct ar5523_rx_data *data; | |
691 | ||
692 | ar5523_cancel_rx_bufs(ar); | |
693 | while (!list_empty(&ar->rx_data_free)) { | |
694 | data = (struct ar5523_rx_data *) ar->rx_data_free.next; | |
695 | list_del(&data->list); | |
696 | usb_free_urb(data->urb); | |
697 | } | |
698 | } | |
699 | ||
700 | static int ar5523_alloc_rx_bufs(struct ar5523 *ar) | |
701 | { | |
702 | int i; | |
703 | ||
704 | for (i = 0; i < AR5523_RX_DATA_COUNT; i++) { | |
705 | struct ar5523_rx_data *data = &ar->rx_data[i]; | |
706 | ||
707 | data->ar = ar; | |
708 | data->urb = usb_alloc_urb(0, GFP_KERNEL); | |
71c4c616 | 709 | if (!data->urb) |
b7d572e1 | 710 | goto err; |
b7d572e1 PF |
711 | list_add_tail(&data->list, &ar->rx_data_free); |
712 | atomic_inc(&ar->rx_data_free_cnt); | |
713 | } | |
714 | return 0; | |
715 | ||
716 | err: | |
717 | ar5523_free_rx_bufs(ar); | |
718 | return -ENOMEM; | |
719 | } | |
720 | ||
721 | static void ar5523_data_tx_pkt_put(struct ar5523 *ar) | |
722 | { | |
723 | atomic_dec(&ar->tx_nr_total); | |
724 | if (!atomic_dec_return(&ar->tx_nr_pending)) { | |
725 | del_timer(&ar->tx_wd_timer); | |
726 | wake_up(&ar->tx_flush_waitq); | |
727 | } | |
728 | ||
729 | if (atomic_read(&ar->tx_nr_total) < AR5523_TX_DATA_RESTART_COUNT) { | |
730 | ar5523_dbg(ar, "restart tx queue\n"); | |
731 | ieee80211_wake_queues(ar->hw); | |
732 | } | |
733 | } | |
734 | ||
735 | static void ar5523_data_tx_cb(struct urb *urb) | |
736 | { | |
737 | struct sk_buff *skb = urb->context; | |
738 | struct ieee80211_tx_info *txi = IEEE80211_SKB_CB(skb); | |
739 | struct ar5523_tx_data *data = (struct ar5523_tx_data *) | |
740 | txi->driver_data; | |
741 | struct ar5523 *ar = data->ar; | |
742 | unsigned long flags; | |
743 | ||
744 | ar5523_dbg(ar, "data tx urb completed: %d\n", urb->status); | |
745 | ||
746 | spin_lock_irqsave(&ar->tx_data_list_lock, flags); | |
747 | list_del(&data->list); | |
748 | spin_unlock_irqrestore(&ar->tx_data_list_lock, flags); | |
749 | ||
750 | if (urb->status) { | |
751 | ar5523_dbg(ar, "%s: urb status: %d\n", __func__, urb->status); | |
752 | ar5523_data_tx_pkt_put(ar); | |
753 | ieee80211_free_txskb(ar->hw, skb); | |
754 | } else { | |
755 | skb_pull(skb, sizeof(struct ar5523_tx_desc) + sizeof(__be32)); | |
756 | ieee80211_tx_status_irqsafe(ar->hw, skb); | |
757 | } | |
758 | usb_free_urb(urb); | |
759 | } | |
760 | ||
761 | static void ar5523_tx(struct ieee80211_hw *hw, | |
762 | struct ieee80211_tx_control *control, | |
763 | struct sk_buff *skb) | |
764 | { | |
765 | struct ieee80211_tx_info *txi = IEEE80211_SKB_CB(skb); | |
766 | struct ar5523_tx_data *data = (struct ar5523_tx_data *) | |
767 | txi->driver_data; | |
768 | struct ar5523 *ar = hw->priv; | |
769 | unsigned long flags; | |
770 | ||
771 | ar5523_dbg(ar, "tx called\n"); | |
772 | if (atomic_inc_return(&ar->tx_nr_total) >= AR5523_TX_DATA_COUNT) { | |
773 | ar5523_dbg(ar, "tx queue full\n"); | |
774 | ar5523_dbg(ar, "stop queues (tot %d pend %d)\n", | |
775 | atomic_read(&ar->tx_nr_total), | |
776 | atomic_read(&ar->tx_nr_pending)); | |
777 | ieee80211_stop_queues(hw); | |
778 | } | |
779 | ||
b7d572e1 PF |
780 | spin_lock_irqsave(&ar->tx_data_list_lock, flags); |
781 | list_add_tail(&data->list, &ar->tx_queue_pending); | |
782 | spin_unlock_irqrestore(&ar->tx_data_list_lock, flags); | |
783 | ||
784 | ieee80211_queue_work(ar->hw, &ar->tx_work); | |
785 | } | |
786 | ||
787 | static void ar5523_tx_work_locked(struct ar5523 *ar) | |
788 | { | |
789 | struct ar5523_tx_data *data; | |
790 | struct ar5523_tx_desc *desc; | |
791 | struct ar5523_chunk *chunk; | |
792 | struct ieee80211_tx_info *txi; | |
793 | struct urb *urb; | |
794 | struct sk_buff *skb; | |
795 | int error = 0, paylen; | |
796 | u32 txqid; | |
797 | unsigned long flags; | |
798 | ||
799 | BUILD_BUG_ON(sizeof(struct ar5523_tx_data) > | |
800 | IEEE80211_TX_INFO_DRIVER_DATA_SIZE); | |
801 | ||
802 | ar5523_dbg(ar, "%s\n", __func__); | |
803 | do { | |
804 | spin_lock_irqsave(&ar->tx_data_list_lock, flags); | |
805 | if (!list_empty(&ar->tx_queue_pending)) { | |
806 | data = (struct ar5523_tx_data *) | |
807 | ar->tx_queue_pending.next; | |
808 | list_del(&data->list); | |
809 | } else | |
810 | data = NULL; | |
811 | spin_unlock_irqrestore(&ar->tx_data_list_lock, flags); | |
812 | ||
813 | if (!data) | |
814 | break; | |
815 | ||
6faf22d9 FW |
816 | txi = container_of((void *)data, struct ieee80211_tx_info, |
817 | driver_data); | |
b7d572e1 | 818 | txqid = 0; |
6faf22d9 FW |
819 | |
820 | skb = container_of((void *)txi, struct sk_buff, cb); | |
b7d572e1 | 821 | paylen = skb->len; |
6faf22d9 | 822 | |
b7d572e1 PF |
823 | urb = usb_alloc_urb(0, GFP_KERNEL); |
824 | if (!urb) { | |
b7d572e1 PF |
825 | ieee80211_free_txskb(ar->hw, skb); |
826 | continue; | |
827 | } | |
828 | ||
829 | data->ar = ar; | |
830 | data->urb = urb; | |
831 | ||
832 | desc = (struct ar5523_tx_desc *)skb_push(skb, sizeof(*desc)); | |
833 | chunk = (struct ar5523_chunk *)skb_push(skb, sizeof(*chunk)); | |
834 | ||
835 | chunk->seqnum = 0; | |
836 | chunk->flags = UATH_CFLAGS_FINAL; | |
837 | chunk->length = cpu_to_be16(skb->len); | |
838 | ||
839 | desc->msglen = cpu_to_be32(skb->len); | |
840 | desc->msgid = AR5523_DATA_ID; | |
841 | desc->buflen = cpu_to_be32(paylen); | |
842 | desc->type = cpu_to_be32(WDCMSG_SEND); | |
843 | desc->flags = cpu_to_be32(UATH_TX_NOTIFY); | |
844 | ||
845 | if (test_bit(AR5523_CONNECTED, &ar->flags)) | |
846 | desc->connid = cpu_to_be32(AR5523_ID_BSS); | |
847 | else | |
848 | desc->connid = cpu_to_be32(AR5523_ID_BROADCAST); | |
849 | ||
850 | if (txi->flags & IEEE80211_TX_CTL_USE_MINRATE) | |
851 | txqid |= UATH_TXQID_MINRATE; | |
852 | ||
853 | desc->txqid = cpu_to_be32(txqid); | |
854 | ||
855 | urb->transfer_flags = URB_ZERO_PACKET; | |
856 | usb_fill_bulk_urb(urb, ar->dev, ar5523_data_tx_pipe(ar->dev), | |
857 | skb->data, skb->len, ar5523_data_tx_cb, skb); | |
858 | ||
859 | spin_lock_irqsave(&ar->tx_data_list_lock, flags); | |
860 | list_add_tail(&data->list, &ar->tx_queue_submitted); | |
861 | spin_unlock_irqrestore(&ar->tx_data_list_lock, flags); | |
862 | mod_timer(&ar->tx_wd_timer, jiffies + AR5523_TX_WD_TIMEOUT); | |
863 | atomic_inc(&ar->tx_nr_pending); | |
864 | ||
865 | ar5523_dbg(ar, "TX Frame (%d pending)\n", | |
866 | atomic_read(&ar->tx_nr_pending)); | |
867 | error = usb_submit_urb(urb, GFP_KERNEL); | |
868 | if (error) { | |
869 | ar5523_err(ar, "error %d when submitting tx urb\n", | |
870 | error); | |
871 | spin_lock_irqsave(&ar->tx_data_list_lock, flags); | |
872 | list_del(&data->list); | |
873 | spin_unlock_irqrestore(&ar->tx_data_list_lock, flags); | |
874 | atomic_dec(&ar->tx_nr_pending); | |
875 | ar5523_data_tx_pkt_put(ar); | |
876 | usb_free_urb(urb); | |
877 | ieee80211_free_txskb(ar->hw, skb); | |
878 | } | |
879 | } while (true); | |
880 | } | |
881 | ||
882 | static void ar5523_tx_work(struct work_struct *work) | |
883 | { | |
884 | struct ar5523 *ar = container_of(work, struct ar5523, tx_work); | |
885 | ||
886 | ar5523_dbg(ar, "%s\n", __func__); | |
887 | mutex_lock(&ar->mutex); | |
888 | ar5523_tx_work_locked(ar); | |
889 | mutex_unlock(&ar->mutex); | |
890 | } | |
891 | ||
892 | static void ar5523_tx_wd_timer(unsigned long arg) | |
893 | { | |
894 | struct ar5523 *ar = (struct ar5523 *) arg; | |
895 | ||
896 | ar5523_dbg(ar, "TX watchdog timer triggered\n"); | |
897 | ieee80211_queue_work(ar->hw, &ar->tx_wd_work); | |
898 | } | |
899 | ||
900 | static void ar5523_tx_wd_work(struct work_struct *work) | |
901 | { | |
902 | struct ar5523 *ar = container_of(work, struct ar5523, tx_wd_work); | |
903 | ||
904 | /* Occasionally the TX queues stop responding. The only way to | |
905 | * recover seems to be to reset the dongle. | |
906 | */ | |
907 | ||
908 | mutex_lock(&ar->mutex); | |
909 | ar5523_err(ar, "TX queue stuck (tot %d pend %d)\n", | |
910 | atomic_read(&ar->tx_nr_total), | |
911 | atomic_read(&ar->tx_nr_pending)); | |
912 | ||
913 | ar5523_err(ar, "Will restart dongle.\n"); | |
914 | ar5523_cmd_write(ar, WDCMSG_TARGET_RESET, NULL, 0, 0); | |
915 | mutex_unlock(&ar->mutex); | |
916 | } | |
917 | ||
918 | static void ar5523_flush_tx(struct ar5523 *ar) | |
919 | { | |
920 | ar5523_tx_work_locked(ar); | |
921 | ||
922 | /* Don't waste time trying to flush if USB is disconnected */ | |
923 | if (test_bit(AR5523_USB_DISCONNECTED, &ar->flags)) | |
924 | return; | |
925 | if (!wait_event_timeout(ar->tx_flush_waitq, | |
926 | !atomic_read(&ar->tx_nr_pending), AR5523_FLUSH_TIMEOUT)) | |
927 | ar5523_err(ar, "flush timeout (tot %d pend %d)\n", | |
928 | atomic_read(&ar->tx_nr_total), | |
929 | atomic_read(&ar->tx_nr_pending)); | |
930 | } | |
931 | ||
932 | static void ar5523_free_tx_cmd(struct ar5523 *ar) | |
933 | { | |
934 | struct ar5523_tx_cmd *cmd = &ar->tx_cmd; | |
935 | ||
936 | usb_free_coherent(ar->dev, AR5523_MAX_RXCMDSZ, cmd->buf_tx, | |
937 | cmd->urb_tx->transfer_dma); | |
938 | usb_free_urb(cmd->urb_tx); | |
939 | } | |
940 | ||
941 | static int ar5523_alloc_tx_cmd(struct ar5523 *ar) | |
942 | { | |
943 | struct ar5523_tx_cmd *cmd = &ar->tx_cmd; | |
944 | ||
945 | cmd->ar = ar; | |
946 | init_completion(&cmd->done); | |
947 | ||
948 | cmd->urb_tx = usb_alloc_urb(0, GFP_KERNEL); | |
71c4c616 | 949 | if (!cmd->urb_tx) |
b7d572e1 | 950 | return -ENOMEM; |
b7d572e1 PF |
951 | cmd->buf_tx = usb_alloc_coherent(ar->dev, AR5523_MAX_TXCMDSZ, |
952 | GFP_KERNEL, | |
953 | &cmd->urb_tx->transfer_dma); | |
954 | if (!cmd->buf_tx) { | |
955 | usb_free_urb(cmd->urb_tx); | |
956 | return -ENOMEM; | |
957 | } | |
958 | return 0; | |
959 | } | |
960 | ||
961 | /* | |
962 | * This function is called periodically (every second) when associated to | |
963 | * query device statistics. | |
964 | */ | |
965 | static void ar5523_stat_work(struct work_struct *work) | |
966 | { | |
967 | struct ar5523 *ar = container_of(work, struct ar5523, stat_work.work); | |
968 | int error; | |
969 | ||
970 | ar5523_dbg(ar, "%s\n", __func__); | |
971 | mutex_lock(&ar->mutex); | |
972 | ||
973 | /* | |
974 | * Send request for statistics asynchronously once a second. This | |
975 | * seems to be important. Throughput is a lot better if this is done. | |
976 | */ | |
977 | error = ar5523_cmd_write(ar, WDCMSG_TARGET_GET_STATS, NULL, 0, 0); | |
978 | if (error) | |
979 | ar5523_err(ar, "could not query stats, error %d\n", error); | |
980 | mutex_unlock(&ar->mutex); | |
981 | ieee80211_queue_delayed_work(ar->hw, &ar->stat_work, HZ); | |
982 | } | |
983 | ||
984 | /* | |
985 | * Interface routines to the mac80211 stack. | |
986 | */ | |
987 | static int ar5523_start(struct ieee80211_hw *hw) | |
988 | { | |
989 | struct ar5523 *ar = hw->priv; | |
990 | int error; | |
991 | __be32 val; | |
992 | ||
993 | ar5523_dbg(ar, "start called\n"); | |
994 | ||
995 | mutex_lock(&ar->mutex); | |
996 | val = cpu_to_be32(0); | |
997 | ar5523_cmd_write(ar, WDCMSG_BIND, &val, sizeof(val), 0); | |
998 | ||
999 | /* set MAC address */ | |
1000 | ar5523_config_multi(ar, CFG_MAC_ADDR, &ar->hw->wiphy->perm_addr, | |
1001 | ETH_ALEN); | |
1002 | ||
1003 | /* XXX honor net80211 state */ | |
1004 | ar5523_config(ar, CFG_RATE_CONTROL_ENABLE, 0x00000001); | |
1005 | ar5523_config(ar, CFG_DIVERSITY_CTL, 0x00000001); | |
1006 | ar5523_config(ar, CFG_ABOLT, 0x0000003f); | |
1007 | ar5523_config(ar, CFG_WME_ENABLED, 0x00000000); | |
1008 | ||
1009 | ar5523_config(ar, CFG_SERVICE_TYPE, 1); | |
1010 | ar5523_config(ar, CFG_TP_SCALE, 0x00000000); | |
1011 | ar5523_config(ar, CFG_TPC_HALF_DBM5, 0x0000003c); | |
1012 | ar5523_config(ar, CFG_TPC_HALF_DBM2, 0x0000003c); | |
1013 | ar5523_config(ar, CFG_OVERRD_TX_POWER, 0x00000000); | |
1014 | ar5523_config(ar, CFG_GMODE_PROTECTION, 0x00000000); | |
1015 | ar5523_config(ar, CFG_GMODE_PROTECT_RATE_INDEX, 0x00000003); | |
1016 | ar5523_config(ar, CFG_PROTECTION_TYPE, 0x00000000); | |
1017 | ar5523_config(ar, CFG_MODE_CTS, 0x00000002); | |
1018 | ||
1019 | error = ar5523_cmd_read(ar, WDCMSG_TARGET_START, NULL, 0, | |
1020 | &val, sizeof(val), AR5523_CMD_FLAG_MAGIC); | |
1021 | if (error) { | |
1022 | ar5523_dbg(ar, "could not start target, error %d\n", error); | |
1023 | goto err; | |
1024 | } | |
1025 | ar5523_dbg(ar, "WDCMSG_TARGET_START returns handle: 0x%x\n", | |
1026 | be32_to_cpu(val)); | |
1027 | ||
1028 | ar5523_switch_chan(ar); | |
1029 | ||
1030 | val = cpu_to_be32(TARGET_DEVICE_AWAKE); | |
1031 | ar5523_cmd_write(ar, WDCMSG_SET_PWR_MODE, &val, sizeof(val), 0); | |
1032 | /* XXX? check */ | |
1033 | ar5523_cmd_write(ar, WDCMSG_RESET_KEY_CACHE, NULL, 0, 0); | |
1034 | ||
1035 | set_bit(AR5523_HW_UP, &ar->flags); | |
1036 | queue_work(ar->wq, &ar->rx_refill_work); | |
1037 | ||
1038 | /* enable Rx */ | |
1039 | ar5523_set_rxfilter(ar, 0, UATH_FILTER_OP_INIT); | |
1040 | ar5523_set_rxfilter(ar, | |
1041 | UATH_FILTER_RX_UCAST | UATH_FILTER_RX_MCAST | | |
1042 | UATH_FILTER_RX_BCAST | UATH_FILTER_RX_BEACON, | |
1043 | UATH_FILTER_OP_SET); | |
1044 | ||
1045 | ar5523_set_ledsteady(ar, UATH_LED_ACTIVITY, UATH_LED_ON); | |
1046 | ar5523_dbg(ar, "start OK\n"); | |
1047 | ||
1048 | err: | |
1049 | mutex_unlock(&ar->mutex); | |
1050 | return error; | |
1051 | } | |
1052 | ||
1053 | static void ar5523_stop(struct ieee80211_hw *hw) | |
1054 | { | |
1055 | struct ar5523 *ar = hw->priv; | |
1056 | ||
1057 | ar5523_dbg(ar, "stop called\n"); | |
1058 | ||
1059 | cancel_delayed_work_sync(&ar->stat_work); | |
1060 | mutex_lock(&ar->mutex); | |
1061 | clear_bit(AR5523_HW_UP, &ar->flags); | |
1062 | ||
1063 | ar5523_set_ledsteady(ar, UATH_LED_LINK, UATH_LED_OFF); | |
1064 | ar5523_set_ledsteady(ar, UATH_LED_ACTIVITY, UATH_LED_OFF); | |
1065 | ||
1066 | ar5523_cmd_write(ar, WDCMSG_TARGET_STOP, NULL, 0, 0); | |
1067 | ||
1068 | del_timer_sync(&ar->tx_wd_timer); | |
1069 | cancel_work_sync(&ar->tx_wd_work); | |
1070 | cancel_work_sync(&ar->rx_refill_work); | |
1071 | ar5523_cancel_rx_bufs(ar); | |
1072 | mutex_unlock(&ar->mutex); | |
1073 | } | |
1074 | ||
1075 | static int ar5523_set_rts_threshold(struct ieee80211_hw *hw, u32 value) | |
1076 | { | |
1077 | struct ar5523 *ar = hw->priv; | |
1078 | int ret; | |
1079 | ||
1080 | ar5523_dbg(ar, "set_rts_threshold called\n"); | |
1081 | mutex_lock(&ar->mutex); | |
1082 | ||
1083 | ret = ar5523_config(ar, CFG_USER_RTS_THRESHOLD, value); | |
1084 | ||
1085 | mutex_unlock(&ar->mutex); | |
1086 | return ret; | |
1087 | } | |
1088 | ||
77be2c54 EG |
1089 | static void ar5523_flush(struct ieee80211_hw *hw, struct ieee80211_vif *vif, |
1090 | u32 queues, bool drop) | |
b7d572e1 PF |
1091 | { |
1092 | struct ar5523 *ar = hw->priv; | |
1093 | ||
1094 | ar5523_dbg(ar, "flush called\n"); | |
1095 | ar5523_flush_tx(ar); | |
1096 | } | |
1097 | ||
1098 | static int ar5523_add_interface(struct ieee80211_hw *hw, | |
1099 | struct ieee80211_vif *vif) | |
1100 | { | |
1101 | struct ar5523 *ar = hw->priv; | |
1102 | ||
1103 | ar5523_dbg(ar, "add interface called\n"); | |
1104 | ||
1105 | if (ar->vif) { | |
1106 | ar5523_dbg(ar, "invalid add_interface\n"); | |
1107 | return -EOPNOTSUPP; | |
1108 | } | |
1109 | ||
1110 | switch (vif->type) { | |
1111 | case NL80211_IFTYPE_STATION: | |
1112 | ar->vif = vif; | |
1113 | break; | |
1114 | default: | |
1115 | return -EOPNOTSUPP; | |
1116 | } | |
1117 | return 0; | |
1118 | } | |
1119 | ||
1120 | static void ar5523_remove_interface(struct ieee80211_hw *hw, | |
1121 | struct ieee80211_vif *vif) | |
1122 | { | |
1123 | struct ar5523 *ar = hw->priv; | |
1124 | ||
1125 | ar5523_dbg(ar, "remove interface called\n"); | |
1126 | ar->vif = NULL; | |
1127 | } | |
1128 | ||
1129 | static int ar5523_hwconfig(struct ieee80211_hw *hw, u32 changed) | |
1130 | { | |
1131 | struct ar5523 *ar = hw->priv; | |
1132 | ||
1133 | ar5523_dbg(ar, "config called\n"); | |
1134 | mutex_lock(&ar->mutex); | |
1135 | if (changed & IEEE80211_CONF_CHANGE_CHANNEL) { | |
1136 | ar5523_dbg(ar, "Do channel switch\n"); | |
1137 | ar5523_flush_tx(ar); | |
1138 | ar5523_switch_chan(ar); | |
1139 | } | |
1140 | mutex_unlock(&ar->mutex); | |
1141 | return 0; | |
1142 | } | |
1143 | ||
1144 | static int ar5523_get_wlan_mode(struct ar5523 *ar, | |
1145 | struct ieee80211_bss_conf *bss_conf) | |
1146 | { | |
1147 | struct ieee80211_supported_band *band; | |
1148 | int bit; | |
1149 | struct ieee80211_sta *sta; | |
1150 | u32 sta_rate_set; | |
1151 | ||
675a0b04 | 1152 | band = ar->hw->wiphy->bands[ar->hw->conf.chandef.chan->band]; |
b7d572e1 PF |
1153 | sta = ieee80211_find_sta(ar->vif, bss_conf->bssid); |
1154 | if (!sta) { | |
1155 | ar5523_info(ar, "STA not found!\n"); | |
1156 | return WLAN_MODE_11b; | |
1157 | } | |
675a0b04 | 1158 | sta_rate_set = sta->supp_rates[ar->hw->conf.chandef.chan->band]; |
b7d572e1 PF |
1159 | |
1160 | for (bit = 0; bit < band->n_bitrates; bit++) { | |
1161 | if (sta_rate_set & 1) { | |
1162 | int rate = band->bitrates[bit].bitrate; | |
1163 | switch (rate) { | |
1164 | case 60: | |
1165 | case 90: | |
1166 | case 120: | |
1167 | case 180: | |
1168 | case 240: | |
1169 | case 360: | |
1170 | case 480: | |
1171 | case 540: | |
1172 | return WLAN_MODE_11g; | |
1173 | } | |
1174 | } | |
1175 | sta_rate_set >>= 1; | |
1176 | } | |
1177 | return WLAN_MODE_11b; | |
1178 | } | |
1179 | ||
1180 | static void ar5523_create_rateset(struct ar5523 *ar, | |
1181 | struct ieee80211_bss_conf *bss_conf, | |
1182 | struct ar5523_cmd_rateset *rs, | |
1183 | bool basic) | |
1184 | { | |
1185 | struct ieee80211_supported_band *band; | |
1186 | struct ieee80211_sta *sta; | |
1187 | int bit, i = 0; | |
1188 | u32 sta_rate_set, basic_rate_set; | |
1189 | ||
1190 | sta = ieee80211_find_sta(ar->vif, bss_conf->bssid); | |
1191 | basic_rate_set = bss_conf->basic_rates; | |
1192 | if (!sta) { | |
1193 | ar5523_info(ar, "STA not found. Cannot set rates\n"); | |
1194 | sta_rate_set = bss_conf->basic_rates; | |
9ee01b30 | 1195 | } else |
675a0b04 | 1196 | sta_rate_set = sta->supp_rates[ar->hw->conf.chandef.chan->band]; |
b7d572e1 PF |
1197 | |
1198 | ar5523_dbg(ar, "sta rate_set = %08x\n", sta_rate_set); | |
1199 | ||
675a0b04 | 1200 | band = ar->hw->wiphy->bands[ar->hw->conf.chandef.chan->band]; |
b7d572e1 PF |
1201 | for (bit = 0; bit < band->n_bitrates; bit++) { |
1202 | BUG_ON(i >= AR5523_MAX_NRATES); | |
1203 | ar5523_dbg(ar, "Considering rate %d : %d\n", | |
1204 | band->bitrates[bit].hw_value, sta_rate_set & 1); | |
1205 | if (sta_rate_set & 1) { | |
1206 | rs->set[i] = band->bitrates[bit].hw_value; | |
1207 | if (basic_rate_set & 1 && basic) | |
1208 | rs->set[i] |= 0x80; | |
1209 | i++; | |
1210 | } | |
1211 | sta_rate_set >>= 1; | |
1212 | basic_rate_set >>= 1; | |
1213 | } | |
1214 | ||
1215 | rs->length = i; | |
1216 | } | |
1217 | ||
1218 | static int ar5523_set_basic_rates(struct ar5523 *ar, | |
1219 | struct ieee80211_bss_conf *bss) | |
1220 | { | |
1221 | struct ar5523_cmd_rates rates; | |
1222 | ||
1223 | memset(&rates, 0, sizeof(rates)); | |
1224 | rates.connid = cpu_to_be32(2); /* XXX */ | |
1225 | rates.size = cpu_to_be32(sizeof(struct ar5523_cmd_rateset)); | |
1226 | ar5523_create_rateset(ar, bss, &rates.rateset, true); | |
1227 | ||
1228 | return ar5523_cmd_write(ar, WDCMSG_SET_BASIC_RATE, &rates, | |
1229 | sizeof(rates), 0); | |
1230 | } | |
1231 | ||
1232 | static int ar5523_create_connection(struct ar5523 *ar, | |
1233 | struct ieee80211_vif *vif, | |
1234 | struct ieee80211_bss_conf *bss) | |
1235 | { | |
1236 | struct ar5523_cmd_create_connection create; | |
1237 | int wlan_mode; | |
1238 | ||
1239 | memset(&create, 0, sizeof(create)); | |
1240 | create.connid = cpu_to_be32(2); | |
1241 | create.bssid = cpu_to_be32(0); | |
1242 | /* XXX packed or not? */ | |
1243 | create.size = cpu_to_be32(sizeof(struct ar5523_cmd_rateset)); | |
1244 | ||
1245 | ar5523_create_rateset(ar, bss, &create.connattr.rateset, false); | |
1246 | ||
1247 | wlan_mode = ar5523_get_wlan_mode(ar, bss); | |
1248 | create.connattr.wlanmode = cpu_to_be32(wlan_mode); | |
1249 | ||
1250 | return ar5523_cmd_write(ar, WDCMSG_CREATE_CONNECTION, &create, | |
1251 | sizeof(create), 0); | |
1252 | } | |
1253 | ||
1254 | static int ar5523_write_associd(struct ar5523 *ar, | |
1255 | struct ieee80211_bss_conf *bss) | |
1256 | { | |
1257 | struct ar5523_cmd_set_associd associd; | |
1258 | ||
1259 | memset(&associd, 0, sizeof(associd)); | |
1260 | associd.defaultrateix = cpu_to_be32(0); /* XXX */ | |
1261 | associd.associd = cpu_to_be32(bss->aid); | |
1262 | associd.timoffset = cpu_to_be32(0x3b); /* XXX */ | |
1263 | memcpy(associd.bssid, bss->bssid, ETH_ALEN); | |
1264 | return ar5523_cmd_write(ar, WDCMSG_WRITE_ASSOCID, &associd, | |
1265 | sizeof(associd), 0); | |
1266 | } | |
1267 | ||
1268 | static void ar5523_bss_info_changed(struct ieee80211_hw *hw, | |
1269 | struct ieee80211_vif *vif, | |
1270 | struct ieee80211_bss_conf *bss, | |
1271 | u32 changed) | |
1272 | { | |
1273 | struct ar5523 *ar = hw->priv; | |
1274 | int error; | |
1275 | ||
1276 | ar5523_dbg(ar, "bss_info_changed called\n"); | |
1277 | mutex_lock(&ar->mutex); | |
1278 | ||
1279 | if (!(changed & BSS_CHANGED_ASSOC)) | |
1280 | goto out_unlock; | |
1281 | ||
1282 | if (bss->assoc) { | |
1283 | error = ar5523_create_connection(ar, vif, bss); | |
1284 | if (error) { | |
1285 | ar5523_err(ar, "could not create connection\n"); | |
1286 | goto out_unlock; | |
1287 | } | |
1288 | ||
1289 | error = ar5523_set_basic_rates(ar, bss); | |
1290 | if (error) { | |
1291 | ar5523_err(ar, "could not set negotiated rate set\n"); | |
1292 | goto out_unlock; | |
1293 | } | |
1294 | ||
1295 | error = ar5523_write_associd(ar, bss); | |
1296 | if (error) { | |
1297 | ar5523_err(ar, "could not set association\n"); | |
1298 | goto out_unlock; | |
1299 | } | |
1300 | ||
1301 | /* turn link LED on */ | |
1302 | ar5523_set_ledsteady(ar, UATH_LED_LINK, UATH_LED_ON); | |
1303 | set_bit(AR5523_CONNECTED, &ar->flags); | |
1304 | ieee80211_queue_delayed_work(hw, &ar->stat_work, HZ); | |
1305 | ||
1306 | } else { | |
1307 | cancel_delayed_work(&ar->stat_work); | |
1308 | clear_bit(AR5523_CONNECTED, &ar->flags); | |
1309 | ar5523_set_ledsteady(ar, UATH_LED_LINK, UATH_LED_OFF); | |
1310 | } | |
1311 | ||
1312 | out_unlock: | |
1313 | mutex_unlock(&ar->mutex); | |
1314 | ||
1315 | } | |
1316 | ||
df140465 | 1317 | #define AR5523_SUPPORTED_FILTERS (FIF_ALLMULTI | \ |
b7d572e1 PF |
1318 | FIF_FCSFAIL | \ |
1319 | FIF_OTHER_BSS) | |
1320 | ||
1321 | static void ar5523_configure_filter(struct ieee80211_hw *hw, | |
1322 | unsigned int changed_flags, | |
1323 | unsigned int *total_flags, | |
1324 | u64 multicast) | |
1325 | { | |
1326 | struct ar5523 *ar = hw->priv; | |
1327 | u32 filter = 0; | |
1328 | ||
1329 | ar5523_dbg(ar, "configure_filter called\n"); | |
1330 | mutex_lock(&ar->mutex); | |
1331 | ar5523_flush_tx(ar); | |
1332 | ||
1333 | *total_flags &= AR5523_SUPPORTED_FILTERS; | |
1334 | ||
1335 | /* The filters seems strange. UATH_FILTER_RX_BCAST and | |
1336 | * UATH_FILTER_RX_MCAST does not result in those frames being RXed. | |
1337 | * The only way I have found to get [mb]cast frames seems to be | |
1338 | * to set UATH_FILTER_RX_PROM. */ | |
1339 | filter |= UATH_FILTER_RX_UCAST | UATH_FILTER_RX_MCAST | | |
1340 | UATH_FILTER_RX_BCAST | UATH_FILTER_RX_BEACON | | |
1341 | UATH_FILTER_RX_PROM; | |
1342 | ||
1343 | ar5523_set_rxfilter(ar, 0, UATH_FILTER_OP_INIT); | |
1344 | ar5523_set_rxfilter(ar, filter, UATH_FILTER_OP_SET); | |
1345 | ||
1346 | mutex_unlock(&ar->mutex); | |
1347 | } | |
1348 | ||
1349 | static const struct ieee80211_ops ar5523_ops = { | |
1350 | .start = ar5523_start, | |
1351 | .stop = ar5523_stop, | |
1352 | .tx = ar5523_tx, | |
1353 | .set_rts_threshold = ar5523_set_rts_threshold, | |
1354 | .add_interface = ar5523_add_interface, | |
1355 | .remove_interface = ar5523_remove_interface, | |
1356 | .config = ar5523_hwconfig, | |
1357 | .bss_info_changed = ar5523_bss_info_changed, | |
1358 | .configure_filter = ar5523_configure_filter, | |
1359 | .flush = ar5523_flush, | |
1360 | }; | |
1361 | ||
1362 | static int ar5523_host_available(struct ar5523 *ar) | |
1363 | { | |
1364 | struct ar5523_cmd_host_available setup; | |
1365 | ||
1366 | /* inform target the host is available */ | |
1367 | setup.sw_ver_major = cpu_to_be32(ATH_SW_VER_MAJOR); | |
1368 | setup.sw_ver_minor = cpu_to_be32(ATH_SW_VER_MINOR); | |
1369 | setup.sw_ver_patch = cpu_to_be32(ATH_SW_VER_PATCH); | |
1370 | setup.sw_ver_build = cpu_to_be32(ATH_SW_VER_BUILD); | |
1371 | return ar5523_cmd_read(ar, WDCMSG_HOST_AVAILABLE, | |
1372 | &setup, sizeof(setup), NULL, 0, 0); | |
1373 | } | |
1374 | ||
1375 | static int ar5523_get_devstatus(struct ar5523 *ar) | |
1376 | { | |
1377 | u8 macaddr[ETH_ALEN]; | |
1378 | int error; | |
1379 | ||
1380 | /* retrieve MAC address */ | |
1381 | error = ar5523_get_status(ar, ST_MAC_ADDR, macaddr, ETH_ALEN); | |
1382 | if (error) { | |
1383 | ar5523_err(ar, "could not read MAC address\n"); | |
1384 | return error; | |
1385 | } | |
1386 | ||
1387 | SET_IEEE80211_PERM_ADDR(ar->hw, macaddr); | |
1388 | ||
1389 | error = ar5523_get_status(ar, ST_SERIAL_NUMBER, | |
1390 | &ar->serial[0], sizeof(ar->serial)); | |
1391 | if (error) { | |
1392 | ar5523_err(ar, "could not read device serial number\n"); | |
1393 | return error; | |
1394 | } | |
1395 | return 0; | |
1396 | } | |
1397 | ||
1398 | #define AR5523_SANE_RXBUFSZ 2000 | |
1399 | ||
1400 | static int ar5523_get_max_rxsz(struct ar5523 *ar) | |
1401 | { | |
1402 | int error; | |
1403 | __be32 rxsize; | |
1404 | ||
1405 | /* Get max rx size */ | |
1406 | error = ar5523_get_status(ar, ST_WDC_TRANSPORT_CHUNK_SIZE, &rxsize, | |
1407 | sizeof(rxsize)); | |
1408 | if (error != 0) { | |
1409 | ar5523_err(ar, "could not read max RX size\n"); | |
1410 | return error; | |
1411 | } | |
1412 | ||
1413 | ar->rxbufsz = be32_to_cpu(rxsize); | |
1414 | ||
1415 | if (!ar->rxbufsz || ar->rxbufsz > AR5523_SANE_RXBUFSZ) { | |
1416 | ar5523_err(ar, "Bad rxbufsz from device. Using %d instead\n", | |
1417 | AR5523_SANE_RXBUFSZ); | |
1418 | ar->rxbufsz = AR5523_SANE_RXBUFSZ; | |
1419 | } | |
1420 | ||
1421 | ar5523_dbg(ar, "Max RX buf size: %d\n", ar->rxbufsz); | |
1422 | return 0; | |
1423 | } | |
1424 | ||
1425 | /* | |
1426 | * This is copied from rtl818x, but we should probably move this | |
1427 | * to common code as in OpenBSD. | |
1428 | */ | |
1429 | static const struct ieee80211_rate ar5523_rates[] = { | |
1430 | { .bitrate = 10, .hw_value = 2, }, | |
1431 | { .bitrate = 20, .hw_value = 4 }, | |
1432 | { .bitrate = 55, .hw_value = 11, }, | |
1433 | { .bitrate = 110, .hw_value = 22, }, | |
1434 | { .bitrate = 60, .hw_value = 12, }, | |
1435 | { .bitrate = 90, .hw_value = 18, }, | |
1436 | { .bitrate = 120, .hw_value = 24, }, | |
1437 | { .bitrate = 180, .hw_value = 36, }, | |
1438 | { .bitrate = 240, .hw_value = 48, }, | |
1439 | { .bitrate = 360, .hw_value = 72, }, | |
1440 | { .bitrate = 480, .hw_value = 96, }, | |
1441 | { .bitrate = 540, .hw_value = 108, }, | |
1442 | }; | |
1443 | ||
1444 | static const struct ieee80211_channel ar5523_channels[] = { | |
1445 | { .center_freq = 2412 }, | |
1446 | { .center_freq = 2417 }, | |
1447 | { .center_freq = 2422 }, | |
1448 | { .center_freq = 2427 }, | |
1449 | { .center_freq = 2432 }, | |
1450 | { .center_freq = 2437 }, | |
1451 | { .center_freq = 2442 }, | |
1452 | { .center_freq = 2447 }, | |
1453 | { .center_freq = 2452 }, | |
1454 | { .center_freq = 2457 }, | |
1455 | { .center_freq = 2462 }, | |
1456 | { .center_freq = 2467 }, | |
1457 | { .center_freq = 2472 }, | |
1458 | { .center_freq = 2484 }, | |
1459 | }; | |
1460 | ||
1461 | static int ar5523_init_modes(struct ar5523 *ar) | |
1462 | { | |
1463 | BUILD_BUG_ON(sizeof(ar->channels) != sizeof(ar5523_channels)); | |
1464 | BUILD_BUG_ON(sizeof(ar->rates) != sizeof(ar5523_rates)); | |
1465 | ||
1466 | memcpy(ar->channels, ar5523_channels, sizeof(ar5523_channels)); | |
1467 | memcpy(ar->rates, ar5523_rates, sizeof(ar5523_rates)); | |
1468 | ||
57fbcce3 | 1469 | ar->band.band = NL80211_BAND_2GHZ; |
b7d572e1 PF |
1470 | ar->band.channels = ar->channels; |
1471 | ar->band.n_channels = ARRAY_SIZE(ar5523_channels); | |
1472 | ar->band.bitrates = ar->rates; | |
1473 | ar->band.n_bitrates = ARRAY_SIZE(ar5523_rates); | |
57fbcce3 | 1474 | ar->hw->wiphy->bands[NL80211_BAND_2GHZ] = &ar->band; |
b7d572e1 PF |
1475 | return 0; |
1476 | } | |
1477 | ||
1478 | /* | |
1479 | * Load the MIPS R4000 microcode into the device. Once the image is loaded, | |
1480 | * the device will detach itself from the bus and reattach later with a new | |
1481 | * product Id (a la ezusb). | |
1482 | */ | |
1483 | static int ar5523_load_firmware(struct usb_device *dev) | |
1484 | { | |
1485 | struct ar5523_fwblock *txblock, *rxblock; | |
1486 | const struct firmware *fw; | |
1487 | void *fwbuf; | |
1488 | int len, offset; | |
1489 | int foolen; /* XXX(hch): handle short transfers */ | |
1490 | int error = -ENXIO; | |
1491 | ||
1492 | if (request_firmware(&fw, AR5523_FIRMWARE_FILE, &dev->dev)) { | |
1493 | dev_err(&dev->dev, "no firmware found: %s\n", | |
1494 | AR5523_FIRMWARE_FILE); | |
1495 | return -ENOENT; | |
1496 | } | |
1497 | ||
1498 | txblock = kmalloc(sizeof(*txblock), GFP_KERNEL); | |
1499 | if (!txblock) | |
1500 | goto out; | |
1501 | ||
1502 | rxblock = kmalloc(sizeof(*rxblock), GFP_KERNEL); | |
1503 | if (!rxblock) | |
1504 | goto out_free_txblock; | |
1505 | ||
1506 | fwbuf = kmalloc(AR5523_MAX_FWBLOCK_SIZE, GFP_KERNEL); | |
1507 | if (!fwbuf) | |
1508 | goto out_free_rxblock; | |
1509 | ||
1510 | memset(txblock, 0, sizeof(struct ar5523_fwblock)); | |
1511 | txblock->flags = cpu_to_be32(AR5523_WRITE_BLOCK); | |
1512 | txblock->total = cpu_to_be32(fw->size); | |
1513 | ||
1514 | offset = 0; | |
1515 | len = fw->size; | |
1516 | while (len > 0) { | |
1517 | int mlen = min(len, AR5523_MAX_FWBLOCK_SIZE); | |
1518 | ||
1519 | txblock->remain = cpu_to_be32(len - mlen); | |
1520 | txblock->len = cpu_to_be32(mlen); | |
1521 | ||
1522 | /* send firmware block meta-data */ | |
1523 | error = usb_bulk_msg(dev, ar5523_cmd_tx_pipe(dev), | |
1524 | txblock, sizeof(*txblock), &foolen, | |
1525 | AR5523_CMD_TIMEOUT); | |
1526 | if (error) { | |
1527 | dev_err(&dev->dev, | |
1528 | "could not send firmware block info\n"); | |
1529 | goto out_free_fwbuf; | |
1530 | } | |
1531 | ||
1532 | /* send firmware block data */ | |
1533 | memcpy(fwbuf, fw->data + offset, mlen); | |
1534 | error = usb_bulk_msg(dev, ar5523_data_tx_pipe(dev), | |
1535 | fwbuf, mlen, &foolen, | |
1536 | AR5523_DATA_TIMEOUT); | |
1537 | if (error) { | |
1538 | dev_err(&dev->dev, | |
1539 | "could not send firmware block data\n"); | |
1540 | goto out_free_fwbuf; | |
1541 | } | |
1542 | ||
1543 | /* wait for ack from firmware */ | |
1544 | error = usb_bulk_msg(dev, ar5523_cmd_rx_pipe(dev), | |
1545 | rxblock, sizeof(*rxblock), &foolen, | |
1546 | AR5523_CMD_TIMEOUT); | |
1547 | if (error) { | |
1548 | dev_err(&dev->dev, | |
1549 | "could not read firmware answer\n"); | |
1550 | goto out_free_fwbuf; | |
1551 | } | |
1552 | ||
1553 | len -= mlen; | |
1554 | offset += mlen; | |
1555 | } | |
1556 | ||
1557 | /* | |
1558 | * Set the error to -ENXIO to make sure we continue probing for | |
1559 | * a driver. | |
1560 | */ | |
1561 | error = -ENXIO; | |
1562 | ||
1563 | out_free_fwbuf: | |
1564 | kfree(fwbuf); | |
1565 | out_free_rxblock: | |
1566 | kfree(rxblock); | |
1567 | out_free_txblock: | |
1568 | kfree(txblock); | |
1569 | out: | |
1570 | release_firmware(fw); | |
1571 | return error; | |
1572 | } | |
1573 | ||
1574 | static int ar5523_probe(struct usb_interface *intf, | |
1575 | const struct usb_device_id *id) | |
1576 | { | |
1577 | struct usb_device *dev = interface_to_usbdev(intf); | |
1578 | struct ieee80211_hw *hw; | |
1579 | struct ar5523 *ar; | |
1580 | int error = -ENOMEM; | |
1581 | ||
1582 | /* | |
1583 | * Load firmware if the device requires it. This will return | |
1584 | * -ENXIO on success and we'll get called back afer the usb | |
1585 | * id changes to indicate that the firmware is present. | |
1586 | */ | |
1587 | if (id->driver_info & AR5523_FLAG_PRE_FIRMWARE) | |
1588 | return ar5523_load_firmware(dev); | |
1589 | ||
1590 | ||
1591 | hw = ieee80211_alloc_hw(sizeof(*ar), &ar5523_ops); | |
1592 | if (!hw) | |
1593 | goto out; | |
1594 | SET_IEEE80211_DEV(hw, &intf->dev); | |
1595 | ||
1596 | ar = hw->priv; | |
1597 | ar->hw = hw; | |
1598 | ar->dev = dev; | |
1599 | mutex_init(&ar->mutex); | |
1600 | ||
1601 | INIT_DELAYED_WORK(&ar->stat_work, ar5523_stat_work); | |
1602 | init_timer(&ar->tx_wd_timer); | |
1603 | setup_timer(&ar->tx_wd_timer, ar5523_tx_wd_timer, (unsigned long) ar); | |
1604 | INIT_WORK(&ar->tx_wd_work, ar5523_tx_wd_work); | |
1605 | INIT_WORK(&ar->tx_work, ar5523_tx_work); | |
1606 | INIT_LIST_HEAD(&ar->tx_queue_pending); | |
1607 | INIT_LIST_HEAD(&ar->tx_queue_submitted); | |
1608 | spin_lock_init(&ar->tx_data_list_lock); | |
1609 | atomic_set(&ar->tx_nr_total, 0); | |
1610 | atomic_set(&ar->tx_nr_pending, 0); | |
1611 | init_waitqueue_head(&ar->tx_flush_waitq); | |
1612 | ||
1613 | atomic_set(&ar->rx_data_free_cnt, 0); | |
1614 | INIT_WORK(&ar->rx_refill_work, ar5523_rx_refill_work); | |
1615 | INIT_LIST_HEAD(&ar->rx_data_free); | |
1616 | INIT_LIST_HEAD(&ar->rx_data_used); | |
1617 | spin_lock_init(&ar->rx_data_list_lock); | |
1618 | ||
1619 | ar->wq = create_singlethread_workqueue("ar5523"); | |
1620 | if (!ar->wq) { | |
1621 | ar5523_err(ar, "Could not create wq\n"); | |
1622 | goto out_free_ar; | |
1623 | } | |
1624 | ||
1625 | error = ar5523_alloc_rx_bufs(ar); | |
1626 | if (error) { | |
1627 | ar5523_err(ar, "Could not allocate rx buffers\n"); | |
1628 | goto out_free_wq; | |
1629 | } | |
1630 | ||
1631 | error = ar5523_alloc_rx_cmd(ar); | |
1632 | if (error) { | |
1633 | ar5523_err(ar, "Could not allocate rx command buffers\n"); | |
1634 | goto out_free_rx_bufs; | |
1635 | } | |
1636 | ||
1637 | error = ar5523_alloc_tx_cmd(ar); | |
1638 | if (error) { | |
1639 | ar5523_err(ar, "Could not allocate tx command buffers\n"); | |
1640 | goto out_free_rx_cmd; | |
1641 | } | |
1642 | ||
1643 | error = ar5523_submit_rx_cmd(ar); | |
1644 | if (error) { | |
1645 | ar5523_err(ar, "Failed to submit rx cmd\n"); | |
1646 | goto out_free_tx_cmd; | |
1647 | } | |
1648 | ||
1649 | /* | |
1650 | * We're now ready to send/receive firmware commands. | |
1651 | */ | |
1652 | error = ar5523_host_available(ar); | |
1653 | if (error) { | |
1654 | ar5523_err(ar, "could not initialize adapter\n"); | |
1655 | goto out_cancel_rx_cmd; | |
1656 | } | |
1657 | ||
1658 | error = ar5523_get_max_rxsz(ar); | |
1659 | if (error) { | |
1660 | ar5523_err(ar, "could not get caps from adapter\n"); | |
1661 | goto out_cancel_rx_cmd; | |
1662 | } | |
1663 | ||
1664 | error = ar5523_get_devcap(ar); | |
1665 | if (error) { | |
1666 | ar5523_err(ar, "could not get caps from adapter\n"); | |
1667 | goto out_cancel_rx_cmd; | |
1668 | } | |
1669 | ||
1670 | error = ar5523_get_devstatus(ar); | |
1671 | if (error != 0) { | |
1672 | ar5523_err(ar, "could not get device status\n"); | |
1673 | goto out_cancel_rx_cmd; | |
1674 | } | |
1675 | ||
1676 | ar5523_info(ar, "MAC/BBP AR5523, RF AR%c112\n", | |
1677 | (id->driver_info & AR5523_FLAG_ABG) ? '5' : '2'); | |
1678 | ||
1679 | ar->vif = NULL; | |
30686bf7 JB |
1680 | ieee80211_hw_set(hw, HAS_RATE_CONTROL); |
1681 | ieee80211_hw_set(hw, RX_INCLUDES_FCS); | |
1682 | ieee80211_hw_set(hw, SIGNAL_DBM); | |
b7d572e1 PF |
1683 | hw->extra_tx_headroom = sizeof(struct ar5523_tx_desc) + |
1684 | sizeof(struct ar5523_chunk); | |
1685 | hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION); | |
1686 | hw->queues = 1; | |
1687 | ||
1688 | error = ar5523_init_modes(ar); | |
1689 | if (error) | |
1690 | goto out_cancel_rx_cmd; | |
1691 | ||
1692 | usb_set_intfdata(intf, hw); | |
1693 | ||
1694 | error = ieee80211_register_hw(hw); | |
1695 | if (error) { | |
1696 | ar5523_err(ar, "could not register device\n"); | |
1697 | goto out_cancel_rx_cmd; | |
1698 | } | |
1699 | ||
1700 | ar5523_info(ar, "Found and initialized AR5523 device\n"); | |
1701 | return 0; | |
1702 | ||
1703 | out_cancel_rx_cmd: | |
1704 | ar5523_cancel_rx_cmd(ar); | |
1705 | out_free_tx_cmd: | |
1706 | ar5523_free_tx_cmd(ar); | |
1707 | out_free_rx_cmd: | |
1708 | ar5523_free_rx_cmd(ar); | |
1709 | out_free_rx_bufs: | |
1710 | ar5523_free_rx_bufs(ar); | |
1711 | out_free_wq: | |
1712 | destroy_workqueue(ar->wq); | |
1713 | out_free_ar: | |
1714 | ieee80211_free_hw(hw); | |
1715 | out: | |
1716 | return error; | |
1717 | } | |
1718 | ||
1719 | static void ar5523_disconnect(struct usb_interface *intf) | |
1720 | { | |
1721 | struct ieee80211_hw *hw = usb_get_intfdata(intf); | |
1722 | struct ar5523 *ar = hw->priv; | |
1723 | ||
1724 | ar5523_dbg(ar, "detaching\n"); | |
1725 | set_bit(AR5523_USB_DISCONNECTED, &ar->flags); | |
1726 | ||
1727 | ieee80211_unregister_hw(hw); | |
1728 | ||
1729 | ar5523_cancel_rx_cmd(ar); | |
1730 | ar5523_free_tx_cmd(ar); | |
1731 | ar5523_free_rx_cmd(ar); | |
1732 | ar5523_free_rx_bufs(ar); | |
1733 | ||
1734 | destroy_workqueue(ar->wq); | |
1735 | ||
1736 | ieee80211_free_hw(hw); | |
1737 | usb_set_intfdata(intf, NULL); | |
1738 | } | |
1739 | ||
1740 | #define AR5523_DEVICE_UG(vendor, device) \ | |
1741 | { USB_DEVICE((vendor), (device)) }, \ | |
1742 | { USB_DEVICE((vendor), (device) + 1), \ | |
1743 | .driver_info = AR5523_FLAG_PRE_FIRMWARE } | |
1744 | #define AR5523_DEVICE_UX(vendor, device) \ | |
1745 | { USB_DEVICE((vendor), (device)), \ | |
1746 | .driver_info = AR5523_FLAG_ABG }, \ | |
1747 | { USB_DEVICE((vendor), (device) + 1), \ | |
1748 | .driver_info = AR5523_FLAG_ABG|AR5523_FLAG_PRE_FIRMWARE } | |
1749 | ||
1750 | static struct usb_device_id ar5523_id_table[] = { | |
1751 | AR5523_DEVICE_UG(0x168c, 0x0001), /* Atheros / AR5523 */ | |
1752 | AR5523_DEVICE_UG(0x0cf3, 0x0001), /* Atheros2 / AR5523_1 */ | |
1753 | AR5523_DEVICE_UG(0x0cf3, 0x0003), /* Atheros2 / AR5523_2 */ | |
1754 | AR5523_DEVICE_UX(0x0cf3, 0x0005), /* Atheros2 / AR5523_3 */ | |
1755 | AR5523_DEVICE_UG(0x0d8e, 0x7801), /* Conceptronic / AR5523_1 */ | |
1756 | AR5523_DEVICE_UX(0x0d8e, 0x7811), /* Conceptronic / AR5523_2 */ | |
1757 | AR5523_DEVICE_UX(0x2001, 0x3a00), /* Dlink / DWLAG132 */ | |
1758 | AR5523_DEVICE_UG(0x2001, 0x3a02), /* Dlink / DWLG132 */ | |
1759 | AR5523_DEVICE_UX(0x2001, 0x3a04), /* Dlink / DWLAG122 */ | |
38e05a0e | 1760 | AR5523_DEVICE_UG(0x07d1, 0x3a07), /* D-Link / WUA-2340 rev A1 */ |
b7d572e1 PF |
1761 | AR5523_DEVICE_UG(0x1690, 0x0712), /* Gigaset / AR5523 */ |
1762 | AR5523_DEVICE_UG(0x1690, 0x0710), /* Gigaset / SMCWUSBTG */ | |
4fcfc744 | 1763 | AR5523_DEVICE_UG(0x129b, 0x160b), /* Gigaset / USB stick 108 |
b7d572e1 PF |
1764 | (CyberTAN Technology) */ |
1765 | AR5523_DEVICE_UG(0x16ab, 0x7801), /* Globalsun / AR5523_1 */ | |
1766 | AR5523_DEVICE_UX(0x16ab, 0x7811), /* Globalsun / AR5523_2 */ | |
1767 | AR5523_DEVICE_UG(0x0d8e, 0x7802), /* Globalsun / AR5523_3 */ | |
1768 | AR5523_DEVICE_UX(0x0846, 0x4300), /* Netgear / WG111U */ | |
1769 | AR5523_DEVICE_UG(0x0846, 0x4250), /* Netgear / WG111T */ | |
1770 | AR5523_DEVICE_UG(0x0846, 0x5f00), /* Netgear / WPN111 */ | |
1771 | AR5523_DEVICE_UG(0x157e, 0x3006), /* Umedia / AR5523_1 */ | |
1772 | AR5523_DEVICE_UX(0x157e, 0x3205), /* Umedia / AR5523_2 */ | |
1773 | AR5523_DEVICE_UG(0x157e, 0x3006), /* Umedia / TEW444UBEU */ | |
1774 | AR5523_DEVICE_UG(0x1435, 0x0826), /* Wistronneweb / AR5523_1 */ | |
1775 | AR5523_DEVICE_UX(0x1435, 0x0828), /* Wistronneweb / AR5523_2 */ | |
1776 | AR5523_DEVICE_UG(0x0cde, 0x0012), /* Zcom / AR5523 */ | |
1777 | AR5523_DEVICE_UG(0x1385, 0x4250), /* Netgear3 / WG111T (2) */ | |
1778 | AR5523_DEVICE_UG(0x1385, 0x5f00), /* Netgear / WPN111 */ | |
1779 | AR5523_DEVICE_UG(0x1385, 0x5f02), /* Netgear / WPN111 */ | |
1780 | { } | |
1781 | }; | |
1782 | MODULE_DEVICE_TABLE(usb, ar5523_id_table); | |
1783 | ||
1784 | static struct usb_driver ar5523_driver = { | |
1785 | .name = "ar5523", | |
1786 | .id_table = ar5523_id_table, | |
1787 | .probe = ar5523_probe, | |
1788 | .disconnect = ar5523_disconnect, | |
1789 | }; | |
1790 | ||
f0a5fd4e | 1791 | module_usb_driver(ar5523_driver); |
b7d572e1 PF |
1792 | |
1793 | MODULE_LICENSE("Dual BSD/GPL"); | |
1794 | MODULE_FIRMWARE(AR5523_FIRMWARE_FILE); |