diff options
Diffstat (limited to 'drivers/net/wireless/wl12xx/wl1251_main.c')
-rw-r--r-- | drivers/net/wireless/wl12xx/wl1251_main.c | 1442 |
1 files changed, 0 insertions, 1442 deletions
diff --git a/drivers/net/wireless/wl12xx/wl1251_main.c b/drivers/net/wireless/wl12xx/wl1251_main.c deleted file mode 100644 index 861a5f33761e..000000000000 --- a/drivers/net/wireless/wl12xx/wl1251_main.c +++ /dev/null | |||
@@ -1,1442 +0,0 @@ | |||
1 | /* | ||
2 | * This file is part of wl1251 | ||
3 | * | ||
4 | * Copyright (C) 2008-2009 Nokia Corporation | ||
5 | * | ||
6 | * Contact: Kalle Valo <kalle.valo@nokia.com> | ||
7 | * | ||
8 | * This program is free software; you can redistribute it and/or | ||
9 | * modify it under the terms of the GNU General Public License | ||
10 | * version 2 as published by the Free Software Foundation. | ||
11 | * | ||
12 | * This program is distributed in the hope that it will be useful, but | ||
13 | * WITHOUT ANY WARRANTY; without even the implied warranty of | ||
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
15 | * General Public License for more details. | ||
16 | * | ||
17 | * You should have received a copy of the GNU General Public License | ||
18 | * along with this program; if not, write to the Free Software | ||
19 | * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA | ||
20 | * 02110-1301 USA | ||
21 | * | ||
22 | */ | ||
23 | |||
24 | #include <linux/module.h> | ||
25 | #include <linux/interrupt.h> | ||
26 | #include <linux/firmware.h> | ||
27 | #include <linux/delay.h> | ||
28 | #include <linux/irq.h> | ||
29 | #include <linux/crc32.h> | ||
30 | #include <linux/etherdevice.h> | ||
31 | #include <linux/vmalloc.h> | ||
32 | #include <linux/slab.h> | ||
33 | |||
34 | #include "wl1251.h" | ||
35 | #include "wl12xx_80211.h" | ||
36 | #include "wl1251_reg.h" | ||
37 | #include "wl1251_io.h" | ||
38 | #include "wl1251_cmd.h" | ||
39 | #include "wl1251_event.h" | ||
40 | #include "wl1251_tx.h" | ||
41 | #include "wl1251_rx.h" | ||
42 | #include "wl1251_ps.h" | ||
43 | #include "wl1251_init.h" | ||
44 | #include "wl1251_debugfs.h" | ||
45 | #include "wl1251_boot.h" | ||
46 | |||
47 | void wl1251_enable_interrupts(struct wl1251 *wl) | ||
48 | { | ||
49 | wl->if_ops->enable_irq(wl); | ||
50 | } | ||
51 | |||
52 | void wl1251_disable_interrupts(struct wl1251 *wl) | ||
53 | { | ||
54 | wl->if_ops->disable_irq(wl); | ||
55 | } | ||
56 | |||
57 | static void wl1251_power_off(struct wl1251 *wl) | ||
58 | { | ||
59 | wl->set_power(false); | ||
60 | } | ||
61 | |||
62 | static void wl1251_power_on(struct wl1251 *wl) | ||
63 | { | ||
64 | wl->set_power(true); | ||
65 | } | ||
66 | |||
67 | static int wl1251_fetch_firmware(struct wl1251 *wl) | ||
68 | { | ||
69 | const struct firmware *fw; | ||
70 | struct device *dev = wiphy_dev(wl->hw->wiphy); | ||
71 | int ret; | ||
72 | |||
73 | ret = request_firmware(&fw, WL1251_FW_NAME, dev); | ||
74 | |||
75 | if (ret < 0) { | ||
76 | wl1251_error("could not get firmware: %d", ret); | ||
77 | return ret; | ||
78 | } | ||
79 | |||
80 | if (fw->size % 4) { | ||
81 | wl1251_error("firmware size is not multiple of 32 bits: %zu", | ||
82 | fw->size); | ||
83 | ret = -EILSEQ; | ||
84 | goto out; | ||
85 | } | ||
86 | |||
87 | wl->fw_len = fw->size; | ||
88 | wl->fw = vmalloc(wl->fw_len); | ||
89 | |||
90 | if (!wl->fw) { | ||
91 | wl1251_error("could not allocate memory for the firmware"); | ||
92 | ret = -ENOMEM; | ||
93 | goto out; | ||
94 | } | ||
95 | |||
96 | memcpy(wl->fw, fw->data, wl->fw_len); | ||
97 | |||
98 | ret = 0; | ||
99 | |||
100 | out: | ||
101 | release_firmware(fw); | ||
102 | |||
103 | return ret; | ||
104 | } | ||
105 | |||
106 | static int wl1251_fetch_nvs(struct wl1251 *wl) | ||
107 | { | ||
108 | const struct firmware *fw; | ||
109 | struct device *dev = wiphy_dev(wl->hw->wiphy); | ||
110 | int ret; | ||
111 | |||
112 | ret = request_firmware(&fw, WL1251_NVS_NAME, dev); | ||
113 | |||
114 | if (ret < 0) { | ||
115 | wl1251_error("could not get nvs file: %d", ret); | ||
116 | return ret; | ||
117 | } | ||
118 | |||
119 | if (fw->size % 4) { | ||
120 | wl1251_error("nvs size is not multiple of 32 bits: %zu", | ||
121 | fw->size); | ||
122 | ret = -EILSEQ; | ||
123 | goto out; | ||
124 | } | ||
125 | |||
126 | wl->nvs_len = fw->size; | ||
127 | wl->nvs = kmemdup(fw->data, wl->nvs_len, GFP_KERNEL); | ||
128 | |||
129 | if (!wl->nvs) { | ||
130 | wl1251_error("could not allocate memory for the nvs file"); | ||
131 | ret = -ENOMEM; | ||
132 | goto out; | ||
133 | } | ||
134 | |||
135 | ret = 0; | ||
136 | |||
137 | out: | ||
138 | release_firmware(fw); | ||
139 | |||
140 | return ret; | ||
141 | } | ||
142 | |||
143 | static void wl1251_fw_wakeup(struct wl1251 *wl) | ||
144 | { | ||
145 | u32 elp_reg; | ||
146 | |||
147 | elp_reg = ELPCTRL_WAKE_UP; | ||
148 | wl1251_write_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, elp_reg); | ||
149 | elp_reg = wl1251_read_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR); | ||
150 | |||
151 | if (!(elp_reg & ELPCTRL_WLAN_READY)) | ||
152 | wl1251_warning("WLAN not ready"); | ||
153 | } | ||
154 | |||
155 | static int wl1251_chip_wakeup(struct wl1251 *wl) | ||
156 | { | ||
157 | int ret = 0; | ||
158 | |||
159 | wl1251_power_on(wl); | ||
160 | msleep(WL1251_POWER_ON_SLEEP); | ||
161 | wl->if_ops->reset(wl); | ||
162 | |||
163 | /* We don't need a real memory partition here, because we only want | ||
164 | * to use the registers at this point. */ | ||
165 | wl1251_set_partition(wl, | ||
166 | 0x00000000, | ||
167 | 0x00000000, | ||
168 | REGISTERS_BASE, | ||
169 | REGISTERS_DOWN_SIZE); | ||
170 | |||
171 | /* ELP module wake up */ | ||
172 | wl1251_fw_wakeup(wl); | ||
173 | |||
174 | /* whal_FwCtrl_BootSm() */ | ||
175 | |||
176 | /* 0. read chip id from CHIP_ID */ | ||
177 | wl->chip_id = wl1251_reg_read32(wl, CHIP_ID_B); | ||
178 | |||
179 | /* 1. check if chip id is valid */ | ||
180 | |||
181 | switch (wl->chip_id) { | ||
182 | case CHIP_ID_1251_PG12: | ||
183 | wl1251_debug(DEBUG_BOOT, "chip id 0x%x (1251 PG12)", | ||
184 | wl->chip_id); | ||
185 | break; | ||
186 | case CHIP_ID_1251_PG11: | ||
187 | wl1251_debug(DEBUG_BOOT, "chip id 0x%x (1251 PG11)", | ||
188 | wl->chip_id); | ||
189 | break; | ||
190 | case CHIP_ID_1251_PG10: | ||
191 | default: | ||
192 | wl1251_error("unsupported chip id: 0x%x", wl->chip_id); | ||
193 | ret = -ENODEV; | ||
194 | goto out; | ||
195 | } | ||
196 | |||
197 | if (wl->fw == NULL) { | ||
198 | ret = wl1251_fetch_firmware(wl); | ||
199 | if (ret < 0) | ||
200 | goto out; | ||
201 | } | ||
202 | |||
203 | if (wl->nvs == NULL && !wl->use_eeprom) { | ||
204 | /* No NVS from netlink, try to get it from the filesystem */ | ||
205 | ret = wl1251_fetch_nvs(wl); | ||
206 | if (ret < 0) | ||
207 | goto out; | ||
208 | } | ||
209 | |||
210 | out: | ||
211 | return ret; | ||
212 | } | ||
213 | |||
214 | #define WL1251_IRQ_LOOP_COUNT 10 | ||
215 | static void wl1251_irq_work(struct work_struct *work) | ||
216 | { | ||
217 | u32 intr, ctr = WL1251_IRQ_LOOP_COUNT; | ||
218 | struct wl1251 *wl = | ||
219 | container_of(work, struct wl1251, irq_work); | ||
220 | int ret; | ||
221 | |||
222 | mutex_lock(&wl->mutex); | ||
223 | |||
224 | wl1251_debug(DEBUG_IRQ, "IRQ work"); | ||
225 | |||
226 | if (wl->state == WL1251_STATE_OFF) | ||
227 | goto out; | ||
228 | |||
229 | ret = wl1251_ps_elp_wakeup(wl); | ||
230 | if (ret < 0) | ||
231 | goto out; | ||
232 | |||
233 | wl1251_reg_write32(wl, ACX_REG_INTERRUPT_MASK, WL1251_ACX_INTR_ALL); | ||
234 | |||
235 | intr = wl1251_reg_read32(wl, ACX_REG_INTERRUPT_CLEAR); | ||
236 | wl1251_debug(DEBUG_IRQ, "intr: 0x%x", intr); | ||
237 | |||
238 | do { | ||
239 | if (wl->data_path) { | ||
240 | wl->rx_counter = wl1251_mem_read32( | ||
241 | wl, wl->data_path->rx_control_addr); | ||
242 | |||
243 | /* We handle a frmware bug here */ | ||
244 | switch ((wl->rx_counter - wl->rx_handled) & 0xf) { | ||
245 | case 0: | ||
246 | wl1251_debug(DEBUG_IRQ, | ||
247 | "RX: FW and host in sync"); | ||
248 | intr &= ~WL1251_ACX_INTR_RX0_DATA; | ||
249 | intr &= ~WL1251_ACX_INTR_RX1_DATA; | ||
250 | break; | ||
251 | case 1: | ||
252 | wl1251_debug(DEBUG_IRQ, "RX: FW +1"); | ||
253 | intr |= WL1251_ACX_INTR_RX0_DATA; | ||
254 | intr &= ~WL1251_ACX_INTR_RX1_DATA; | ||
255 | break; | ||
256 | case 2: | ||
257 | wl1251_debug(DEBUG_IRQ, "RX: FW +2"); | ||
258 | intr |= WL1251_ACX_INTR_RX0_DATA; | ||
259 | intr |= WL1251_ACX_INTR_RX1_DATA; | ||
260 | break; | ||
261 | default: | ||
262 | wl1251_warning( | ||
263 | "RX: FW and host out of sync: %d", | ||
264 | wl->rx_counter - wl->rx_handled); | ||
265 | break; | ||
266 | } | ||
267 | |||
268 | wl->rx_handled = wl->rx_counter; | ||
269 | |||
270 | wl1251_debug(DEBUG_IRQ, "RX counter: %d", | ||
271 | wl->rx_counter); | ||
272 | } | ||
273 | |||
274 | intr &= wl->intr_mask; | ||
275 | |||
276 | if (intr == 0) { | ||
277 | wl1251_debug(DEBUG_IRQ, "INTR is 0"); | ||
278 | goto out_sleep; | ||
279 | } | ||
280 | |||
281 | if (intr & WL1251_ACX_INTR_RX0_DATA) { | ||
282 | wl1251_debug(DEBUG_IRQ, "WL1251_ACX_INTR_RX0_DATA"); | ||
283 | wl1251_rx(wl); | ||
284 | } | ||
285 | |||
286 | if (intr & WL1251_ACX_INTR_RX1_DATA) { | ||
287 | wl1251_debug(DEBUG_IRQ, "WL1251_ACX_INTR_RX1_DATA"); | ||
288 | wl1251_rx(wl); | ||
289 | } | ||
290 | |||
291 | if (intr & WL1251_ACX_INTR_TX_RESULT) { | ||
292 | wl1251_debug(DEBUG_IRQ, "WL1251_ACX_INTR_TX_RESULT"); | ||
293 | wl1251_tx_complete(wl); | ||
294 | } | ||
295 | |||
296 | if (intr & (WL1251_ACX_INTR_EVENT_A | | ||
297 | WL1251_ACX_INTR_EVENT_B)) { | ||
298 | wl1251_debug(DEBUG_IRQ, "WL1251_ACX_INTR_EVENT (0x%x)", | ||
299 | intr); | ||
300 | if (intr & WL1251_ACX_INTR_EVENT_A) | ||
301 | wl1251_event_handle(wl, 0); | ||
302 | else | ||
303 | wl1251_event_handle(wl, 1); | ||
304 | } | ||
305 | |||
306 | if (intr & WL1251_ACX_INTR_INIT_COMPLETE) | ||
307 | wl1251_debug(DEBUG_IRQ, | ||
308 | "WL1251_ACX_INTR_INIT_COMPLETE"); | ||
309 | |||
310 | if (--ctr == 0) | ||
311 | break; | ||
312 | |||
313 | intr = wl1251_reg_read32(wl, ACX_REG_INTERRUPT_CLEAR); | ||
314 | } while (intr); | ||
315 | |||
316 | out_sleep: | ||
317 | wl1251_reg_write32(wl, ACX_REG_INTERRUPT_MASK, ~(wl->intr_mask)); | ||
318 | wl1251_ps_elp_sleep(wl); | ||
319 | |||
320 | out: | ||
321 | mutex_unlock(&wl->mutex); | ||
322 | } | ||
323 | |||
324 | static int wl1251_join(struct wl1251 *wl, u8 bss_type, u8 channel, | ||
325 | u16 beacon_interval, u8 dtim_period) | ||
326 | { | ||
327 | int ret; | ||
328 | |||
329 | ret = wl1251_acx_frame_rates(wl, DEFAULT_HW_GEN_TX_RATE, | ||
330 | DEFAULT_HW_GEN_MODULATION_TYPE, | ||
331 | wl->tx_mgmt_frm_rate, | ||
332 | wl->tx_mgmt_frm_mod); | ||
333 | if (ret < 0) | ||
334 | goto out; | ||
335 | |||
336 | |||
337 | ret = wl1251_cmd_join(wl, bss_type, channel, beacon_interval, | ||
338 | dtim_period); | ||
339 | if (ret < 0) | ||
340 | goto out; | ||
341 | |||
342 | /* | ||
343 | * FIXME: we should wait for JOIN_EVENT_COMPLETE_ID but to simplify | ||
344 | * locking we just sleep instead, for now | ||
345 | */ | ||
346 | msleep(10); | ||
347 | |||
348 | out: | ||
349 | return ret; | ||
350 | } | ||
351 | |||
352 | static void wl1251_filter_work(struct work_struct *work) | ||
353 | { | ||
354 | struct wl1251 *wl = | ||
355 | container_of(work, struct wl1251, filter_work); | ||
356 | int ret; | ||
357 | |||
358 | mutex_lock(&wl->mutex); | ||
359 | |||
360 | if (wl->state == WL1251_STATE_OFF) | ||
361 | goto out; | ||
362 | |||
363 | ret = wl1251_ps_elp_wakeup(wl); | ||
364 | if (ret < 0) | ||
365 | goto out; | ||
366 | |||
367 | ret = wl1251_join(wl, wl->bss_type, wl->channel, wl->beacon_int, | ||
368 | wl->dtim_period); | ||
369 | if (ret < 0) | ||
370 | goto out_sleep; | ||
371 | |||
372 | out_sleep: | ||
373 | wl1251_ps_elp_sleep(wl); | ||
374 | |||
375 | out: | ||
376 | mutex_unlock(&wl->mutex); | ||
377 | } | ||
378 | |||
379 | static int wl1251_op_tx(struct ieee80211_hw *hw, struct sk_buff *skb) | ||
380 | { | ||
381 | struct wl1251 *wl = hw->priv; | ||
382 | |||
383 | skb_queue_tail(&wl->tx_queue, skb); | ||
384 | |||
385 | /* | ||
386 | * The chip specific setup must run before the first TX packet - | ||
387 | * before that, the tx_work will not be initialized! | ||
388 | */ | ||
389 | |||
390 | ieee80211_queue_work(wl->hw, &wl->tx_work); | ||
391 | |||
392 | /* | ||
393 | * The workqueue is slow to process the tx_queue and we need stop | ||
394 | * the queue here, otherwise the queue will get too long. | ||
395 | */ | ||
396 | if (skb_queue_len(&wl->tx_queue) >= WL1251_TX_QUEUE_MAX_LENGTH) { | ||
397 | wl1251_debug(DEBUG_TX, "op_tx: tx_queue full, stop queues"); | ||
398 | ieee80211_stop_queues(wl->hw); | ||
399 | |||
400 | /* | ||
401 | * FIXME: this is racy, the variable is not properly | ||
402 | * protected. Maybe fix this by removing the stupid | ||
403 | * variable altogether and checking the real queue state? | ||
404 | */ | ||
405 | wl->tx_queue_stopped = true; | ||
406 | } | ||
407 | |||
408 | return NETDEV_TX_OK; | ||
409 | } | ||
410 | |||
411 | static int wl1251_op_start(struct ieee80211_hw *hw) | ||
412 | { | ||
413 | struct wl1251 *wl = hw->priv; | ||
414 | struct wiphy *wiphy = hw->wiphy; | ||
415 | int ret = 0; | ||
416 | |||
417 | wl1251_debug(DEBUG_MAC80211, "mac80211 start"); | ||
418 | |||
419 | mutex_lock(&wl->mutex); | ||
420 | |||
421 | if (wl->state != WL1251_STATE_OFF) { | ||
422 | wl1251_error("cannot start because not in off state: %d", | ||
423 | wl->state); | ||
424 | ret = -EBUSY; | ||
425 | goto out; | ||
426 | } | ||
427 | |||
428 | ret = wl1251_chip_wakeup(wl); | ||
429 | if (ret < 0) | ||
430 | goto out; | ||
431 | |||
432 | ret = wl1251_boot(wl); | ||
433 | if (ret < 0) | ||
434 | goto out; | ||
435 | |||
436 | ret = wl1251_hw_init(wl); | ||
437 | if (ret < 0) | ||
438 | goto out; | ||
439 | |||
440 | ret = wl1251_acx_station_id(wl); | ||
441 | if (ret < 0) | ||
442 | goto out; | ||
443 | |||
444 | wl->state = WL1251_STATE_ON; | ||
445 | |||
446 | wl1251_info("firmware booted (%s)", wl->fw_ver); | ||
447 | |||
448 | /* update hw/fw version info in wiphy struct */ | ||
449 | wiphy->hw_version = wl->chip_id; | ||
450 | strncpy(wiphy->fw_version, wl->fw_ver, sizeof(wiphy->fw_version)); | ||
451 | |||
452 | out: | ||
453 | if (ret < 0) | ||
454 | wl1251_power_off(wl); | ||
455 | |||
456 | mutex_unlock(&wl->mutex); | ||
457 | |||
458 | return ret; | ||
459 | } | ||
460 | |||
461 | static void wl1251_op_stop(struct ieee80211_hw *hw) | ||
462 | { | ||
463 | struct wl1251 *wl = hw->priv; | ||
464 | |||
465 | wl1251_info("down"); | ||
466 | |||
467 | wl1251_debug(DEBUG_MAC80211, "mac80211 stop"); | ||
468 | |||
469 | mutex_lock(&wl->mutex); | ||
470 | |||
471 | WARN_ON(wl->state != WL1251_STATE_ON); | ||
472 | |||
473 | if (wl->scanning) { | ||
474 | mutex_unlock(&wl->mutex); | ||
475 | ieee80211_scan_completed(wl->hw, true); | ||
476 | mutex_lock(&wl->mutex); | ||
477 | wl->scanning = false; | ||
478 | } | ||
479 | |||
480 | wl->state = WL1251_STATE_OFF; | ||
481 | |||
482 | wl1251_disable_interrupts(wl); | ||
483 | |||
484 | mutex_unlock(&wl->mutex); | ||
485 | |||
486 | cancel_work_sync(&wl->irq_work); | ||
487 | cancel_work_sync(&wl->tx_work); | ||
488 | cancel_work_sync(&wl->filter_work); | ||
489 | |||
490 | mutex_lock(&wl->mutex); | ||
491 | |||
492 | /* let's notify MAC80211 about the remaining pending TX frames */ | ||
493 | wl1251_tx_flush(wl); | ||
494 | wl1251_power_off(wl); | ||
495 | |||
496 | memset(wl->bssid, 0, ETH_ALEN); | ||
497 | wl->listen_int = 1; | ||
498 | wl->bss_type = MAX_BSS_TYPE; | ||
499 | |||
500 | wl->data_in_count = 0; | ||
501 | wl->rx_counter = 0; | ||
502 | wl->rx_handled = 0; | ||
503 | wl->rx_current_buffer = 0; | ||
504 | wl->rx_last_id = 0; | ||
505 | wl->next_tx_complete = 0; | ||
506 | wl->elp = false; | ||
507 | wl->psm = 0; | ||
508 | wl->tx_queue_stopped = false; | ||
509 | wl->power_level = WL1251_DEFAULT_POWER_LEVEL; | ||
510 | wl->channel = WL1251_DEFAULT_CHANNEL; | ||
511 | |||
512 | wl1251_debugfs_reset(wl); | ||
513 | |||
514 | mutex_unlock(&wl->mutex); | ||
515 | } | ||
516 | |||
517 | static int wl1251_op_add_interface(struct ieee80211_hw *hw, | ||
518 | struct ieee80211_vif *vif) | ||
519 | { | ||
520 | struct wl1251 *wl = hw->priv; | ||
521 | int ret = 0; | ||
522 | |||
523 | wl1251_debug(DEBUG_MAC80211, "mac80211 add interface type %d mac %pM", | ||
524 | vif->type, vif->addr); | ||
525 | |||
526 | mutex_lock(&wl->mutex); | ||
527 | if (wl->vif) { | ||
528 | ret = -EBUSY; | ||
529 | goto out; | ||
530 | } | ||
531 | |||
532 | wl->vif = vif; | ||
533 | |||
534 | switch (vif->type) { | ||
535 | case NL80211_IFTYPE_STATION: | ||
536 | wl->bss_type = BSS_TYPE_STA_BSS; | ||
537 | break; | ||
538 | case NL80211_IFTYPE_ADHOC: | ||
539 | wl->bss_type = BSS_TYPE_IBSS; | ||
540 | break; | ||
541 | default: | ||
542 | ret = -EOPNOTSUPP; | ||
543 | goto out; | ||
544 | } | ||
545 | |||
546 | if (memcmp(wl->mac_addr, vif->addr, ETH_ALEN)) { | ||
547 | memcpy(wl->mac_addr, vif->addr, ETH_ALEN); | ||
548 | SET_IEEE80211_PERM_ADDR(wl->hw, wl->mac_addr); | ||
549 | ret = wl1251_acx_station_id(wl); | ||
550 | if (ret < 0) | ||
551 | goto out; | ||
552 | } | ||
553 | |||
554 | out: | ||
555 | mutex_unlock(&wl->mutex); | ||
556 | return ret; | ||
557 | } | ||
558 | |||
559 | static void wl1251_op_remove_interface(struct ieee80211_hw *hw, | ||
560 | struct ieee80211_vif *vif) | ||
561 | { | ||
562 | struct wl1251 *wl = hw->priv; | ||
563 | |||
564 | mutex_lock(&wl->mutex); | ||
565 | wl1251_debug(DEBUG_MAC80211, "mac80211 remove interface"); | ||
566 | wl->vif = NULL; | ||
567 | mutex_unlock(&wl->mutex); | ||
568 | } | ||
569 | |||
570 | static int wl1251_build_qos_null_data(struct wl1251 *wl) | ||
571 | { | ||
572 | struct ieee80211_qos_hdr template; | ||
573 | |||
574 | memset(&template, 0, sizeof(template)); | ||
575 | |||
576 | memcpy(template.addr1, wl->bssid, ETH_ALEN); | ||
577 | memcpy(template.addr2, wl->mac_addr, ETH_ALEN); | ||
578 | memcpy(template.addr3, wl->bssid, ETH_ALEN); | ||
579 | |||
580 | template.frame_control = cpu_to_le16(IEEE80211_FTYPE_DATA | | ||
581 | IEEE80211_STYPE_QOS_NULLFUNC | | ||
582 | IEEE80211_FCTL_TODS); | ||
583 | |||
584 | /* FIXME: not sure what priority to use here */ | ||
585 | template.qos_ctrl = cpu_to_le16(0); | ||
586 | |||
587 | return wl1251_cmd_template_set(wl, CMD_QOS_NULL_DATA, &template, | ||
588 | sizeof(template)); | ||
589 | } | ||
590 | |||
591 | static int wl1251_op_config(struct ieee80211_hw *hw, u32 changed) | ||
592 | { | ||
593 | struct wl1251 *wl = hw->priv; | ||
594 | struct ieee80211_conf *conf = &hw->conf; | ||
595 | int channel, ret = 0; | ||
596 | |||
597 | channel = ieee80211_frequency_to_channel(conf->channel->center_freq); | ||
598 | |||
599 | wl1251_debug(DEBUG_MAC80211, "mac80211 config ch %d psm %s power %d", | ||
600 | channel, | ||
601 | conf->flags & IEEE80211_CONF_PS ? "on" : "off", | ||
602 | conf->power_level); | ||
603 | |||
604 | mutex_lock(&wl->mutex); | ||
605 | |||
606 | ret = wl1251_ps_elp_wakeup(wl); | ||
607 | if (ret < 0) | ||
608 | goto out; | ||
609 | |||
610 | if (channel != wl->channel) { | ||
611 | wl->channel = channel; | ||
612 | |||
613 | ret = wl1251_join(wl, wl->bss_type, wl->channel, | ||
614 | wl->beacon_int, wl->dtim_period); | ||
615 | if (ret < 0) | ||
616 | goto out_sleep; | ||
617 | } | ||
618 | |||
619 | if (conf->flags & IEEE80211_CONF_PS && !wl->psm_requested) { | ||
620 | wl1251_debug(DEBUG_PSM, "psm enabled"); | ||
621 | |||
622 | wl->psm_requested = true; | ||
623 | |||
624 | wl->dtim_period = conf->ps_dtim_period; | ||
625 | |||
626 | ret = wl1251_acx_wr_tbtt_and_dtim(wl, wl->beacon_int, | ||
627 | wl->dtim_period); | ||
628 | |||
629 | /* | ||
630 | * mac80211 enables PSM only if we're already associated. | ||
631 | */ | ||
632 | ret = wl1251_ps_set_mode(wl, STATION_POWER_SAVE_MODE); | ||
633 | if (ret < 0) | ||
634 | goto out_sleep; | ||
635 | } else if (!(conf->flags & IEEE80211_CONF_PS) && | ||
636 | wl->psm_requested) { | ||
637 | wl1251_debug(DEBUG_PSM, "psm disabled"); | ||
638 | |||
639 | wl->psm_requested = false; | ||
640 | |||
641 | if (wl->psm) { | ||
642 | ret = wl1251_ps_set_mode(wl, STATION_ACTIVE_MODE); | ||
643 | if (ret < 0) | ||
644 | goto out_sleep; | ||
645 | } | ||
646 | } | ||
647 | |||
648 | if (conf->power_level != wl->power_level) { | ||
649 | ret = wl1251_acx_tx_power(wl, conf->power_level); | ||
650 | if (ret < 0) | ||
651 | goto out_sleep; | ||
652 | |||
653 | wl->power_level = conf->power_level; | ||
654 | } | ||
655 | |||
656 | out_sleep: | ||
657 | wl1251_ps_elp_sleep(wl); | ||
658 | |||
659 | out: | ||
660 | mutex_unlock(&wl->mutex); | ||
661 | |||
662 | return ret; | ||
663 | } | ||
664 | |||
665 | #define WL1251_SUPPORTED_FILTERS (FIF_PROMISC_IN_BSS | \ | ||
666 | FIF_ALLMULTI | \ | ||
667 | FIF_FCSFAIL | \ | ||
668 | FIF_BCN_PRBRESP_PROMISC | \ | ||
669 | FIF_CONTROL | \ | ||
670 | FIF_OTHER_BSS) | ||
671 | |||
672 | static void wl1251_op_configure_filter(struct ieee80211_hw *hw, | ||
673 | unsigned int changed, | ||
674 | unsigned int *total,u64 multicast) | ||
675 | { | ||
676 | struct wl1251 *wl = hw->priv; | ||
677 | |||
678 | wl1251_debug(DEBUG_MAC80211, "mac80211 configure filter"); | ||
679 | |||
680 | *total &= WL1251_SUPPORTED_FILTERS; | ||
681 | changed &= WL1251_SUPPORTED_FILTERS; | ||
682 | |||
683 | if (changed == 0) | ||
684 | /* no filters which we support changed */ | ||
685 | return; | ||
686 | |||
687 | /* FIXME: wl->rx_config and wl->rx_filter are not protected */ | ||
688 | |||
689 | wl->rx_config = WL1251_DEFAULT_RX_CONFIG; | ||
690 | wl->rx_filter = WL1251_DEFAULT_RX_FILTER; | ||
691 | |||
692 | if (*total & FIF_PROMISC_IN_BSS) { | ||
693 | wl->rx_config |= CFG_BSSID_FILTER_EN; | ||
694 | wl->rx_config |= CFG_RX_ALL_GOOD; | ||
695 | } | ||
696 | if (*total & FIF_ALLMULTI) | ||
697 | /* | ||
698 | * CFG_MC_FILTER_EN in rx_config needs to be 0 to receive | ||
699 | * all multicast frames | ||
700 | */ | ||
701 | wl->rx_config &= ~CFG_MC_FILTER_EN; | ||
702 | if (*total & FIF_FCSFAIL) | ||
703 | wl->rx_filter |= CFG_RX_FCS_ERROR; | ||
704 | if (*total & FIF_BCN_PRBRESP_PROMISC) { | ||
705 | wl->rx_config &= ~CFG_BSSID_FILTER_EN; | ||
706 | wl->rx_config &= ~CFG_SSID_FILTER_EN; | ||
707 | } | ||
708 | if (*total & FIF_CONTROL) | ||
709 | wl->rx_filter |= CFG_RX_CTL_EN; | ||
710 | if (*total & FIF_OTHER_BSS) | ||
711 | wl->rx_filter &= ~CFG_BSSID_FILTER_EN; | ||
712 | |||
713 | /* | ||
714 | * FIXME: workqueues need to be properly cancelled on stop(), for | ||
715 | * now let's just disable changing the filter settings. They will | ||
716 | * be updated any on config(). | ||
717 | */ | ||
718 | /* schedule_work(&wl->filter_work); */ | ||
719 | } | ||
720 | |||
721 | /* HW encryption */ | ||
722 | static int wl1251_set_key_type(struct wl1251 *wl, | ||
723 | struct wl1251_cmd_set_keys *key, | ||
724 | enum set_key_cmd cmd, | ||
725 | struct ieee80211_key_conf *mac80211_key, | ||
726 | const u8 *addr) | ||
727 | { | ||
728 | switch (mac80211_key->alg) { | ||
729 | case ALG_WEP: | ||
730 | if (is_broadcast_ether_addr(addr)) | ||
731 | key->key_type = KEY_WEP_DEFAULT; | ||
732 | else | ||
733 | key->key_type = KEY_WEP_ADDR; | ||
734 | |||
735 | mac80211_key->hw_key_idx = mac80211_key->keyidx; | ||
736 | break; | ||
737 | case ALG_TKIP: | ||
738 | if (is_broadcast_ether_addr(addr)) | ||
739 | key->key_type = KEY_TKIP_MIC_GROUP; | ||
740 | else | ||
741 | key->key_type = KEY_TKIP_MIC_PAIRWISE; | ||
742 | |||
743 | mac80211_key->hw_key_idx = mac80211_key->keyidx; | ||
744 | break; | ||
745 | case ALG_CCMP: | ||
746 | if (is_broadcast_ether_addr(addr)) | ||
747 | key->key_type = KEY_AES_GROUP; | ||
748 | else | ||
749 | key->key_type = KEY_AES_PAIRWISE; | ||
750 | mac80211_key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV; | ||
751 | break; | ||
752 | default: | ||
753 | wl1251_error("Unknown key algo 0x%x", mac80211_key->alg); | ||
754 | return -EOPNOTSUPP; | ||
755 | } | ||
756 | |||
757 | return 0; | ||
758 | } | ||
759 | |||
760 | static int wl1251_op_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd, | ||
761 | struct ieee80211_vif *vif, | ||
762 | struct ieee80211_sta *sta, | ||
763 | struct ieee80211_key_conf *key) | ||
764 | { | ||
765 | struct wl1251 *wl = hw->priv; | ||
766 | struct wl1251_cmd_set_keys *wl_cmd; | ||
767 | const u8 *addr; | ||
768 | int ret; | ||
769 | |||
770 | static const u8 bcast_addr[ETH_ALEN] = | ||
771 | { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; | ||
772 | |||
773 | wl1251_debug(DEBUG_MAC80211, "mac80211 set key"); | ||
774 | |||
775 | wl_cmd = kzalloc(sizeof(*wl_cmd), GFP_KERNEL); | ||
776 | if (!wl_cmd) { | ||
777 | ret = -ENOMEM; | ||
778 | goto out; | ||
779 | } | ||
780 | |||
781 | addr = sta ? sta->addr : bcast_addr; | ||
782 | |||
783 | wl1251_debug(DEBUG_CRYPT, "CMD: 0x%x", cmd); | ||
784 | wl1251_dump(DEBUG_CRYPT, "ADDR: ", addr, ETH_ALEN); | ||
785 | wl1251_debug(DEBUG_CRYPT, "Key: algo:0x%x, id:%d, len:%d flags 0x%x", | ||
786 | key->alg, key->keyidx, key->keylen, key->flags); | ||
787 | wl1251_dump(DEBUG_CRYPT, "KEY: ", key->key, key->keylen); | ||
788 | |||
789 | if (is_zero_ether_addr(addr)) { | ||
790 | /* We dont support TX only encryption */ | ||
791 | ret = -EOPNOTSUPP; | ||
792 | goto out; | ||
793 | } | ||
794 | |||
795 | mutex_lock(&wl->mutex); | ||
796 | |||
797 | ret = wl1251_ps_elp_wakeup(wl); | ||
798 | if (ret < 0) | ||
799 | goto out_unlock; | ||
800 | |||
801 | switch (cmd) { | ||
802 | case SET_KEY: | ||
803 | wl_cmd->key_action = KEY_ADD_OR_REPLACE; | ||
804 | break; | ||
805 | case DISABLE_KEY: | ||
806 | wl_cmd->key_action = KEY_REMOVE; | ||
807 | break; | ||
808 | default: | ||
809 | wl1251_error("Unsupported key cmd 0x%x", cmd); | ||
810 | break; | ||
811 | } | ||
812 | |||
813 | ret = wl1251_set_key_type(wl, wl_cmd, cmd, key, addr); | ||
814 | if (ret < 0) { | ||
815 | wl1251_error("Set KEY type failed"); | ||
816 | goto out_sleep; | ||
817 | } | ||
818 | |||
819 | if (wl_cmd->key_type != KEY_WEP_DEFAULT) | ||
820 | memcpy(wl_cmd->addr, addr, ETH_ALEN); | ||
821 | |||
822 | if ((wl_cmd->key_type == KEY_TKIP_MIC_GROUP) || | ||
823 | (wl_cmd->key_type == KEY_TKIP_MIC_PAIRWISE)) { | ||
824 | /* | ||
825 | * We get the key in the following form: | ||
826 | * TKIP (16 bytes) - TX MIC (8 bytes) - RX MIC (8 bytes) | ||
827 | * but the target is expecting: | ||
828 | * TKIP - RX MIC - TX MIC | ||
829 | */ | ||
830 | memcpy(wl_cmd->key, key->key, 16); | ||
831 | memcpy(wl_cmd->key + 16, key->key + 24, 8); | ||
832 | memcpy(wl_cmd->key + 24, key->key + 16, 8); | ||
833 | |||
834 | } else { | ||
835 | memcpy(wl_cmd->key, key->key, key->keylen); | ||
836 | } | ||
837 | wl_cmd->key_size = key->keylen; | ||
838 | |||
839 | wl_cmd->id = key->keyidx; | ||
840 | wl_cmd->ssid_profile = 0; | ||
841 | |||
842 | wl1251_dump(DEBUG_CRYPT, "TARGET KEY: ", wl_cmd, sizeof(*wl_cmd)); | ||
843 | |||
844 | ret = wl1251_cmd_send(wl, CMD_SET_KEYS, wl_cmd, sizeof(*wl_cmd)); | ||
845 | if (ret < 0) { | ||
846 | wl1251_warning("could not set keys"); | ||
847 | goto out_sleep; | ||
848 | } | ||
849 | |||
850 | out_sleep: | ||
851 | wl1251_ps_elp_sleep(wl); | ||
852 | |||
853 | out_unlock: | ||
854 | mutex_unlock(&wl->mutex); | ||
855 | |||
856 | out: | ||
857 | kfree(wl_cmd); | ||
858 | |||
859 | return ret; | ||
860 | } | ||
861 | |||
862 | static int wl1251_op_hw_scan(struct ieee80211_hw *hw, | ||
863 | struct ieee80211_vif *vif, | ||
864 | struct cfg80211_scan_request *req) | ||
865 | { | ||
866 | struct wl1251 *wl = hw->priv; | ||
867 | struct sk_buff *skb; | ||
868 | size_t ssid_len = 0; | ||
869 | u8 *ssid = NULL; | ||
870 | int ret; | ||
871 | |||
872 | wl1251_debug(DEBUG_MAC80211, "mac80211 hw scan"); | ||
873 | |||
874 | if (req->n_ssids) { | ||
875 | ssid = req->ssids[0].ssid; | ||
876 | ssid_len = req->ssids[0].ssid_len; | ||
877 | } | ||
878 | |||
879 | mutex_lock(&wl->mutex); | ||
880 | |||
881 | if (wl->scanning) { | ||
882 | wl1251_debug(DEBUG_SCAN, "scan already in progress"); | ||
883 | ret = -EINVAL; | ||
884 | goto out; | ||
885 | } | ||
886 | |||
887 | ret = wl1251_ps_elp_wakeup(wl); | ||
888 | if (ret < 0) | ||
889 | goto out; | ||
890 | |||
891 | skb = ieee80211_probereq_get(wl->hw, wl->vif, ssid, ssid_len, | ||
892 | req->ie, req->ie_len); | ||
893 | if (!skb) { | ||
894 | ret = -ENOMEM; | ||
895 | goto out; | ||
896 | } | ||
897 | |||
898 | ret = wl1251_cmd_template_set(wl, CMD_PROBE_REQ, skb->data, | ||
899 | skb->len); | ||
900 | dev_kfree_skb(skb); | ||
901 | if (ret < 0) | ||
902 | goto out_sleep; | ||
903 | |||
904 | ret = wl1251_cmd_trigger_scan_to(wl, 0); | ||
905 | if (ret < 0) | ||
906 | goto out_sleep; | ||
907 | |||
908 | wl->scanning = true; | ||
909 | |||
910 | ret = wl1251_cmd_scan(wl, ssid, ssid_len, req->channels, | ||
911 | req->n_channels, WL1251_SCAN_NUM_PROBES); | ||
912 | if (ret < 0) { | ||
913 | wl->scanning = false; | ||
914 | goto out_sleep; | ||
915 | } | ||
916 | |||
917 | out_sleep: | ||
918 | wl1251_ps_elp_sleep(wl); | ||
919 | |||
920 | out: | ||
921 | mutex_unlock(&wl->mutex); | ||
922 | |||
923 | return ret; | ||
924 | } | ||
925 | |||
926 | static int wl1251_op_set_rts_threshold(struct ieee80211_hw *hw, u32 value) | ||
927 | { | ||
928 | struct wl1251 *wl = hw->priv; | ||
929 | int ret; | ||
930 | |||
931 | mutex_lock(&wl->mutex); | ||
932 | |||
933 | ret = wl1251_ps_elp_wakeup(wl); | ||
934 | if (ret < 0) | ||
935 | goto out; | ||
936 | |||
937 | ret = wl1251_acx_rts_threshold(wl, (u16) value); | ||
938 | if (ret < 0) | ||
939 | wl1251_warning("wl1251_op_set_rts_threshold failed: %d", ret); | ||
940 | |||
941 | wl1251_ps_elp_sleep(wl); | ||
942 | |||
943 | out: | ||
944 | mutex_unlock(&wl->mutex); | ||
945 | |||
946 | return ret; | ||
947 | } | ||
948 | |||
949 | static void wl1251_op_bss_info_changed(struct ieee80211_hw *hw, | ||
950 | struct ieee80211_vif *vif, | ||
951 | struct ieee80211_bss_conf *bss_conf, | ||
952 | u32 changed) | ||
953 | { | ||
954 | struct wl1251 *wl = hw->priv; | ||
955 | struct sk_buff *beacon, *skb; | ||
956 | int ret; | ||
957 | |||
958 | wl1251_debug(DEBUG_MAC80211, "mac80211 bss info changed"); | ||
959 | |||
960 | mutex_lock(&wl->mutex); | ||
961 | |||
962 | ret = wl1251_ps_elp_wakeup(wl); | ||
963 | if (ret < 0) | ||
964 | goto out; | ||
965 | |||
966 | if (changed & BSS_CHANGED_BSSID) { | ||
967 | memcpy(wl->bssid, bss_conf->bssid, ETH_ALEN); | ||
968 | |||
969 | skb = ieee80211_nullfunc_get(wl->hw, wl->vif); | ||
970 | if (!skb) | ||
971 | goto out_sleep; | ||
972 | |||
973 | ret = wl1251_cmd_template_set(wl, CMD_NULL_DATA, | ||
974 | skb->data, skb->len); | ||
975 | dev_kfree_skb(skb); | ||
976 | if (ret < 0) | ||
977 | goto out_sleep; | ||
978 | |||
979 | ret = wl1251_build_qos_null_data(wl); | ||
980 | if (ret < 0) | ||
981 | goto out; | ||
982 | |||
983 | if (wl->bss_type != BSS_TYPE_IBSS) { | ||
984 | ret = wl1251_join(wl, wl->bss_type, wl->channel, | ||
985 | wl->beacon_int, wl->dtim_period); | ||
986 | if (ret < 0) | ||
987 | goto out_sleep; | ||
988 | } | ||
989 | } | ||
990 | |||
991 | if (changed & BSS_CHANGED_ASSOC) { | ||
992 | if (bss_conf->assoc) { | ||
993 | wl->beacon_int = bss_conf->beacon_int; | ||
994 | |||
995 | skb = ieee80211_pspoll_get(wl->hw, wl->vif); | ||
996 | if (!skb) | ||
997 | goto out_sleep; | ||
998 | |||
999 | ret = wl1251_cmd_template_set(wl, CMD_PS_POLL, | ||
1000 | skb->data, | ||
1001 | skb->len); | ||
1002 | dev_kfree_skb(skb); | ||
1003 | if (ret < 0) | ||
1004 | goto out_sleep; | ||
1005 | |||
1006 | ret = wl1251_acx_aid(wl, bss_conf->aid); | ||
1007 | if (ret < 0) | ||
1008 | goto out_sleep; | ||
1009 | } else { | ||
1010 | /* use defaults when not associated */ | ||
1011 | wl->beacon_int = WL1251_DEFAULT_BEACON_INT; | ||
1012 | wl->dtim_period = WL1251_DEFAULT_DTIM_PERIOD; | ||
1013 | } | ||
1014 | } | ||
1015 | if (changed & BSS_CHANGED_ERP_SLOT) { | ||
1016 | if (bss_conf->use_short_slot) | ||
1017 | ret = wl1251_acx_slot(wl, SLOT_TIME_SHORT); | ||
1018 | else | ||
1019 | ret = wl1251_acx_slot(wl, SLOT_TIME_LONG); | ||
1020 | if (ret < 0) { | ||
1021 | wl1251_warning("Set slot time failed %d", ret); | ||
1022 | goto out_sleep; | ||
1023 | } | ||
1024 | } | ||
1025 | |||
1026 | if (changed & BSS_CHANGED_ERP_PREAMBLE) { | ||
1027 | if (bss_conf->use_short_preamble) | ||
1028 | wl1251_acx_set_preamble(wl, ACX_PREAMBLE_SHORT); | ||
1029 | else | ||
1030 | wl1251_acx_set_preamble(wl, ACX_PREAMBLE_LONG); | ||
1031 | } | ||
1032 | |||
1033 | if (changed & BSS_CHANGED_ERP_CTS_PROT) { | ||
1034 | if (bss_conf->use_cts_prot) | ||
1035 | ret = wl1251_acx_cts_protect(wl, CTSPROTECT_ENABLE); | ||
1036 | else | ||
1037 | ret = wl1251_acx_cts_protect(wl, CTSPROTECT_DISABLE); | ||
1038 | if (ret < 0) { | ||
1039 | wl1251_warning("Set ctsprotect failed %d", ret); | ||
1040 | goto out_sleep; | ||
1041 | } | ||
1042 | } | ||
1043 | |||
1044 | if (changed & BSS_CHANGED_BEACON) { | ||
1045 | beacon = ieee80211_beacon_get(hw, vif); | ||
1046 | ret = wl1251_cmd_template_set(wl, CMD_BEACON, beacon->data, | ||
1047 | beacon->len); | ||
1048 | |||
1049 | if (ret < 0) { | ||
1050 | dev_kfree_skb(beacon); | ||
1051 | goto out_sleep; | ||
1052 | } | ||
1053 | |||
1054 | ret = wl1251_cmd_template_set(wl, CMD_PROBE_RESP, beacon->data, | ||
1055 | beacon->len); | ||
1056 | |||
1057 | dev_kfree_skb(beacon); | ||
1058 | |||
1059 | if (ret < 0) | ||
1060 | goto out_sleep; | ||
1061 | |||
1062 | ret = wl1251_join(wl, wl->bss_type, wl->beacon_int, | ||
1063 | wl->channel, wl->dtim_period); | ||
1064 | |||
1065 | if (ret < 0) | ||
1066 | goto out_sleep; | ||
1067 | } | ||
1068 | |||
1069 | out_sleep: | ||
1070 | wl1251_ps_elp_sleep(wl); | ||
1071 | |||
1072 | out: | ||
1073 | mutex_unlock(&wl->mutex); | ||
1074 | } | ||
1075 | |||
1076 | |||
1077 | /* can't be const, mac80211 writes to this */ | ||
1078 | static struct ieee80211_rate wl1251_rates[] = { | ||
1079 | { .bitrate = 10, | ||
1080 | .hw_value = 0x1, | ||
1081 | .hw_value_short = 0x1, }, | ||
1082 | { .bitrate = 20, | ||
1083 | .hw_value = 0x2, | ||
1084 | .hw_value_short = 0x2, | ||
1085 | .flags = IEEE80211_RATE_SHORT_PREAMBLE }, | ||
1086 | { .bitrate = 55, | ||
1087 | .hw_value = 0x4, | ||
1088 | .hw_value_short = 0x4, | ||
1089 | .flags = IEEE80211_RATE_SHORT_PREAMBLE }, | ||
1090 | { .bitrate = 110, | ||
1091 | .hw_value = 0x20, | ||
1092 | .hw_value_short = 0x20, | ||
1093 | .flags = IEEE80211_RATE_SHORT_PREAMBLE }, | ||
1094 | { .bitrate = 60, | ||
1095 | .hw_value = 0x8, | ||
1096 | .hw_value_short = 0x8, }, | ||
1097 | { .bitrate = 90, | ||
1098 | .hw_value = 0x10, | ||
1099 | .hw_value_short = 0x10, }, | ||
1100 | { .bitrate = 120, | ||
1101 | .hw_value = 0x40, | ||
1102 | .hw_value_short = 0x40, }, | ||
1103 | { .bitrate = 180, | ||
1104 | .hw_value = 0x80, | ||
1105 | .hw_value_short = 0x80, }, | ||
1106 | { .bitrate = 240, | ||
1107 | .hw_value = 0x200, | ||
1108 | .hw_value_short = 0x200, }, | ||
1109 | { .bitrate = 360, | ||
1110 | .hw_value = 0x400, | ||
1111 | .hw_value_short = 0x400, }, | ||
1112 | { .bitrate = 480, | ||
1113 | .hw_value = 0x800, | ||
1114 | .hw_value_short = 0x800, }, | ||
1115 | { .bitrate = 540, | ||
1116 | .hw_value = 0x1000, | ||
1117 | .hw_value_short = 0x1000, }, | ||
1118 | }; | ||
1119 | |||
1120 | /* can't be const, mac80211 writes to this */ | ||
1121 | static struct ieee80211_channel wl1251_channels[] = { | ||
1122 | { .hw_value = 1, .center_freq = 2412}, | ||
1123 | { .hw_value = 2, .center_freq = 2417}, | ||
1124 | { .hw_value = 3, .center_freq = 2422}, | ||
1125 | { .hw_value = 4, .center_freq = 2427}, | ||
1126 | { .hw_value = 5, .center_freq = 2432}, | ||
1127 | { .hw_value = 6, .center_freq = 2437}, | ||
1128 | { .hw_value = 7, .center_freq = 2442}, | ||
1129 | { .hw_value = 8, .center_freq = 2447}, | ||
1130 | { .hw_value = 9, .center_freq = 2452}, | ||
1131 | { .hw_value = 10, .center_freq = 2457}, | ||
1132 | { .hw_value = 11, .center_freq = 2462}, | ||
1133 | { .hw_value = 12, .center_freq = 2467}, | ||
1134 | { .hw_value = 13, .center_freq = 2472}, | ||
1135 | }; | ||
1136 | |||
1137 | static int wl1251_op_conf_tx(struct ieee80211_hw *hw, u16 queue, | ||
1138 | const struct ieee80211_tx_queue_params *params) | ||
1139 | { | ||
1140 | enum wl1251_acx_ps_scheme ps_scheme; | ||
1141 | struct wl1251 *wl = hw->priv; | ||
1142 | int ret; | ||
1143 | |||
1144 | mutex_lock(&wl->mutex); | ||
1145 | |||
1146 | wl1251_debug(DEBUG_MAC80211, "mac80211 conf tx %d", queue); | ||
1147 | |||
1148 | ret = wl1251_ps_elp_wakeup(wl); | ||
1149 | if (ret < 0) | ||
1150 | goto out; | ||
1151 | |||
1152 | /* mac80211 uses units of 32 usec */ | ||
1153 | ret = wl1251_acx_ac_cfg(wl, wl1251_tx_get_queue(queue), | ||
1154 | params->cw_min, params->cw_max, | ||
1155 | params->aifs, params->txop * 32); | ||
1156 | if (ret < 0) | ||
1157 | goto out_sleep; | ||
1158 | |||
1159 | if (params->uapsd) | ||
1160 | ps_scheme = WL1251_ACX_PS_SCHEME_UPSD_TRIGGER; | ||
1161 | else | ||
1162 | ps_scheme = WL1251_ACX_PS_SCHEME_LEGACY; | ||
1163 | |||
1164 | ret = wl1251_acx_tid_cfg(wl, wl1251_tx_get_queue(queue), | ||
1165 | CHANNEL_TYPE_EDCF, | ||
1166 | wl1251_tx_get_queue(queue), ps_scheme, | ||
1167 | WL1251_ACX_ACK_POLICY_LEGACY); | ||
1168 | if (ret < 0) | ||
1169 | goto out_sleep; | ||
1170 | |||
1171 | out_sleep: | ||
1172 | wl1251_ps_elp_sleep(wl); | ||
1173 | |||
1174 | out: | ||
1175 | mutex_unlock(&wl->mutex); | ||
1176 | |||
1177 | return ret; | ||
1178 | } | ||
1179 | |||
1180 | static int wl1251_op_get_survey(struct ieee80211_hw *hw, int idx, | ||
1181 | struct survey_info *survey) | ||
1182 | { | ||
1183 | struct wl1251 *wl = hw->priv; | ||
1184 | struct ieee80211_conf *conf = &hw->conf; | ||
1185 | |||
1186 | if (idx != 0) | ||
1187 | return -ENOENT; | ||
1188 | |||
1189 | survey->channel = conf->channel; | ||
1190 | survey->filled = SURVEY_INFO_NOISE_DBM; | ||
1191 | survey->noise = wl->noise; | ||
1192 | |||
1193 | return 0; | ||
1194 | } | ||
1195 | |||
1196 | /* can't be const, mac80211 writes to this */ | ||
1197 | static struct ieee80211_supported_band wl1251_band_2ghz = { | ||
1198 | .channels = wl1251_channels, | ||
1199 | .n_channels = ARRAY_SIZE(wl1251_channels), | ||
1200 | .bitrates = wl1251_rates, | ||
1201 | .n_bitrates = ARRAY_SIZE(wl1251_rates), | ||
1202 | }; | ||
1203 | |||
1204 | static const struct ieee80211_ops wl1251_ops = { | ||
1205 | .start = wl1251_op_start, | ||
1206 | .stop = wl1251_op_stop, | ||
1207 | .add_interface = wl1251_op_add_interface, | ||
1208 | .remove_interface = wl1251_op_remove_interface, | ||
1209 | .config = wl1251_op_config, | ||
1210 | .configure_filter = wl1251_op_configure_filter, | ||
1211 | .tx = wl1251_op_tx, | ||
1212 | .set_key = wl1251_op_set_key, | ||
1213 | .hw_scan = wl1251_op_hw_scan, | ||
1214 | .bss_info_changed = wl1251_op_bss_info_changed, | ||
1215 | .set_rts_threshold = wl1251_op_set_rts_threshold, | ||
1216 | .conf_tx = wl1251_op_conf_tx, | ||
1217 | .get_survey = wl1251_op_get_survey, | ||
1218 | }; | ||
1219 | |||
1220 | static int wl1251_read_eeprom_byte(struct wl1251 *wl, off_t offset, u8 *data) | ||
1221 | { | ||
1222 | unsigned long timeout; | ||
1223 | |||
1224 | wl1251_reg_write32(wl, EE_ADDR, offset); | ||
1225 | wl1251_reg_write32(wl, EE_CTL, EE_CTL_READ); | ||
1226 | |||
1227 | /* EE_CTL_READ clears when data is ready */ | ||
1228 | timeout = jiffies + msecs_to_jiffies(100); | ||
1229 | while (1) { | ||
1230 | if (!(wl1251_reg_read32(wl, EE_CTL) & EE_CTL_READ)) | ||
1231 | break; | ||
1232 | |||
1233 | if (time_after(jiffies, timeout)) | ||
1234 | return -ETIMEDOUT; | ||
1235 | |||
1236 | msleep(1); | ||
1237 | } | ||
1238 | |||
1239 | *data = wl1251_reg_read32(wl, EE_DATA); | ||
1240 | return 0; | ||
1241 | } | ||
1242 | |||
1243 | static int wl1251_read_eeprom(struct wl1251 *wl, off_t offset, | ||
1244 | u8 *data, size_t len) | ||
1245 | { | ||
1246 | size_t i; | ||
1247 | int ret; | ||
1248 | |||
1249 | wl1251_reg_write32(wl, EE_START, 0); | ||
1250 | |||
1251 | for (i = 0; i < len; i++) { | ||
1252 | ret = wl1251_read_eeprom_byte(wl, offset + i, &data[i]); | ||
1253 | if (ret < 0) | ||
1254 | return ret; | ||
1255 | } | ||
1256 | |||
1257 | return 0; | ||
1258 | } | ||
1259 | |||
1260 | static int wl1251_read_eeprom_mac(struct wl1251 *wl) | ||
1261 | { | ||
1262 | u8 mac[ETH_ALEN]; | ||
1263 | int i, ret; | ||
1264 | |||
1265 | wl1251_set_partition(wl, 0, 0, REGISTERS_BASE, REGISTERS_DOWN_SIZE); | ||
1266 | |||
1267 | ret = wl1251_read_eeprom(wl, 0x1c, mac, sizeof(mac)); | ||
1268 | if (ret < 0) { | ||
1269 | wl1251_warning("failed to read MAC address from EEPROM"); | ||
1270 | return ret; | ||
1271 | } | ||
1272 | |||
1273 | /* MAC is stored in reverse order */ | ||
1274 | for (i = 0; i < ETH_ALEN; i++) | ||
1275 | wl->mac_addr[i] = mac[ETH_ALEN - i - 1]; | ||
1276 | |||
1277 | return 0; | ||
1278 | } | ||
1279 | |||
1280 | static int wl1251_register_hw(struct wl1251 *wl) | ||
1281 | { | ||
1282 | int ret; | ||
1283 | |||
1284 | if (wl->mac80211_registered) | ||
1285 | return 0; | ||
1286 | |||
1287 | SET_IEEE80211_PERM_ADDR(wl->hw, wl->mac_addr); | ||
1288 | |||
1289 | ret = ieee80211_register_hw(wl->hw); | ||
1290 | if (ret < 0) { | ||
1291 | wl1251_error("unable to register mac80211 hw: %d", ret); | ||
1292 | return ret; | ||
1293 | } | ||
1294 | |||
1295 | wl->mac80211_registered = true; | ||
1296 | |||
1297 | wl1251_notice("loaded"); | ||
1298 | |||
1299 | return 0; | ||
1300 | } | ||
1301 | |||
1302 | int wl1251_init_ieee80211(struct wl1251 *wl) | ||
1303 | { | ||
1304 | int ret; | ||
1305 | |||
1306 | /* The tx descriptor buffer and the TKIP space */ | ||
1307 | wl->hw->extra_tx_headroom = sizeof(struct tx_double_buffer_desc) | ||
1308 | + WL1251_TKIP_IV_SPACE; | ||
1309 | |||
1310 | /* unit us */ | ||
1311 | /* FIXME: find a proper value */ | ||
1312 | wl->hw->channel_change_time = 10000; | ||
1313 | |||
1314 | wl->hw->flags = IEEE80211_HW_SIGNAL_DBM | | ||
1315 | IEEE80211_HW_SUPPORTS_PS | | ||
1316 | IEEE80211_HW_BEACON_FILTER | | ||
1317 | IEEE80211_HW_SUPPORTS_UAPSD; | ||
1318 | |||
1319 | wl->hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION); | ||
1320 | wl->hw->wiphy->max_scan_ssids = 1; | ||
1321 | wl->hw->wiphy->bands[IEEE80211_BAND_2GHZ] = &wl1251_band_2ghz; | ||
1322 | |||
1323 | wl->hw->queues = 4; | ||
1324 | |||
1325 | if (wl->use_eeprom) | ||
1326 | wl1251_read_eeprom_mac(wl); | ||
1327 | |||
1328 | ret = wl1251_register_hw(wl); | ||
1329 | if (ret) | ||
1330 | goto out; | ||
1331 | |||
1332 | wl1251_debugfs_init(wl); | ||
1333 | wl1251_notice("initialized"); | ||
1334 | |||
1335 | ret = 0; | ||
1336 | |||
1337 | out: | ||
1338 | return ret; | ||
1339 | } | ||
1340 | EXPORT_SYMBOL_GPL(wl1251_init_ieee80211); | ||
1341 | |||
1342 | struct ieee80211_hw *wl1251_alloc_hw(void) | ||
1343 | { | ||
1344 | struct ieee80211_hw *hw; | ||
1345 | struct wl1251 *wl; | ||
1346 | int i; | ||
1347 | static const u8 nokia_oui[3] = {0x00, 0x1f, 0xdf}; | ||
1348 | |||
1349 | hw = ieee80211_alloc_hw(sizeof(*wl), &wl1251_ops); | ||
1350 | if (!hw) { | ||
1351 | wl1251_error("could not alloc ieee80211_hw"); | ||
1352 | return ERR_PTR(-ENOMEM); | ||
1353 | } | ||
1354 | |||
1355 | wl = hw->priv; | ||
1356 | memset(wl, 0, sizeof(*wl)); | ||
1357 | |||
1358 | wl->hw = hw; | ||
1359 | |||
1360 | wl->data_in_count = 0; | ||
1361 | |||
1362 | skb_queue_head_init(&wl->tx_queue); | ||
1363 | |||
1364 | INIT_WORK(&wl->filter_work, wl1251_filter_work); | ||
1365 | INIT_DELAYED_WORK(&wl->elp_work, wl1251_elp_work); | ||
1366 | wl->channel = WL1251_DEFAULT_CHANNEL; | ||
1367 | wl->scanning = false; | ||
1368 | wl->default_key = 0; | ||
1369 | wl->listen_int = 1; | ||
1370 | wl->rx_counter = 0; | ||
1371 | wl->rx_handled = 0; | ||
1372 | wl->rx_current_buffer = 0; | ||
1373 | wl->rx_last_id = 0; | ||
1374 | wl->rx_config = WL1251_DEFAULT_RX_CONFIG; | ||
1375 | wl->rx_filter = WL1251_DEFAULT_RX_FILTER; | ||
1376 | wl->elp = false; | ||
1377 | wl->psm = 0; | ||
1378 | wl->psm_requested = false; | ||
1379 | wl->tx_queue_stopped = false; | ||
1380 | wl->power_level = WL1251_DEFAULT_POWER_LEVEL; | ||
1381 | wl->beacon_int = WL1251_DEFAULT_BEACON_INT; | ||
1382 | wl->dtim_period = WL1251_DEFAULT_DTIM_PERIOD; | ||
1383 | wl->vif = NULL; | ||
1384 | |||
1385 | for (i = 0; i < FW_TX_CMPLT_BLOCK_SIZE; i++) | ||
1386 | wl->tx_frames[i] = NULL; | ||
1387 | |||
1388 | wl->next_tx_complete = 0; | ||
1389 | |||
1390 | INIT_WORK(&wl->irq_work, wl1251_irq_work); | ||
1391 | INIT_WORK(&wl->tx_work, wl1251_tx_work); | ||
1392 | |||
1393 | /* | ||
1394 | * In case our MAC address is not correctly set, | ||
1395 | * we use a random but Nokia MAC. | ||
1396 | */ | ||
1397 | memcpy(wl->mac_addr, nokia_oui, 3); | ||
1398 | get_random_bytes(wl->mac_addr + 3, 3); | ||
1399 | |||
1400 | wl->state = WL1251_STATE_OFF; | ||
1401 | mutex_init(&wl->mutex); | ||
1402 | |||
1403 | wl->tx_mgmt_frm_rate = DEFAULT_HW_GEN_TX_RATE; | ||
1404 | wl->tx_mgmt_frm_mod = DEFAULT_HW_GEN_MODULATION_TYPE; | ||
1405 | |||
1406 | wl->rx_descriptor = kmalloc(sizeof(*wl->rx_descriptor), GFP_KERNEL); | ||
1407 | if (!wl->rx_descriptor) { | ||
1408 | wl1251_error("could not allocate memory for rx descriptor"); | ||
1409 | ieee80211_free_hw(hw); | ||
1410 | return ERR_PTR(-ENOMEM); | ||
1411 | } | ||
1412 | |||
1413 | return hw; | ||
1414 | } | ||
1415 | EXPORT_SYMBOL_GPL(wl1251_alloc_hw); | ||
1416 | |||
1417 | int wl1251_free_hw(struct wl1251 *wl) | ||
1418 | { | ||
1419 | ieee80211_unregister_hw(wl->hw); | ||
1420 | |||
1421 | wl1251_debugfs_exit(wl); | ||
1422 | |||
1423 | kfree(wl->target_mem_map); | ||
1424 | kfree(wl->data_path); | ||
1425 | vfree(wl->fw); | ||
1426 | wl->fw = NULL; | ||
1427 | kfree(wl->nvs); | ||
1428 | wl->nvs = NULL; | ||
1429 | |||
1430 | kfree(wl->rx_descriptor); | ||
1431 | wl->rx_descriptor = NULL; | ||
1432 | |||
1433 | ieee80211_free_hw(wl->hw); | ||
1434 | |||
1435 | return 0; | ||
1436 | } | ||
1437 | EXPORT_SYMBOL_GPL(wl1251_free_hw); | ||
1438 | |||
1439 | MODULE_DESCRIPTION("TI wl1251 Wireles LAN Driver Core"); | ||
1440 | MODULE_LICENSE("GPL"); | ||
1441 | MODULE_AUTHOR("Kalle Valo <kalle.valo@nokia.com>"); | ||
1442 | MODULE_FIRMWARE(WL1251_FW_NAME); | ||