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); | ||
