main.c revision d41776fad4c6601c1711d4e454291efd6687addb
12f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo/* 280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo * This file is part of wl1251 32f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * 42f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * Copyright (C) 2008-2009 Nokia Corporation 52f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * 62f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * Contact: Kalle Valo <kalle.valo@nokia.com> 72f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * 82f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * This program is free software; you can redistribute it and/or 92f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * modify it under the terms of the GNU General Public License 102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * version 2 as published by the Free Software Foundation. 112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * 122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * This program is distributed in the hope that it will be useful, but 132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * WITHOUT ANY WARRANTY; without even the implied warranty of 142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * General Public License for more details. 162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * 172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * You should have received a copy of the GNU General Public License 182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * along with this program; if not, write to the Free Software 192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * 02110-1301 USA 212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * 222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo */ 232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo#include <linux/module.h> 252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo#include <linux/interrupt.h> 262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo#include <linux/firmware.h> 272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo#include <linux/delay.h> 282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo#include <linux/irq.h> 292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo#include <linux/crc32.h> 302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo#include <linux/etherdevice.h> 31c74ddfd5ea9c0c67d0aae77eeb5b610188cb8bc4Kalle Valo#include <linux/vmalloc.h> 325a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 341367411858d5fc60b632a3f488f2b4adc73d12d7Kalle Valo#include "wl1251.h" 352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo#include "wl12xx_80211.h" 3629d904c452d466fbf51b2fde10f405b5c8f14c74Kalle Valo#include "wl1251_reg.h" 370764de64c8628f653c7e8493017d6bd8d43f4e3bBob Copeland#include "wl1251_io.h" 388e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland#include "wl1251_cmd.h" 39ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_event.h" 409f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen#include "wl1251_tx.h" 41ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_rx.h" 42ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_ps.h" 43ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_init.h" 44ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_debugfs.h" 450e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo#include "wl1251_boot.h" 462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 47b5ed9c1b6f8fcb2d2315f12599fd5808f7933f16Bob Copelandvoid wl1251_enable_interrupts(struct wl1251 *wl) 482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 49b5ed9c1b6f8fcb2d2315f12599fd5808f7933f16Bob Copeland wl->if_ops->enable_irq(wl); 50b5ed9c1b6f8fcb2d2315f12599fd5808f7933f16Bob Copeland} 51b5ed9c1b6f8fcb2d2315f12599fd5808f7933f16Bob Copeland 52b5ed9c1b6f8fcb2d2315f12599fd5808f7933f16Bob Copelandvoid wl1251_disable_interrupts(struct wl1251 *wl) 53b5ed9c1b6f8fcb2d2315f12599fd5808f7933f16Bob Copeland{ 54b5ed9c1b6f8fcb2d2315f12599fd5808f7933f16Bob Copeland wl->if_ops->disable_irq(wl); 552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 5780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_power_off(struct wl1251 *wl) 582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->set_power(false); 602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 6280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_power_on(struct wl1251 *wl) 632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->set_power(true); 652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 6780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_fetch_firmware(struct wl1251 *wl) 682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo const struct firmware *fw; 706c766f413c81d5a11588552934fa093eab6ae06eBob Copeland struct device *dev = wiphy_dev(wl->hw->wiphy); 712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo int ret; 722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 730e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo ret = request_firmware(&fw, WL1251_FW_NAME, dev); 742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) { 7680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_error("could not get firmware: %d", ret); 772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return ret; 782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (fw->size % 4) { 8180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_error("firmware size is not multiple of 32 bits: %zu", 822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo fw->size); 832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ret = -EILSEQ; 842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo goto out; 852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->fw_len = fw->size; 88c74ddfd5ea9c0c67d0aae77eeb5b610188cb8bc4Kalle Valo wl->fw = vmalloc(wl->fw_len); 892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (!wl->fw) { 9180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_error("could not allocate memory for the firmware"); 922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ret = -ENOMEM; 932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo goto out; 942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo memcpy(wl->fw, fw->data, wl->fw_len); 972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ret = 0; 992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout: 1012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo release_firmware(fw); 1022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return ret; 1042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 1052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 10680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_fetch_nvs(struct wl1251 *wl) 1072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 1082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo const struct firmware *fw; 1096c766f413c81d5a11588552934fa093eab6ae06eBob Copeland struct device *dev = wiphy_dev(wl->hw->wiphy); 1102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo int ret; 1112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1120e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo ret = request_firmware(&fw, WL1251_NVS_NAME, dev); 1132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) { 11580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_error("could not get nvs file: %d", ret); 1162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return ret; 1172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 1182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (fw->size % 4) { 12080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_error("nvs size is not multiple of 32 bits: %zu", 1212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo fw->size); 1222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ret = -EILSEQ; 1232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo goto out; 1242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 1252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->nvs_len = fw->size; 12780caf6017ace944035210ca2bba7abeb85eb0c5cJulia Lawall wl->nvs = kmemdup(fw->data, wl->nvs_len, GFP_KERNEL); 1282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (!wl->nvs) { 13080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_error("could not allocate memory for the nvs file"); 1312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ret = -ENOMEM; 1322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo goto out; 1332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 1342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ret = 0; 1362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout: 1382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo release_firmware(fw); 1392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return ret; 1412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 1422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 14380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_fw_wakeup(struct wl1251 *wl) 1442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 1452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo u32 elp_reg; 1462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo elp_reg = ELPCTRL_WAKE_UP; 1483f9e750d130b4a4d9f8226642b46ed17d8357f40Grazvydas Ignotas wl1251_write_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, elp_reg); 1493f9e750d130b4a4d9f8226642b46ed17d8357f40Grazvydas Ignotas elp_reg = wl1251_read_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR); 1502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 15105fac682c2ca0c572d1bd8e6a38025838ddf0e68Kalle Valo if (!(elp_reg & ELPCTRL_WLAN_READY)) 15280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_warning("WLAN not ready"); 1532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 1542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 15580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_chip_wakeup(struct wl1251 *wl) 1562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 1572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo int ret = 0; 1582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 15980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_power_on(wl); 1600e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo msleep(WL1251_POWER_ON_SLEEP); 16108d9f57251841e4870cfd286e867ffcbef81d9a4Bob Copeland wl->if_ops->reset(wl); 1622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* We don't need a real memory partition here, because we only want 1642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * to use the registers at this point. */ 16580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_set_partition(wl, 1662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 0x00000000, 1672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 0x00000000, 1682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo REGISTERS_BASE, 1692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo REGISTERS_DOWN_SIZE); 1702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* ELP module wake up */ 17280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_fw_wakeup(wl); 1732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* whal_FwCtrl_BootSm() */ 1752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* 0. read chip id from CHIP_ID */ 1770e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo wl->chip_id = wl1251_reg_read32(wl, CHIP_ID_B); 1782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* 1. check if chip id is valid */ 1802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1810e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo switch (wl->chip_id) { 1822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo case CHIP_ID_1251_PG12: 18380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_debug(DEBUG_BOOT, "chip id 0x%x (1251 PG12)", 1840e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo wl->chip_id); 1852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo break; 1862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo case CHIP_ID_1251_PG11: 1872c759e03b3b7639fff23ec3b7bab64a35ca0914fDavid-John Willis wl1251_debug(DEBUG_BOOT, "chip id 0x%x (1251 PG11)", 1882c759e03b3b7639fff23ec3b7bab64a35ca0914fDavid-John Willis wl->chip_id); 1892c759e03b3b7639fff23ec3b7bab64a35ca0914fDavid-John Willis break; 1909a493e8f4d78fc3f2494fa952500b720c86737d8John W. Linville case CHIP_ID_1251_PG10: 1912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo default: 1920e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo wl1251_error("unsupported chip id: 0x%x", wl->chip_id); 1932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ret = -ENODEV; 1942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo goto out; 1952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 1962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (wl->fw == NULL) { 19880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_fetch_firmware(wl); 1992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 2002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo goto out; 2012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 2022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 203afa5ec27f4d69952d4ae11f182258bf53d85fcf5Grazvydas Ignotas if (wl->nvs == NULL && !wl->use_eeprom) { 204afa5ec27f4d69952d4ae11f182258bf53d85fcf5Grazvydas Ignotas /* No NVS from netlink, try to get it from the filesystem */ 20580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_fetch_nvs(wl); 2062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 2072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo goto out; 2082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 2092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 2102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout: 2112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return ret; 2122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 2132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 214dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto#define WL1251_IRQ_LOOP_COUNT 10 2150e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valostatic void wl1251_irq_work(struct work_struct *work) 2160e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo{ 217dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto u32 intr, ctr = WL1251_IRQ_LOOP_COUNT; 2180e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo struct wl1251 *wl = 2190e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo container_of(work, struct wl1251, irq_work); 2200e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo int ret; 2210e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 2220e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo mutex_lock(&wl->mutex); 2230e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 2240e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo wl1251_debug(DEBUG_IRQ, "IRQ work"); 2250e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 2260e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo if (wl->state == WL1251_STATE_OFF) 2270e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo goto out; 2280e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 2290e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo ret = wl1251_ps_elp_wakeup(wl); 2300e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo if (ret < 0) 2310e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo goto out; 2320e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 2330e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo wl1251_reg_write32(wl, ACX_REG_INTERRUPT_MASK, WL1251_ACX_INTR_ALL); 2340e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 2350e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo intr = wl1251_reg_read32(wl, ACX_REG_INTERRUPT_CLEAR); 2360e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo wl1251_debug(DEBUG_IRQ, "intr: 0x%x", intr); 2370e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 238dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto do { 239dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto if (wl->data_path) { 240dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl->rx_counter = wl1251_mem_read32( 241dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl, wl->data_path->rx_control_addr); 242dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto 243dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto /* We handle a frmware bug here */ 244dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto switch ((wl->rx_counter - wl->rx_handled) & 0xf) { 245dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto case 0: 246dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl1251_debug(DEBUG_IRQ, 247dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto "RX: FW and host in sync"); 248dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto intr &= ~WL1251_ACX_INTR_RX0_DATA; 249dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto intr &= ~WL1251_ACX_INTR_RX1_DATA; 250dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto break; 251dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto case 1: 252dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl1251_debug(DEBUG_IRQ, "RX: FW +1"); 253dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto intr |= WL1251_ACX_INTR_RX0_DATA; 254dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto intr &= ~WL1251_ACX_INTR_RX1_DATA; 255dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto break; 256dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto case 2: 257dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl1251_debug(DEBUG_IRQ, "RX: FW +2"); 258dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto intr |= WL1251_ACX_INTR_RX0_DATA; 259dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto intr |= WL1251_ACX_INTR_RX1_DATA; 260dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto break; 261dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto default: 262dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl1251_warning( 263dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto "RX: FW and host out of sync: %d", 264dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl->rx_counter - wl->rx_handled); 265dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto break; 266dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto } 267dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto 268dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl->rx_handled = wl->rx_counter; 269dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto 270dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl1251_debug(DEBUG_IRQ, "RX counter: %d", 271dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl->rx_counter); 2720e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo } 2730e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 274dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto intr &= wl->intr_mask; 2750e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 276dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto if (intr == 0) { 277dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl1251_debug(DEBUG_IRQ, "INTR is 0"); 278dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto goto out_sleep; 279dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto } 2800e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 281dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto if (intr & WL1251_ACX_INTR_RX0_DATA) { 282dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl1251_debug(DEBUG_IRQ, "WL1251_ACX_INTR_RX0_DATA"); 283dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl1251_rx(wl); 284dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto } 2850e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 286dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto if (intr & WL1251_ACX_INTR_RX1_DATA) { 287dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl1251_debug(DEBUG_IRQ, "WL1251_ACX_INTR_RX1_DATA"); 288dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl1251_rx(wl); 289dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto } 2900e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 291dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto if (intr & WL1251_ACX_INTR_TX_RESULT) { 292dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl1251_debug(DEBUG_IRQ, "WL1251_ACX_INTR_TX_RESULT"); 293dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl1251_tx_complete(wl); 294dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto } 2950e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 296d41776fad4c6601c1711d4e454291efd6687addbGrazvydas Ignotas if (intr & WL1251_ACX_INTR_EVENT_A) { 297d41776fad4c6601c1711d4e454291efd6687addbGrazvydas Ignotas wl1251_debug(DEBUG_IRQ, "WL1251_ACX_INTR_EVENT_A"); 298d41776fad4c6601c1711d4e454291efd6687addbGrazvydas Ignotas wl1251_event_handle(wl, 0); 299d41776fad4c6601c1711d4e454291efd6687addbGrazvydas Ignotas } 300d41776fad4c6601c1711d4e454291efd6687addbGrazvydas Ignotas 301d41776fad4c6601c1711d4e454291efd6687addbGrazvydas Ignotas if (intr & WL1251_ACX_INTR_EVENT_B) { 302d41776fad4c6601c1711d4e454291efd6687addbGrazvydas Ignotas wl1251_debug(DEBUG_IRQ, "WL1251_ACX_INTR_EVENT_B"); 303d41776fad4c6601c1711d4e454291efd6687addbGrazvydas Ignotas wl1251_event_handle(wl, 1); 304dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto } 3050e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 306dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto if (intr & WL1251_ACX_INTR_INIT_COMPLETE) 307dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl1251_debug(DEBUG_IRQ, 308dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto "WL1251_ACX_INTR_INIT_COMPLETE"); 3090e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 31079553f82c993ed511450748f01e16e4dccdc8c02Juuso Oikarinen if (--ctr == 0) 31179553f82c993ed511450748f01e16e4dccdc8c02Juuso Oikarinen break; 3120e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 31379553f82c993ed511450748f01e16e4dccdc8c02Juuso Oikarinen intr = wl1251_reg_read32(wl, ACX_REG_INTERRUPT_CLEAR); 31479553f82c993ed511450748f01e16e4dccdc8c02Juuso Oikarinen } while (intr); 3150e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 3160e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valoout_sleep: 317dcea4dbe54f5bbea2ef0bb265072754ccd934a1eJanne Ylalehto wl1251_reg_write32(wl, ACX_REG_INTERRUPT_MASK, ~(wl->intr_mask)); 3180e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo wl1251_ps_elp_sleep(wl); 3190e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 3200e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valoout: 3210e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo mutex_unlock(&wl->mutex); 3220e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo} 3230e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 324ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valostatic int wl1251_join(struct wl1251 *wl, u8 bss_type, u8 channel, 325ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo u16 beacon_interval, u8 dtim_period) 326ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo{ 327ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo int ret; 328ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo 329ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo ret = wl1251_acx_frame_rates(wl, DEFAULT_HW_GEN_TX_RATE, 330ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo DEFAULT_HW_GEN_MODULATION_TYPE, 331ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo wl->tx_mgmt_frm_rate, 332ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo wl->tx_mgmt_frm_mod); 333ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo if (ret < 0) 334ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo goto out; 335ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo 336ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo 337ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo ret = wl1251_cmd_join(wl, bss_type, channel, beacon_interval, 338ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo dtim_period); 339ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo if (ret < 0) 340ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo goto out; 341ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo 342ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo /* 343ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo * FIXME: we should wait for JOIN_EVENT_COMPLETE_ID but to simplify 344ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo * locking we just sleep instead, for now 345ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo */ 346ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo msleep(10); 347ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo 348ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valoout: 349ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo return ret; 350ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo} 351ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo 35280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_filter_work(struct work_struct *work) 3532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 35480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo struct wl1251 *wl = 35580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo container_of(work, struct wl1251, filter_work); 3562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo int ret; 3572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 3582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_lock(&wl->mutex); 3592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 36080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo if (wl->state == WL1251_STATE_OFF) 3612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo goto out; 3622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 36380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_ps_elp_wakeup(wl); 364c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo if (ret < 0) 365c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo goto out; 36601d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo 367ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo ret = wl1251_join(wl, wl->bss_type, wl->channel, wl->beacon_int, 368ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo wl->dtim_period); 3692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 370c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo goto out_sleep; 3712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 372c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout_sleep: 37380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_ps_elp_sleep(wl); 374c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo 375c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout: 3762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_unlock(&wl->mutex); 3772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 3782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 37980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_tx(struct ieee80211_hw *hw, struct sk_buff *skb) 3802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 38180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo struct wl1251 *wl = hw->priv; 3822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 3832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo skb_queue_tail(&wl->tx_queue, skb); 3842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 3859f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen /* 3869f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen * The chip specific setup must run before the first TX packet - 3879f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen * before that, the tx_work will not be initialized! 3889f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen */ 3899f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen 39016e711f9ed16e32126270652d79225836a7062cbKalle Valo ieee80211_queue_work(wl->hw, &wl->tx_work); 3912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 3922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* 3932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * The workqueue is slow to process the tx_queue and we need stop 3942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * the queue here, otherwise the queue will get too long. 3952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo */ 39680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo if (skb_queue_len(&wl->tx_queue) >= WL1251_TX_QUEUE_MAX_LENGTH) { 397d67e261829d405ed19a6c2e648f224e352012f52Kalle Valo wl1251_debug(DEBUG_TX, "op_tx: tx_queue full, stop queues"); 3982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ieee80211_stop_queues(wl->hw); 3992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* 4012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * FIXME: this is racy, the variable is not properly 4022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * protected. Maybe fix this by removing the stupid 4032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * variable altogether and checking the real queue state? 4042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo */ 4052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->tx_queue_stopped = true; 4062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 4072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return NETDEV_TX_OK; 4092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 4102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 41180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_start(struct ieee80211_hw *hw) 4122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 41380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo struct wl1251 *wl = hw->priv; 4148b28e82224321d6fdabadd7d6ddc4bd28a3b5490John W. Linville struct wiphy *wiphy = hw->wiphy; 4152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo int ret = 0; 4162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 41780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_debug(DEBUG_MAC80211, "mac80211 start"); 4182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_lock(&wl->mutex); 4202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 42180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo if (wl->state != WL1251_STATE_OFF) { 42280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_error("cannot start because not in off state: %d", 4232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->state); 4242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ret = -EBUSY; 4252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo goto out; 4262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 4272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 42880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_chip_wakeup(wl); 4292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 430fe643414dbf330d6d910e01edd48dd93dc6f2942Jiri Slaby goto out; 4312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4320e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo ret = wl1251_boot(wl); 4332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 4342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo goto out; 4352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4360e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo ret = wl1251_hw_init(wl); 4372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 4382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo goto out; 4392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 44080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_acx_station_id(wl); 4412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 4422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo goto out; 4432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 44480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl->state = WL1251_STATE_ON; 4452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4460e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo wl1251_info("firmware booted (%s)", wl->fw_ver); 4472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4488b28e82224321d6fdabadd7d6ddc4bd28a3b5490John W. Linville /* update hw/fw version info in wiphy struct */ 4498b28e82224321d6fdabadd7d6ddc4bd28a3b5490John W. Linville wiphy->hw_version = wl->chip_id; 4508b28e82224321d6fdabadd7d6ddc4bd28a3b5490John W. Linville strncpy(wiphy->fw_version, wl->fw_ver, sizeof(wiphy->fw_version)); 4518b28e82224321d6fdabadd7d6ddc4bd28a3b5490John W. Linville 4522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout: 4532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 45480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_power_off(wl); 4552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_unlock(&wl->mutex); 4572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return ret; 4592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 4602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 46180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_op_stop(struct ieee80211_hw *hw) 4622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 46380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo struct wl1251 *wl = hw->priv; 4642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 46580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_info("down"); 4662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 46780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_debug(DEBUG_MAC80211, "mac80211 stop"); 4682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_lock(&wl->mutex); 4702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 47180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo WARN_ON(wl->state != WL1251_STATE_ON); 4722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (wl->scanning) { 4742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_unlock(&wl->mutex); 4752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ieee80211_scan_completed(wl->hw, true); 4762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_lock(&wl->mutex); 4772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->scanning = false; 4782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 4792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 48080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl->state = WL1251_STATE_OFF; 4812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 48280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_disable_interrupts(wl); 4832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_unlock(&wl->mutex); 4852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo cancel_work_sync(&wl->irq_work); 4872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo cancel_work_sync(&wl->tx_work); 4882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo cancel_work_sync(&wl->filter_work); 4892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_lock(&wl->mutex); 4912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* let's notify MAC80211 about the remaining pending TX frames */ 4930e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo wl1251_tx_flush(wl); 49480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_power_off(wl); 4952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 4962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo memset(wl->bssid, 0, ETH_ALEN); 4972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->listen_int = 1; 4982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->bss_type = MAX_BSS_TYPE; 4992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 5002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->data_in_count = 0; 5012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_counter = 0; 5022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_handled = 0; 5032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_current_buffer = 0; 5042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_last_id = 0; 5052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->next_tx_complete = 0; 5062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->elp = false; 5072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->psm = 0; 5082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->tx_queue_stopped = false; 50980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl->power_level = WL1251_DEFAULT_POWER_LEVEL; 5109780279c60c32cb5f14531aa34ae991bb714c90cKalle Valo wl->channel = WL1251_DEFAULT_CHANNEL; 5112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 51280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_debugfs_reset(wl); 5132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 5142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_unlock(&wl->mutex); 5152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 5162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 51780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_add_interface(struct ieee80211_hw *hw, 5181ed32e4fc8cfc9656cc1101e7f9617d485fcbe7bJohannes Berg struct ieee80211_vif *vif) 5192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 52080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo struct wl1251 *wl = hw->priv; 5212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo int ret = 0; 5222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 523e91d83346ad9b30f44469c92b982206dcd7dcaf0Johannes Berg wl1251_debug(DEBUG_MAC80211, "mac80211 add interface type %d mac %pM", 5241ed32e4fc8cfc9656cc1101e7f9617d485fcbe7bJohannes Berg vif->type, vif->addr); 5252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 5262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_lock(&wl->mutex); 527287f6f9672635f4e948c0aa96754a2ce448ebdb2Juuso Oikarinen if (wl->vif) { 528287f6f9672635f4e948c0aa96754a2ce448ebdb2Juuso Oikarinen ret = -EBUSY; 529287f6f9672635f4e948c0aa96754a2ce448ebdb2Juuso Oikarinen goto out; 530287f6f9672635f4e948c0aa96754a2ce448ebdb2Juuso Oikarinen } 531287f6f9672635f4e948c0aa96754a2ce448ebdb2Juuso Oikarinen 5321ed32e4fc8cfc9656cc1101e7f9617d485fcbe7bJohannes Berg wl->vif = vif; 5332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 5341ed32e4fc8cfc9656cc1101e7f9617d485fcbe7bJohannes Berg switch (vif->type) { 5352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo case NL80211_IFTYPE_STATION: 5362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->bss_type = BSS_TYPE_STA_BSS; 5372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo break; 5382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo case NL80211_IFTYPE_ADHOC: 5392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->bss_type = BSS_TYPE_IBSS; 5402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo break; 5412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo default: 5422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ret = -EOPNOTSUPP; 5432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo goto out; 5442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 5452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 5461ed32e4fc8cfc9656cc1101e7f9617d485fcbe7bJohannes Berg if (memcmp(wl->mac_addr, vif->addr, ETH_ALEN)) { 5471ed32e4fc8cfc9656cc1101e7f9617d485fcbe7bJohannes Berg memcpy(wl->mac_addr, vif->addr, ETH_ALEN); 5482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo SET_IEEE80211_PERM_ADDR(wl->hw, wl->mac_addr); 54980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_acx_station_id(wl); 5502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 5512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo goto out; 5522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 5532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 5542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout: 5552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_unlock(&wl->mutex); 5562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return ret; 5572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 5582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 55980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_op_remove_interface(struct ieee80211_hw *hw, 5601ed32e4fc8cfc9656cc1101e7f9617d485fcbe7bJohannes Berg struct ieee80211_vif *vif) 5612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 562287f6f9672635f4e948c0aa96754a2ce448ebdb2Juuso Oikarinen struct wl1251 *wl = hw->priv; 563287f6f9672635f4e948c0aa96754a2ce448ebdb2Juuso Oikarinen 564287f6f9672635f4e948c0aa96754a2ce448ebdb2Juuso Oikarinen mutex_lock(&wl->mutex); 56580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_debug(DEBUG_MAC80211, "mac80211 remove interface"); 566287f6f9672635f4e948c0aa96754a2ce448ebdb2Juuso Oikarinen wl->vif = NULL; 567287f6f9672635f4e948c0aa96754a2ce448ebdb2Juuso Oikarinen mutex_unlock(&wl->mutex); 5682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 5692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 5708f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valostatic int wl1251_build_qos_null_data(struct wl1251 *wl) 5718f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo{ 5728f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo struct ieee80211_qos_hdr template; 5738f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo 5748f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo memset(&template, 0, sizeof(template)); 5758f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo 5768f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo memcpy(template.addr1, wl->bssid, ETH_ALEN); 5778f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo memcpy(template.addr2, wl->mac_addr, ETH_ALEN); 5788f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo memcpy(template.addr3, wl->bssid, ETH_ALEN); 5798f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo 5808f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo template.frame_control = cpu_to_le16(IEEE80211_FTYPE_DATA | 5818f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo IEEE80211_STYPE_QOS_NULLFUNC | 5828f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo IEEE80211_FCTL_TODS); 5838f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo 5848f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo /* FIXME: not sure what priority to use here */ 5858f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo template.qos_ctrl = cpu_to_le16(0); 5868f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo 5878f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo return wl1251_cmd_template_set(wl, CMD_QOS_NULL_DATA, &template, 5888f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo sizeof(template)); 5898f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo} 5908f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo 59180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_config(struct ieee80211_hw *hw, u32 changed) 5922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 59380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo struct wl1251 *wl = hw->priv; 5942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo struct ieee80211_conf *conf = &hw->conf; 5952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo int channel, ret = 0; 5962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 5972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo channel = ieee80211_frequency_to_channel(conf->channel->center_freq); 5982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 59980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_debug(DEBUG_MAC80211, "mac80211 config ch %d psm %s power %d", 6002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo channel, 6012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo conf->flags & IEEE80211_CONF_PS ? "on" : "off", 6022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo conf->power_level); 6032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 6042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_lock(&wl->mutex); 6052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 60680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_ps_elp_wakeup(wl); 607c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo if (ret < 0) 608c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo goto out; 60901d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo 6102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (channel != wl->channel) { 611fe9a98460b6c8dac47d0e34bcb04850193d41565Kalle Valo wl->channel = channel; 612fe9a98460b6c8dac47d0e34bcb04850193d41565Kalle Valo 613ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo ret = wl1251_join(wl, wl->bss_type, wl->channel, 614ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo wl->beacon_int, wl->dtim_period); 6152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 616c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo goto out_sleep; 6172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 6182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 6192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (conf->flags & IEEE80211_CONF_PS && !wl->psm_requested) { 62047af3fe36dc478f7eddc8bec104ff1876d71f37cLuciano Coelho wl1251_debug(DEBUG_PSM, "psm enabled"); 6212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 6222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->psm_requested = true; 6232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 62456007a028c51cbf800a6c969d6f6431d23443b99Johannes Berg wl->dtim_period = conf->ps_dtim_period; 62556007a028c51cbf800a6c969d6f6431d23443b99Johannes Berg 62656007a028c51cbf800a6c969d6f6431d23443b99Johannes Berg ret = wl1251_acx_wr_tbtt_and_dtim(wl, wl->beacon_int, 62756007a028c51cbf800a6c969d6f6431d23443b99Johannes Berg wl->dtim_period); 62856007a028c51cbf800a6c969d6f6431d23443b99Johannes Berg 6292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* 63056007a028c51cbf800a6c969d6f6431d23443b99Johannes Berg * mac80211 enables PSM only if we're already associated. 6312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo */ 63280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_ps_set_mode(wl, STATION_POWER_SAVE_MODE); 633478fdf2bcef73747eb99bc6dd3565f093942647aKalle Valo if (ret < 0) 634478fdf2bcef73747eb99bc6dd3565f093942647aKalle Valo goto out_sleep; 6352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } else if (!(conf->flags & IEEE80211_CONF_PS) && 6362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->psm_requested) { 63747af3fe36dc478f7eddc8bec104ff1876d71f37cLuciano Coelho wl1251_debug(DEBUG_PSM, "psm disabled"); 6382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 6392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->psm_requested = false; 6402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 641478fdf2bcef73747eb99bc6dd3565f093942647aKalle Valo if (wl->psm) { 64280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_ps_set_mode(wl, STATION_ACTIVE_MODE); 643478fdf2bcef73747eb99bc6dd3565f093942647aKalle Valo if (ret < 0) 644478fdf2bcef73747eb99bc6dd3565f093942647aKalle Valo goto out_sleep; 645478fdf2bcef73747eb99bc6dd3565f093942647aKalle Valo } 6462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 6472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 6482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (conf->power_level != wl->power_level) { 64980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_acx_tx_power(wl, conf->power_level); 6502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 651478fdf2bcef73747eb99bc6dd3565f093942647aKalle Valo goto out_sleep; 6522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 6532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->power_level = conf->power_level; 6542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 6552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 656c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout_sleep: 65780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_ps_elp_sleep(wl); 658c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo 659c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout: 6602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_unlock(&wl->mutex); 661c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo 6622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return ret; 6632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 6642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 66580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo#define WL1251_SUPPORTED_FILTERS (FIF_PROMISC_IN_BSS | \ 6662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo FIF_ALLMULTI | \ 6672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo FIF_FCSFAIL | \ 6682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo FIF_BCN_PRBRESP_PROMISC | \ 6692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo FIF_CONTROL | \ 6702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo FIF_OTHER_BSS) 6712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 67280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_op_configure_filter(struct ieee80211_hw *hw, 6732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo unsigned int changed, 6743ac64beecd27400d12cc7afb4108eef26c499f6aJohannes Berg unsigned int *total,u64 multicast) 6752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 67680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo struct wl1251 *wl = hw->priv; 6772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 67880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_debug(DEBUG_MAC80211, "mac80211 configure filter"); 6792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 68080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo *total &= WL1251_SUPPORTED_FILTERS; 68180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo changed &= WL1251_SUPPORTED_FILTERS; 6822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 6832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (changed == 0) 6842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* no filters which we support changed */ 6852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return; 6862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 6872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* FIXME: wl->rx_config and wl->rx_filter are not protected */ 6882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 68980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl->rx_config = WL1251_DEFAULT_RX_CONFIG; 69080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl->rx_filter = WL1251_DEFAULT_RX_FILTER; 6912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 6922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (*total & FIF_PROMISC_IN_BSS) { 6932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_config |= CFG_BSSID_FILTER_EN; 6942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_config |= CFG_RX_ALL_GOOD; 6952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 6962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (*total & FIF_ALLMULTI) 6972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* 6982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * CFG_MC_FILTER_EN in rx_config needs to be 0 to receive 6992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * all multicast frames 7002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo */ 7012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_config &= ~CFG_MC_FILTER_EN; 7022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (*total & FIF_FCSFAIL) 7032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_filter |= CFG_RX_FCS_ERROR; 7042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (*total & FIF_BCN_PRBRESP_PROMISC) { 7052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_config &= ~CFG_BSSID_FILTER_EN; 7062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_config &= ~CFG_SSID_FILTER_EN; 7072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 7082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (*total & FIF_CONTROL) 7092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_filter |= CFG_RX_CTL_EN; 7102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (*total & FIF_OTHER_BSS) 7112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_filter &= ~CFG_BSSID_FILTER_EN; 7122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 7132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* 7142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * FIXME: workqueues need to be properly cancelled on stop(), for 7152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * now let's just disable changing the filter settings. They will 7162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * be updated any on config(). 7172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo */ 7182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* schedule_work(&wl->filter_work); */ 7192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 7202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 7212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo/* HW encryption */ 72280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_set_key_type(struct wl1251 *wl, 72380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo struct wl1251_cmd_set_keys *key, 7242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo enum set_key_cmd cmd, 7252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo struct ieee80211_key_conf *mac80211_key, 7262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo const u8 *addr) 7272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 72897359d1235eaf634fe706c9faa6e40181cc95fb8Johannes Berg switch (mac80211_key->cipher) { 72997359d1235eaf634fe706c9faa6e40181cc95fb8Johannes Berg case WLAN_CIPHER_SUITE_WEP40: 73097359d1235eaf634fe706c9faa6e40181cc95fb8Johannes Berg case WLAN_CIPHER_SUITE_WEP104: 7312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (is_broadcast_ether_addr(addr)) 7322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo key->key_type = KEY_WEP_DEFAULT; 7332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo else 7342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo key->key_type = KEY_WEP_ADDR; 7352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 7362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mac80211_key->hw_key_idx = mac80211_key->keyidx; 7372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo break; 73897359d1235eaf634fe706c9faa6e40181cc95fb8Johannes Berg case WLAN_CIPHER_SUITE_TKIP: 7392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (is_broadcast_ether_addr(addr)) 7402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo key->key_type = KEY_TKIP_MIC_GROUP; 7412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo else 7422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo key->key_type = KEY_TKIP_MIC_PAIRWISE; 7432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 7442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mac80211_key->hw_key_idx = mac80211_key->keyidx; 7452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo break; 74697359d1235eaf634fe706c9faa6e40181cc95fb8Johannes Berg case WLAN_CIPHER_SUITE_CCMP: 7472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (is_broadcast_ether_addr(addr)) 7482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo key->key_type = KEY_AES_GROUP; 7492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo else 7502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo key->key_type = KEY_AES_PAIRWISE; 7512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mac80211_key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV; 7522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo break; 7532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo default: 75497359d1235eaf634fe706c9faa6e40181cc95fb8Johannes Berg wl1251_error("Unknown key cipher 0x%x", mac80211_key->cipher); 7552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return -EOPNOTSUPP; 7562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 7572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 7582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return 0; 7592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 7602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 76180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd, 7622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo struct ieee80211_vif *vif, 7632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo struct ieee80211_sta *sta, 7642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo struct ieee80211_key_conf *key) 7652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 76680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo struct wl1251 *wl = hw->priv; 76780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo struct wl1251_cmd_set_keys *wl_cmd; 7682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo const u8 *addr; 7692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo int ret; 7702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 7712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo static const u8 bcast_addr[ETH_ALEN] = 7722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 7732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 77480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_debug(DEBUG_MAC80211, "mac80211 set key"); 7752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 776ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo wl_cmd = kzalloc(sizeof(*wl_cmd), GFP_KERNEL); 777ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo if (!wl_cmd) { 778ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo ret = -ENOMEM; 779ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo goto out; 780ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo } 7812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 7822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo addr = sta ? sta->addr : bcast_addr; 7832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 78480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_debug(DEBUG_CRYPT, "CMD: 0x%x", cmd); 78580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_dump(DEBUG_CRYPT, "ADDR: ", addr, ETH_ALEN); 78680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_debug(DEBUG_CRYPT, "Key: algo:0x%x, id:%d, len:%d flags 0x%x", 78797359d1235eaf634fe706c9faa6e40181cc95fb8Johannes Berg key->cipher, key->keyidx, key->keylen, key->flags); 78880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_dump(DEBUG_CRYPT, "KEY: ", key->key, key->keylen); 7892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 790ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo if (is_zero_ether_addr(addr)) { 791ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo /* We dont support TX only encryption */ 792ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo ret = -EOPNOTSUPP; 793ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo goto out; 794ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo } 795ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo 7962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_lock(&wl->mutex); 7972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 79880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_ps_elp_wakeup(wl); 799c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo if (ret < 0) 800c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo goto out_unlock; 80101d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo 8022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo switch (cmd) { 8032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo case SET_KEY: 804ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo wl_cmd->key_action = KEY_ADD_OR_REPLACE; 8052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo break; 8062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo case DISABLE_KEY: 807ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo wl_cmd->key_action = KEY_REMOVE; 8082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo break; 8092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo default: 81080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_error("Unsupported key cmd 0x%x", cmd); 8112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo break; 8122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 8132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 81480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_set_key_type(wl, wl_cmd, cmd, key, addr); 8152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) { 81680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_error("Set KEY type failed"); 817c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo goto out_sleep; 8182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 8192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 820ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo if (wl_cmd->key_type != KEY_WEP_DEFAULT) 821ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo memcpy(wl_cmd->addr, addr, ETH_ALEN); 8222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 823ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo if ((wl_cmd->key_type == KEY_TKIP_MIC_GROUP) || 824ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo (wl_cmd->key_type == KEY_TKIP_MIC_PAIRWISE)) { 8252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* 8262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * We get the key in the following form: 8272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * TKIP (16 bytes) - TX MIC (8 bytes) - RX MIC (8 bytes) 8282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * but the target is expecting: 8292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * TKIP - RX MIC - TX MIC 8302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo */ 831ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo memcpy(wl_cmd->key, key->key, 16); 832ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo memcpy(wl_cmd->key + 16, key->key + 24, 8); 833ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo memcpy(wl_cmd->key + 24, key->key + 16, 8); 8342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 8352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } else { 836ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo memcpy(wl_cmd->key, key->key, key->keylen); 8372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 838ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo wl_cmd->key_size = key->keylen; 8392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 840ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo wl_cmd->id = key->keyidx; 841ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo wl_cmd->ssid_profile = 0; 8422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 84380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_dump(DEBUG_CRYPT, "TARGET KEY: ", wl_cmd, sizeof(*wl_cmd)); 8442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 84580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_cmd_send(wl, CMD_SET_KEYS, wl_cmd, sizeof(*wl_cmd)); 846ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo if (ret < 0) { 84780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_warning("could not set keys"); 848c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo goto out_sleep; 8492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 8502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 851c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout_sleep: 85280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_ps_elp_sleep(wl); 853c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo 854c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout_unlock: 8552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_unlock(&wl->mutex); 856ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo 857ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valoout: 858ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo kfree(wl_cmd); 859ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo 8602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return ret; 8612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 8622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 86380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_hw_scan(struct ieee80211_hw *hw, 864a060bbfe4ee95d115e8f9705a66894ac34e2c475Johannes Berg struct ieee80211_vif *vif, 8652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo struct cfg80211_scan_request *req) 8662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 86780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo struct wl1251 *wl = hw->priv; 868e477c56e852c4c6db1f7665c642c9f45f76616a9Kalle Valo struct sk_buff *skb; 8692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo size_t ssid_len = 0; 8703a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo u8 *ssid = NULL; 8713a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo int ret; 8722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 87380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_debug(DEBUG_MAC80211, "mac80211 hw scan"); 8742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 8752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (req->n_ssids) { 8762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ssid = req->ssids[0].ssid; 8772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ssid_len = req->ssids[0].ssid_len; 8782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 8792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 8802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_lock(&wl->mutex); 881c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo 8823a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo if (wl->scanning) { 8833a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo wl1251_debug(DEBUG_SCAN, "scan already in progress"); 8843a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo ret = -EINVAL; 8853a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo goto out; 8863a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo } 8873a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo 88880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_ps_elp_wakeup(wl); 889c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo if (ret < 0) 890c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo goto out; 89101d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo 892e477c56e852c4c6db1f7665c642c9f45f76616a9Kalle Valo skb = ieee80211_probereq_get(wl->hw, wl->vif, ssid, ssid_len, 893e477c56e852c4c6db1f7665c642c9f45f76616a9Kalle Valo req->ie, req->ie_len); 894e477c56e852c4c6db1f7665c642c9f45f76616a9Kalle Valo if (!skb) { 895e477c56e852c4c6db1f7665c642c9f45f76616a9Kalle Valo ret = -ENOMEM; 896e477c56e852c4c6db1f7665c642c9f45f76616a9Kalle Valo goto out; 897e477c56e852c4c6db1f7665c642c9f45f76616a9Kalle Valo } 898e477c56e852c4c6db1f7665c642c9f45f76616a9Kalle Valo 899e477c56e852c4c6db1f7665c642c9f45f76616a9Kalle Valo ret = wl1251_cmd_template_set(wl, CMD_PROBE_REQ, skb->data, 900e477c56e852c4c6db1f7665c642c9f45f76616a9Kalle Valo skb->len); 901e477c56e852c4c6db1f7665c642c9f45f76616a9Kalle Valo dev_kfree_skb(skb); 9023a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo if (ret < 0) 903e477c56e852c4c6db1f7665c642c9f45f76616a9Kalle Valo goto out_sleep; 9043a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo 9053a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo ret = wl1251_cmd_trigger_scan_to(wl, 0); 9063a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo if (ret < 0) 9073a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo goto out_sleep; 9083a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo 9093a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo wl->scanning = true; 91001d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo 911dc52f0a8e50303eb67ff8856cd8d1b461462ceecKalle Valo ret = wl1251_cmd_scan(wl, ssid, ssid_len, req->channels, 912dc52f0a8e50303eb67ff8856cd8d1b461462ceecKalle Valo req->n_channels, WL1251_SCAN_NUM_PROBES); 9133a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo if (ret < 0) { 9143a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo wl->scanning = false; 9153a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo goto out_sleep; 9163a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo } 9173a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valo 9183a98c30f3e8bb1f32b5bcb74a39647b3670de275Kalle Valoout_sleep: 91980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_ps_elp_sleep(wl); 920c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo 921c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout: 9222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_unlock(&wl->mutex); 9232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 9242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return ret; 9252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 9262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 92780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_set_rts_threshold(struct ieee80211_hw *hw, u32 value) 9282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 92980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo struct wl1251 *wl = hw->priv; 9302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo int ret; 9312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 932cee4fd2712a3db21f432bdff14e59aed160453b2Kalle Valo mutex_lock(&wl->mutex); 933cee4fd2712a3db21f432bdff14e59aed160453b2Kalle Valo 93480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_ps_elp_wakeup(wl); 935c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo if (ret < 0) 936c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo goto out; 93701d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo 93880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_acx_rts_threshold(wl, (u16) value); 9392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 94080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_warning("wl1251_op_set_rts_threshold failed: %d", ret); 9412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 94280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_ps_elp_sleep(wl); 94301d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo 944c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout: 945cee4fd2712a3db21f432bdff14e59aed160453b2Kalle Valo mutex_unlock(&wl->mutex); 946cee4fd2712a3db21f432bdff14e59aed160453b2Kalle Valo 9472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return ret; 9482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 9492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 95080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_op_bss_info_changed(struct ieee80211_hw *hw, 9512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo struct ieee80211_vif *vif, 9522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo struct ieee80211_bss_conf *bss_conf, 9532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo u32 changed) 9542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 95580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo struct wl1251 *wl = hw->priv; 956f7f70579340dba1e551c0e52349fde0370592174Kalle Valo struct sk_buff *beacon, *skb; 9572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo int ret; 9582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 95980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_debug(DEBUG_MAC80211, "mac80211 bss info changed"); 9602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 9612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_lock(&wl->mutex); 9622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 96380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_ps_elp_wakeup(wl); 964c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo if (ret < 0) 965c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo goto out; 96601d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo 967de8df1ea489d80106ea82d4a6323e83d376913fbKalle Valo if (changed & BSS_CHANGED_BSSID) { 968de8df1ea489d80106ea82d4a6323e83d376913fbKalle Valo memcpy(wl->bssid, bss_conf->bssid, ETH_ALEN); 969de8df1ea489d80106ea82d4a6323e83d376913fbKalle Valo 970f7f70579340dba1e551c0e52349fde0370592174Kalle Valo skb = ieee80211_nullfunc_get(wl->hw, wl->vif); 971f7f70579340dba1e551c0e52349fde0370592174Kalle Valo if (!skb) 972f7f70579340dba1e551c0e52349fde0370592174Kalle Valo goto out_sleep; 973f7f70579340dba1e551c0e52349fde0370592174Kalle Valo 974f7f70579340dba1e551c0e52349fde0370592174Kalle Valo ret = wl1251_cmd_template_set(wl, CMD_NULL_DATA, 975f7f70579340dba1e551c0e52349fde0370592174Kalle Valo skb->data, skb->len); 976f7f70579340dba1e551c0e52349fde0370592174Kalle Valo dev_kfree_skb(skb); 977de8df1ea489d80106ea82d4a6323e83d376913fbKalle Valo if (ret < 0) 97880a112ffe8dbada25f3780ecc4beebf23451d755Kalle Valo goto out_sleep; 979de8df1ea489d80106ea82d4a6323e83d376913fbKalle Valo 9808f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo ret = wl1251_build_qos_null_data(wl); 9818f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo if (ret < 0) 9828f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo goto out; 9838f8ff91652fcf62b9fced5387956b4b269fde634Kalle Valo 984de8df1ea489d80106ea82d4a6323e83d376913fbKalle Valo if (wl->bss_type != BSS_TYPE_IBSS) { 985de8df1ea489d80106ea82d4a6323e83d376913fbKalle Valo ret = wl1251_join(wl, wl->bss_type, wl->channel, 986de8df1ea489d80106ea82d4a6323e83d376913fbKalle Valo wl->beacon_int, wl->dtim_period); 987de8df1ea489d80106ea82d4a6323e83d376913fbKalle Valo if (ret < 0) 988de8df1ea489d80106ea82d4a6323e83d376913fbKalle Valo goto out_sleep; 989de8df1ea489d80106ea82d4a6323e83d376913fbKalle Valo } 990de8df1ea489d80106ea82d4a6323e83d376913fbKalle Valo } 991de8df1ea489d80106ea82d4a6323e83d376913fbKalle Valo 9922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (changed & BSS_CHANGED_ASSOC) { 9932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (bss_conf->assoc) { 994e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo wl->beacon_int = bss_conf->beacon_int; 9952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 996f7f70579340dba1e551c0e52349fde0370592174Kalle Valo skb = ieee80211_pspoll_get(wl->hw, wl->vif); 997f7f70579340dba1e551c0e52349fde0370592174Kalle Valo if (!skb) 998f7f70579340dba1e551c0e52349fde0370592174Kalle Valo goto out_sleep; 999f7f70579340dba1e551c0e52349fde0370592174Kalle Valo 1000f7f70579340dba1e551c0e52349fde0370592174Kalle Valo ret = wl1251_cmd_template_set(wl, CMD_PS_POLL, 1001f7f70579340dba1e551c0e52349fde0370592174Kalle Valo skb->data, 1002f7f70579340dba1e551c0e52349fde0370592174Kalle Valo skb->len); 1003f7f70579340dba1e551c0e52349fde0370592174Kalle Valo dev_kfree_skb(skb); 10042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 1005c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo goto out_sleep; 10062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 100756007a028c51cbf800a6c969d6f6431d23443b99Johannes Berg ret = wl1251_acx_aid(wl, bss_conf->aid); 10082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 1009c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo goto out_sleep; 1010e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo } else { 1011e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo /* use defaults when not associated */ 1012e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo wl->beacon_int = WL1251_DEFAULT_BEACON_INT; 1013e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo wl->dtim_period = WL1251_DEFAULT_DTIM_PERIOD; 10142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 10152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 10162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (changed & BSS_CHANGED_ERP_SLOT) { 10172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (bss_conf->use_short_slot) 101880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_acx_slot(wl, SLOT_TIME_SHORT); 10192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo else 102080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_acx_slot(wl, SLOT_TIME_LONG); 10212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) { 102280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_warning("Set slot time failed %d", ret); 1023c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo goto out_sleep; 10242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 10252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 10262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 10272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (changed & BSS_CHANGED_ERP_PREAMBLE) { 10282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (bss_conf->use_short_preamble) 102980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_acx_set_preamble(wl, ACX_PREAMBLE_SHORT); 10302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo else 103180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_acx_set_preamble(wl, ACX_PREAMBLE_LONG); 10322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 10332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 10342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (changed & BSS_CHANGED_ERP_CTS_PROT) { 10352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (bss_conf->use_cts_prot) 103680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_acx_cts_protect(wl, CTSPROTECT_ENABLE); 10372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo else 103880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_acx_cts_protect(wl, CTSPROTECT_DISABLE); 10392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) { 104080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_warning("Set ctsprotect failed %d", ret); 104180a112ffe8dbada25f3780ecc4beebf23451d755Kalle Valo goto out_sleep; 10422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 10432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 10442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 10452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (changed & BSS_CHANGED_BEACON) { 10462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo beacon = ieee80211_beacon_get(hw, vif); 104780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_cmd_template_set(wl, CMD_BEACON, beacon->data, 10482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo beacon->len); 10492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 10502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) { 10512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo dev_kfree_skb(beacon); 105280a112ffe8dbada25f3780ecc4beebf23451d755Kalle Valo goto out_sleep; 10532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 10542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 105580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo ret = wl1251_cmd_template_set(wl, CMD_PROBE_RESP, beacon->data, 10562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo beacon->len); 10572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 10582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo dev_kfree_skb(beacon); 10592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 10602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 106180a112ffe8dbada25f3780ecc4beebf23451d755Kalle Valo goto out_sleep; 10622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1063ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo ret = wl1251_join(wl, wl->bss_type, wl->beacon_int, 1064ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo wl->channel, wl->dtim_period); 10652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 10662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) 106780a112ffe8dbada25f3780ecc4beebf23451d755Kalle Valo goto out_sleep; 10682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 10692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1070c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout_sleep: 107180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_ps_elp_sleep(wl); 1072c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo 1073c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout: 10742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_unlock(&wl->mutex); 10752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 10762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 10772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 10782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo/* can't be const, mac80211 writes to this */ 107980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic struct ieee80211_rate wl1251_rates[] = { 10802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .bitrate = 10, 10812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value = 0x1, 10822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value_short = 0x1, }, 10832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .bitrate = 20, 10842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value = 0x2, 10852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value_short = 0x2, 10862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .flags = IEEE80211_RATE_SHORT_PREAMBLE }, 10872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .bitrate = 55, 10882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value = 0x4, 10892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value_short = 0x4, 10902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .flags = IEEE80211_RATE_SHORT_PREAMBLE }, 10912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .bitrate = 110, 10922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value = 0x20, 10932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value_short = 0x20, 10942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .flags = IEEE80211_RATE_SHORT_PREAMBLE }, 10952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .bitrate = 60, 10962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value = 0x8, 10972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value_short = 0x8, }, 10982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .bitrate = 90, 10992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value = 0x10, 11002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value_short = 0x10, }, 11012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .bitrate = 120, 11022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value = 0x40, 11032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value_short = 0x40, }, 11042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .bitrate = 180, 11052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value = 0x80, 11062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value_short = 0x80, }, 11072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .bitrate = 240, 11082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value = 0x200, 11092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value_short = 0x200, }, 11102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .bitrate = 360, 11112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value = 0x400, 11122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value_short = 0x400, }, 11132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .bitrate = 480, 11142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value = 0x800, 11152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value_short = 0x800, }, 11162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .bitrate = 540, 11172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value = 0x1000, 11182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo .hw_value_short = 0x1000, }, 11192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}; 11202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 11212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo/* can't be const, mac80211 writes to this */ 112280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic struct ieee80211_channel wl1251_channels[] = { 11232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .hw_value = 1, .center_freq = 2412}, 11242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .hw_value = 2, .center_freq = 2417}, 11252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .hw_value = 3, .center_freq = 2422}, 11262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .hw_value = 4, .center_freq = 2427}, 11272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .hw_value = 5, .center_freq = 2432}, 11282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .hw_value = 6, .center_freq = 2437}, 11292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .hw_value = 7, .center_freq = 2442}, 11302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .hw_value = 8, .center_freq = 2447}, 11312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .hw_value = 9, .center_freq = 2452}, 11322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .hw_value = 10, .center_freq = 2457}, 11332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .hw_value = 11, .center_freq = 2462}, 11342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .hw_value = 12, .center_freq = 2467}, 11352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo { .hw_value = 13, .center_freq = 2472}, 11362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}; 11372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 113886dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valostatic int wl1251_op_conf_tx(struct ieee80211_hw *hw, u16 queue, 113986dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo const struct ieee80211_tx_queue_params *params) 114086dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo{ 11414ff6ffa107ba1c6ba9a1cc75a1f304eaa79e8bf4Kalle Valo enum wl1251_acx_ps_scheme ps_scheme; 114286dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo struct wl1251 *wl = hw->priv; 114386dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo int ret; 114486dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo 114586dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo mutex_lock(&wl->mutex); 114686dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo 114786dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo wl1251_debug(DEBUG_MAC80211, "mac80211 conf tx %d", queue); 114886dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo 114986dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo ret = wl1251_ps_elp_wakeup(wl); 115086dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo if (ret < 0) 115186dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo goto out; 115286dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo 115385359499eec796e784e2f1e3d7bbb31d84dd4c2bKalle Valo /* mac80211 uses units of 32 usec */ 115486dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo ret = wl1251_acx_ac_cfg(wl, wl1251_tx_get_queue(queue), 115586dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo params->cw_min, params->cw_max, 115685359499eec796e784e2f1e3d7bbb31d84dd4c2bKalle Valo params->aifs, params->txop * 32); 115727336f1c0cd68fb9ae45493321f0d6980144230eKalle Valo if (ret < 0) 115827336f1c0cd68fb9ae45493321f0d6980144230eKalle Valo goto out_sleep; 115927336f1c0cd68fb9ae45493321f0d6980144230eKalle Valo 11604ff6ffa107ba1c6ba9a1cc75a1f304eaa79e8bf4Kalle Valo if (params->uapsd) 11614ff6ffa107ba1c6ba9a1cc75a1f304eaa79e8bf4Kalle Valo ps_scheme = WL1251_ACX_PS_SCHEME_UPSD_TRIGGER; 11624ff6ffa107ba1c6ba9a1cc75a1f304eaa79e8bf4Kalle Valo else 11634ff6ffa107ba1c6ba9a1cc75a1f304eaa79e8bf4Kalle Valo ps_scheme = WL1251_ACX_PS_SCHEME_LEGACY; 11644ff6ffa107ba1c6ba9a1cc75a1f304eaa79e8bf4Kalle Valo 116527336f1c0cd68fb9ae45493321f0d6980144230eKalle Valo ret = wl1251_acx_tid_cfg(wl, wl1251_tx_get_queue(queue), 116649e1b9faed736b20ad9a785638919341b567a595Kalle Valo CHANNEL_TYPE_EDCF, 11674ff6ffa107ba1c6ba9a1cc75a1f304eaa79e8bf4Kalle Valo wl1251_tx_get_queue(queue), ps_scheme, 116827336f1c0cd68fb9ae45493321f0d6980144230eKalle Valo WL1251_ACX_ACK_POLICY_LEGACY); 116927336f1c0cd68fb9ae45493321f0d6980144230eKalle Valo if (ret < 0) 117027336f1c0cd68fb9ae45493321f0d6980144230eKalle Valo goto out_sleep; 117186dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo 117227336f1c0cd68fb9ae45493321f0d6980144230eKalle Valoout_sleep: 117386dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo wl1251_ps_elp_sleep(wl); 117486dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo 117586dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valoout: 117686dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo mutex_unlock(&wl->mutex); 117786dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo 117886dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo return ret; 117986dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo} 118086dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo 118119434148d16dc231026f37af7c40e81ad9342e75John W. Linvillestatic int wl1251_op_get_survey(struct ieee80211_hw *hw, int idx, 118219434148d16dc231026f37af7c40e81ad9342e75John W. Linville struct survey_info *survey) 118319434148d16dc231026f37af7c40e81ad9342e75John W. Linville{ 118419434148d16dc231026f37af7c40e81ad9342e75John W. Linville struct wl1251 *wl = hw->priv; 118519434148d16dc231026f37af7c40e81ad9342e75John W. Linville struct ieee80211_conf *conf = &hw->conf; 118619434148d16dc231026f37af7c40e81ad9342e75John W. Linville 118719434148d16dc231026f37af7c40e81ad9342e75John W. Linville if (idx != 0) 118819434148d16dc231026f37af7c40e81ad9342e75John W. Linville return -ENOENT; 118919434148d16dc231026f37af7c40e81ad9342e75John W. Linville 119019434148d16dc231026f37af7c40e81ad9342e75John W. Linville survey->channel = conf->channel; 119119434148d16dc231026f37af7c40e81ad9342e75John W. Linville survey->filled = SURVEY_INFO_NOISE_DBM; 119219434148d16dc231026f37af7c40e81ad9342e75John W. Linville survey->noise = wl->noise; 119319434148d16dc231026f37af7c40e81ad9342e75John W. Linville 119419434148d16dc231026f37af7c40e81ad9342e75John W. Linville return 0; 119519434148d16dc231026f37af7c40e81ad9342e75John W. Linville} 119619434148d16dc231026f37af7c40e81ad9342e75John W. Linville 11972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo/* can't be const, mac80211 writes to this */ 119880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic struct ieee80211_supported_band wl1251_band_2ghz = { 119980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo .channels = wl1251_channels, 120080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo .n_channels = ARRAY_SIZE(wl1251_channels), 120180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo .bitrates = wl1251_rates, 120280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo .n_bitrates = ARRAY_SIZE(wl1251_rates), 12032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}; 12042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 120580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic const struct ieee80211_ops wl1251_ops = { 120680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo .start = wl1251_op_start, 120780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo .stop = wl1251_op_stop, 120880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo .add_interface = wl1251_op_add_interface, 120980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo .remove_interface = wl1251_op_remove_interface, 121080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo .config = wl1251_op_config, 121180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo .configure_filter = wl1251_op_configure_filter, 121280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo .tx = wl1251_op_tx, 121380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo .set_key = wl1251_op_set_key, 121480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo .hw_scan = wl1251_op_hw_scan, 121580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo .bss_info_changed = wl1251_op_bss_info_changed, 121680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo .set_rts_threshold = wl1251_op_set_rts_threshold, 121786dff7a7955f1e14c1f2c142312462fae70ea7e4Kalle Valo .conf_tx = wl1251_op_conf_tx, 121819434148d16dc231026f37af7c40e81ad9342e75John W. Linville .get_survey = wl1251_op_get_survey, 12192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}; 12202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 122161c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotasstatic int wl1251_read_eeprom_byte(struct wl1251 *wl, off_t offset, u8 *data) 122261c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas{ 122361c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas unsigned long timeout; 122461c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 122561c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas wl1251_reg_write32(wl, EE_ADDR, offset); 122661c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas wl1251_reg_write32(wl, EE_CTL, EE_CTL_READ); 122761c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 122861c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas /* EE_CTL_READ clears when data is ready */ 122961c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas timeout = jiffies + msecs_to_jiffies(100); 123061c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas while (1) { 123161c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas if (!(wl1251_reg_read32(wl, EE_CTL) & EE_CTL_READ)) 123261c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas break; 123361c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 123461c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas if (time_after(jiffies, timeout)) 123561c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas return -ETIMEDOUT; 123661c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 123761c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas msleep(1); 123861c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas } 123961c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 124061c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas *data = wl1251_reg_read32(wl, EE_DATA); 124161c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas return 0; 124261c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas} 124361c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 124461c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotasstatic int wl1251_read_eeprom(struct wl1251 *wl, off_t offset, 124561c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas u8 *data, size_t len) 124661c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas{ 124761c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas size_t i; 124861c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas int ret; 124961c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 125061c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas wl1251_reg_write32(wl, EE_START, 0); 125161c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 125261c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas for (i = 0; i < len; i++) { 125361c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas ret = wl1251_read_eeprom_byte(wl, offset + i, &data[i]); 125461c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas if (ret < 0) 125561c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas return ret; 125661c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas } 125761c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 125861c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas return 0; 125961c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas} 126061c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 126161c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotasstatic int wl1251_read_eeprom_mac(struct wl1251 *wl) 126261c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas{ 126361c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas u8 mac[ETH_ALEN]; 126461c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas int i, ret; 126561c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 126661c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas wl1251_set_partition(wl, 0, 0, REGISTERS_BASE, REGISTERS_DOWN_SIZE); 126761c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 126861c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas ret = wl1251_read_eeprom(wl, 0x1c, mac, sizeof(mac)); 126961c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas if (ret < 0) { 127061c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas wl1251_warning("failed to read MAC address from EEPROM"); 127161c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas return ret; 127261c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas } 127361c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 127461c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas /* MAC is stored in reverse order */ 127561c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas for (i = 0; i < ETH_ALEN; i++) 127661c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas wl->mac_addr[i] = mac[ETH_ALEN - i - 1]; 127761c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 127861c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas return 0; 127961c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas} 128061c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 128180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_register_hw(struct wl1251 *wl) 12822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 12832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo int ret; 12842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 12852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (wl->mac80211_registered) 12862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return 0; 12872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 12882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo SET_IEEE80211_PERM_ADDR(wl->hw, wl->mac_addr); 12892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 12902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ret = ieee80211_register_hw(wl->hw); 12912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (ret < 0) { 129280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_error("unable to register mac80211 hw: %d", ret); 12932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return ret; 12942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 12952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 12962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->mac80211_registered = true; 12972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 129880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_notice("loaded"); 12992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 13002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return 0; 13012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 13022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 13038e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copelandint wl1251_init_ieee80211(struct wl1251 *wl) 13042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 13058e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland int ret; 13068e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland 13072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* The tx descriptor buffer and the TKIP space */ 13082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->hw->extra_tx_headroom = sizeof(struct tx_double_buffer_desc) 13099f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen + WL1251_TKIP_IV_SPACE; 13102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 13112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* unit us */ 13122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* FIXME: find a proper value */ 13132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->hw->channel_change_time = 10000; 13142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 13152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->hw->flags = IEEE80211_HW_SIGNAL_DBM | 13166b21a2cd315e2e56a1748bd3ef9d910fe4f2e711Juuso Oikarinen IEEE80211_HW_SUPPORTS_PS | 13174ff6ffa107ba1c6ba9a1cc75a1f304eaa79e8bf4Kalle Valo IEEE80211_HW_BEACON_FILTER | 13184ff6ffa107ba1c6ba9a1cc75a1f304eaa79e8bf4Kalle Valo IEEE80211_HW_SUPPORTS_UAPSD; 13192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 13202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION); 13212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->hw->wiphy->max_scan_ssids = 1; 132280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl->hw->wiphy->bands[IEEE80211_BAND_2GHZ] = &wl1251_band_2ghz; 13232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 1324da2fb4e9c215b8f0f8954818691549f8a34135beKalle Valo wl->hw->queues = 4; 1325da2fb4e9c215b8f0f8954818691549f8a34135beKalle Valo 132661c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas if (wl->use_eeprom) 132761c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas wl1251_read_eeprom_mac(wl); 132861c2a80b960361a930a4e3c4c0df694713b9dafdGrazvydas Ignotas 13298e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland ret = wl1251_register_hw(wl); 13308e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland if (ret) 13318e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland goto out; 13322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 13338e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland wl1251_debugfs_init(wl); 13348e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland wl1251_notice("initialized"); 13352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 13368e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland ret = 0; 13378e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland 13388e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copelandout: 13398e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland return ret; 13408e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland} 1341af8c78ebbf2a15ecf9b2b6b7b051b0d4c3ba1163Bob CopelandEXPORT_SYMBOL_GPL(wl1251_init_ieee80211); 134208d9f57251841e4870cfd286e867ffcbef81d9a4Bob Copeland 13438e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copelandstruct ieee80211_hw *wl1251_alloc_hw(void) 13442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 13452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo struct ieee80211_hw *hw; 134680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo struct wl1251 *wl; 13478e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland int i; 13482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo static const u8 nokia_oui[3] = {0x00, 0x1f, 0xdf}; 13492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 135080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo hw = ieee80211_alloc_hw(sizeof(*wl), &wl1251_ops); 13512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo if (!hw) { 135280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_error("could not alloc ieee80211_hw"); 13538e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland return ERR_PTR(-ENOMEM); 13542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo } 13552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 13562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl = hw->priv; 13572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo memset(wl, 0, sizeof(*wl)); 13582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 13592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->hw = hw; 13602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 13612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->data_in_count = 0; 13622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 13632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo skb_queue_head_init(&wl->tx_queue); 13642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 136580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo INIT_WORK(&wl->filter_work, wl1251_filter_work); 1366d5da79ac1f5050cccaa68d814ccce292371f25faJuuso Oikarinen INIT_DELAYED_WORK(&wl->elp_work, wl1251_elp_work); 136780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl->channel = WL1251_DEFAULT_CHANNEL; 13682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->scanning = false; 13692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->default_key = 0; 13702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->listen_int = 1; 13712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_counter = 0; 13722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_handled = 0; 13732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_current_buffer = 0; 13742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->rx_last_id = 0; 137580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl->rx_config = WL1251_DEFAULT_RX_CONFIG; 137680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl->rx_filter = WL1251_DEFAULT_RX_FILTER; 13772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->elp = false; 13782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->psm = 0; 13792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->psm_requested = false; 13802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->tx_queue_stopped = false; 138180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl->power_level = WL1251_DEFAULT_POWER_LEVEL; 1382e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo wl->beacon_int = WL1251_DEFAULT_BEACON_INT; 1383e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo wl->dtim_period = WL1251_DEFAULT_DTIM_PERIOD; 1384287f6f9672635f4e948c0aa96754a2ce448ebdb2Juuso Oikarinen wl->vif = NULL; 13852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 13862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo for (i = 0; i < FW_TX_CMPLT_BLOCK_SIZE; i++) 13872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->tx_frames[i] = NULL; 13882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 13892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->next_tx_complete = 0; 13902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 13910e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo INIT_WORK(&wl->irq_work, wl1251_irq_work); 13920e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo INIT_WORK(&wl->tx_work, wl1251_tx_work); 13930e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo 13942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo /* 13952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * In case our MAC address is not correctly set, 13962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo * we use a random but Nokia MAC. 13972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo */ 13982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo memcpy(wl->mac_addr, nokia_oui, 3); 13992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo get_random_bytes(wl->mac_addr + 3, 3); 14002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 140180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl->state = WL1251_STATE_OFF; 14022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo mutex_init(&wl->mutex); 14032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 14042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->tx_mgmt_frm_rate = DEFAULT_HW_GEN_TX_RATE; 14052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->tx_mgmt_frm_mod = DEFAULT_HW_GEN_MODULATION_TYPE; 14062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 14074721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo wl->rx_descriptor = kmalloc(sizeof(*wl->rx_descriptor), GFP_KERNEL); 14084721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo if (!wl->rx_descriptor) { 140980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_error("could not allocate memory for rx descriptor"); 14108e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland ieee80211_free_hw(hw); 14118e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland return ERR_PTR(-ENOMEM); 14124721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo } 14134721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo 14148e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland return hw; 14152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 1416af8c78ebbf2a15ecf9b2b6b7b051b0d4c3ba1163Bob CopelandEXPORT_SYMBOL_GPL(wl1251_alloc_hw); 14172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 14188e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copelandint wl1251_free_hw(struct wl1251 *wl) 14192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{ 14202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ieee80211_unregister_hw(wl->hw); 14212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 142280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo wl1251_debugfs_exit(wl); 14232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 14242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo kfree(wl->target_mem_map); 14252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo kfree(wl->data_path); 1426c74ddfd5ea9c0c67d0aae77eeb5b610188cb8bc4Kalle Valo vfree(wl->fw); 14272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->fw = NULL; 14282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo kfree(wl->nvs); 14292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo wl->nvs = NULL; 14304721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo 14314721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo kfree(wl->rx_descriptor); 14324721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo wl->rx_descriptor = NULL; 14334721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo 14342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo ieee80211_free_hw(wl->hw); 14352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo 14362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo return 0; 14372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo} 1438af8c78ebbf2a15ecf9b2b6b7b051b0d4c3ba1163Bob CopelandEXPORT_SYMBOL_GPL(wl1251_free_hw); 1439af8c78ebbf2a15ecf9b2b6b7b051b0d4c3ba1163Bob Copeland 1440af8c78ebbf2a15ecf9b2b6b7b051b0d4c3ba1163Bob CopelandMODULE_DESCRIPTION("TI wl1251 Wireles LAN Driver Core"); 1441af8c78ebbf2a15ecf9b2b6b7b051b0d4c3ba1163Bob CopelandMODULE_LICENSE("GPL"); 1442b1b0a2b8b51fa3f0cd349f947a38ab4c6ab192c6Kalle ValoMODULE_AUTHOR("Kalle Valo <kalle.valo@nokia.com>"); 144349f146de405cfb37c51976b8a682330b8cb2972eBen HutchingsMODULE_FIRMWARE(WL1251_FW_NAME); 1444