main.c revision ae46ae17d1d8b953eb5859764737c065e4e3c86b
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>
312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
321367411858d5fc60b632a3f488f2b4adc73d12d7Kalle Valo#include "wl1251.h"
332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo#include "wl12xx_80211.h"
342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo#include "reg.h"
350764de64c8628f653c7e8493017d6bd8d43f4e3bBob Copeland#include "wl1251_io.h"
368e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland#include "wl1251_cmd.h"
37ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_event.h"
389f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen#include "wl1251_tx.h"
39ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_rx.h"
40ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_ps.h"
41ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_init.h"
42ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_debugfs.h"
430e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo#include "wl1251_boot.h"
442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
45b5ed9c1b6f8fcb2d2315f12599fd5808f7933f16Bob Copelandvoid wl1251_enable_interrupts(struct wl1251 *wl)
462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
47b5ed9c1b6f8fcb2d2315f12599fd5808f7933f16Bob Copeland	wl->if_ops->enable_irq(wl);
48b5ed9c1b6f8fcb2d2315f12599fd5808f7933f16Bob Copeland}
49b5ed9c1b6f8fcb2d2315f12599fd5808f7933f16Bob Copeland
50b5ed9c1b6f8fcb2d2315f12599fd5808f7933f16Bob Copelandvoid wl1251_disable_interrupts(struct wl1251 *wl)
51b5ed9c1b6f8fcb2d2315f12599fd5808f7933f16Bob Copeland{
52b5ed9c1b6f8fcb2d2315f12599fd5808f7933f16Bob Copeland	wl->if_ops->disable_irq(wl);
532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_power_off(struct wl1251 *wl)
562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->set_power(false);
582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_power_on(struct wl1251 *wl)
612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->set_power(true);
632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_fetch_firmware(struct wl1251 *wl)
662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	const struct firmware *fw;
686c766f413c81d5a11588552934fa093eab6ae06eBob Copeland	struct device *dev = wiphy_dev(wl->hw->wiphy);
692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
710e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	ret = request_firmware(&fw, WL1251_FW_NAME, dev);
722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0) {
7480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("could not get firmware: %d", ret);
752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return ret;
762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (fw->size % 4) {
7980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("firmware size is not multiple of 32 bits: %zu",
802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     fw->size);
812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -EILSEQ;
822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->fw_len = fw->size;
862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->fw = kmalloc(wl->fw_len, GFP_KERNEL);
872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (!wl->fw) {
8980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("could not allocate memory for the firmware");
902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -ENOMEM;
912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memcpy(wl->fw, fw->data, wl->fw_len);
952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ret = 0;
972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout:
992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	release_firmware(fw);
1002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
1022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
1032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_fetch_nvs(struct wl1251 *wl)
1052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
1062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	const struct firmware *fw;
1076c766f413c81d5a11588552934fa093eab6ae06eBob Copeland	struct device *dev = wiphy_dev(wl->hw->wiphy);
1082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
1092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1100e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	ret = request_firmware(&fw, WL1251_NVS_NAME, dev);
1112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0) {
11380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("could not get nvs file: %d", ret);
1142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return ret;
1152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
1162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (fw->size % 4) {
11880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("nvs size is not multiple of 32 bits: %zu",
1192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     fw->size);
1202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -EILSEQ;
1212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
1222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
1232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->nvs_len = fw->size;
1252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->nvs = kmalloc(wl->nvs_len, GFP_KERNEL);
1262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (!wl->nvs) {
12880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("could not allocate memory for the nvs file");
1292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -ENOMEM;
1302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
1312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
1322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memcpy(wl->nvs, fw->data, wl->nvs_len);
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;
14880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_write32(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, elp_reg);
14980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	elp_reg = wl1251_read32(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_PG10:
1872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case CHIP_ID_1251_PG11:
1882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	default:
1890e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		wl1251_error("unsupported chip id: 0x%x", wl->chip_id);
1902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -ENODEV;
1912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
1922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
1932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (wl->fw == NULL) {
19580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_fetch_firmware(wl);
1962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
1972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
1982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
1992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
2002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* No NVS from netlink, try to get it from the filesystem */
2012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (wl->nvs == NULL) {
20280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_fetch_nvs(wl);
2032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
2042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
2052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
2062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
2072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout:
2082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
2092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
2102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
2110e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valostatic void wl1251_irq_work(struct work_struct *work)
2120e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo{
2130e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	u32 intr;
2140e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	struct wl1251 *wl =
2150e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		container_of(work, struct wl1251, irq_work);
2160e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	int ret;
2170e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2180e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	mutex_lock(&wl->mutex);
2190e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2200e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	wl1251_debug(DEBUG_IRQ, "IRQ work");
2210e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2220e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	if (wl->state == WL1251_STATE_OFF)
2230e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		goto out;
2240e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2250e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	ret = wl1251_ps_elp_wakeup(wl);
2260e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	if (ret < 0)
2270e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		goto out;
2280e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2290e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	wl1251_reg_write32(wl, ACX_REG_INTERRUPT_MASK, WL1251_ACX_INTR_ALL);
2300e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2310e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	intr = wl1251_reg_read32(wl, ACX_REG_INTERRUPT_CLEAR);
2320e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	wl1251_debug(DEBUG_IRQ, "intr: 0x%x", intr);
2330e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2340e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	if (wl->data_path) {
2350e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		wl->rx_counter =
2360e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			wl1251_mem_read32(wl, wl->data_path->rx_control_addr);
2370e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2380e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		/* We handle a frmware bug here */
2390e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		switch ((wl->rx_counter - wl->rx_handled) & 0xf) {
2400e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		case 0:
2410e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			wl1251_debug(DEBUG_IRQ, "RX: FW and host in sync");
2420e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			intr &= ~WL1251_ACX_INTR_RX0_DATA;
2430e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			intr &= ~WL1251_ACX_INTR_RX1_DATA;
2440e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			break;
2450e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		case 1:
2460e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			wl1251_debug(DEBUG_IRQ, "RX: FW +1");
2470e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			intr |= WL1251_ACX_INTR_RX0_DATA;
2480e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			intr &= ~WL1251_ACX_INTR_RX1_DATA;
2490e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			break;
2500e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		case 2:
2510e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			wl1251_debug(DEBUG_IRQ, "RX: FW +2");
2520e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			intr |= WL1251_ACX_INTR_RX0_DATA;
2530e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			intr |= WL1251_ACX_INTR_RX1_DATA;
2540e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			break;
2550e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		default:
2560e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			wl1251_warning("RX: FW and host out of sync: %d",
2570e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo				       wl->rx_counter - wl->rx_handled);
2580e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			break;
2590e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		}
2600e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2610e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		wl->rx_handled = wl->rx_counter;
2620e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2630e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2640e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		wl1251_debug(DEBUG_IRQ, "RX counter: %d", wl->rx_counter);
2650e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	}
2660e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2670e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	intr &= wl->intr_mask;
2680e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2690e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	if (intr == 0) {
2700e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		wl1251_debug(DEBUG_IRQ, "INTR is 0");
2710e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		wl1251_reg_write32(wl, ACX_REG_INTERRUPT_MASK,
2720e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo				   ~(wl->intr_mask));
2730e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2740e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		goto out_sleep;
2750e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	}
2760e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2770e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	if (intr & WL1251_ACX_INTR_RX0_DATA) {
2780e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		wl1251_debug(DEBUG_IRQ, "WL1251_ACX_INTR_RX0_DATA");
2790e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		wl1251_rx(wl);
2800e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	}
2810e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2820e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	if (intr & WL1251_ACX_INTR_RX1_DATA) {
2830e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		wl1251_debug(DEBUG_IRQ, "WL1251_ACX_INTR_RX1_DATA");
2840e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		wl1251_rx(wl);
2850e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	}
2860e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2870e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	if (intr & WL1251_ACX_INTR_TX_RESULT) {
2880e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		wl1251_debug(DEBUG_IRQ, "WL1251_ACX_INTR_TX_RESULT");
2890e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		wl1251_tx_complete(wl);
2900e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	}
2910e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
2920e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	if (intr & (WL1251_ACX_INTR_EVENT_A | WL1251_ACX_INTR_EVENT_B)) {
2930e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		wl1251_debug(DEBUG_IRQ, "WL1251_ACX_INTR_EVENT (0x%x)", intr);
2940e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		if (intr & WL1251_ACX_INTR_EVENT_A)
2950e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			wl1251_event_handle(wl, 0);
2960e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		else
2970e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo			wl1251_event_handle(wl, 1);
2980e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	}
2990e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
3000e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	if (intr & WL1251_ACX_INTR_INIT_COMPLETE)
3010e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo		wl1251_debug(DEBUG_IRQ, "WL1251_ACX_INTR_INIT_COMPLETE");
3020e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
3030e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	wl1251_reg_write32(wl, ACX_REG_INTERRUPT_MASK, ~(wl->intr_mask));
3040e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
3050e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valoout_sleep:
3060e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	wl1251_ps_elp_sleep(wl);
3070e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
3080e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valoout:
3090e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	mutex_unlock(&wl->mutex);
3100e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo}
3110e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
312ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valostatic int wl1251_join(struct wl1251 *wl, u8 bss_type, u8 channel,
313ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo		       u16 beacon_interval, u8 dtim_period)
314ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo{
315ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo	int ret;
316ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo
317ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo	ret = wl1251_acx_frame_rates(wl, DEFAULT_HW_GEN_TX_RATE,
318ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo				     DEFAULT_HW_GEN_MODULATION_TYPE,
319ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo				     wl->tx_mgmt_frm_rate,
320ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo				     wl->tx_mgmt_frm_mod);
321ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo	if (ret < 0)
322ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo		goto out;
323ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo
324ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo
325ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo	ret = wl1251_cmd_join(wl, bss_type, channel, beacon_interval,
326ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo			      dtim_period);
327ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo	if (ret < 0)
328ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo		goto out;
329ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo
330ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo	/*
331ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo	 * FIXME: we should wait for JOIN_EVENT_COMPLETE_ID but to simplify
332ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo	 * locking we just sleep instead, for now
333ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo	 */
334ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo	msleep(10);
335ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo
336ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valoout:
337ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo	return ret;
338ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo}
339ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo
34080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_filter_work(struct work_struct *work)
3412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
34280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl =
34380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		container_of(work, struct wl1251, filter_work);
3442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
3452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
3472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
34880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	if (wl->state == WL1251_STATE_OFF)
3492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
3502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
35180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_ps_elp_wakeup(wl);
352c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo	if (ret < 0)
353c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out;
35401d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
355ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo	ret = wl1251_join(wl, wl->bss_type, wl->channel, wl->beacon_int,
356ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo			  wl->dtim_period);
3572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
358c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out_sleep;
3592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
360c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout_sleep:
36180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_ps_elp_sleep(wl);
362c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo
363c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout:
3642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
3652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
3662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
36780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_tx(struct ieee80211_hw *hw, struct sk_buff *skb)
3682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
36980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
3702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	skb_queue_tail(&wl->tx_queue, skb);
3722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3739f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen	/*
3749f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen	 * The chip specific setup must run before the first TX packet -
3759f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen	 * before that, the tx_work will not be initialized!
3769f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen	 */
3779f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen
3782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	schedule_work(&wl->tx_work);
3792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/*
3812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * The workqueue is slow to process the tx_queue and we need stop
3822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * the queue here, otherwise the queue will get too long.
3832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 */
38480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	if (skb_queue_len(&wl->tx_queue) >= WL1251_TX_QUEUE_MAX_LENGTH) {
3852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ieee80211_stop_queues(wl->hw);
3862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		/*
3882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * FIXME: this is racy, the variable is not properly
3892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * protected. Maybe fix this by removing the stupid
3902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * variable altogether and checking the real queue state?
3912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 */
3922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->tx_queue_stopped = true;
3932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
3942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return NETDEV_TX_OK;
3962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
3972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
39880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_start(struct ieee80211_hw *hw)
3992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
40080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
4012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret = 0;
4022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
40380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 start");
4042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
4062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
40780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	if (wl->state != WL1251_STATE_OFF) {
40880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("cannot start because not in off state: %d",
4092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     wl->state);
4102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -EBUSY;
4112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
4122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
4132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
41480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_chip_wakeup(wl);
4152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
416fe643414dbf330d6d910e01edd48dd93dc6f2942Jiri Slaby		goto out;
4172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4180e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	ret = wl1251_boot(wl);
4192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
4202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
4212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4220e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	ret = wl1251_hw_init(wl);
4232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
4242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
4252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
42680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_acx_station_id(wl);
4272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
4282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
4292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
43080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->state = WL1251_STATE_ON;
4312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4320e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	wl1251_info("firmware booted (%s)", wl->fw_ver);
4332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout:
4352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
43680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_power_off(wl);
4372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
4392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
4412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
4422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
44380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_op_stop(struct ieee80211_hw *hw)
4442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
44580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
4462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
44780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_info("down");
4482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
44980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 stop");
4502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
4522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
45380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	WARN_ON(wl->state != WL1251_STATE_ON);
4542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (wl->scanning) {
4562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		mutex_unlock(&wl->mutex);
4572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ieee80211_scan_completed(wl->hw, true);
4582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		mutex_lock(&wl->mutex);
4592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->scanning = false;
4602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
4612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
46280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->state = WL1251_STATE_OFF;
4632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
46480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_disable_interrupts(wl);
4652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
4672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	cancel_work_sync(&wl->irq_work);
4692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	cancel_work_sync(&wl->tx_work);
4702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	cancel_work_sync(&wl->filter_work);
4712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
4732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* let's notify MAC80211 about the remaining pending TX frames */
4750e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	wl1251_tx_flush(wl);
47680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_power_off(wl);
4772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memset(wl->bssid, 0, ETH_ALEN);
4792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->listen_int = 1;
4802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->bss_type = MAX_BSS_TYPE;
4812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->data_in_count = 0;
4832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_counter = 0;
4842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_handled = 0;
4852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_current_buffer = 0;
4862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_last_id = 0;
4872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->next_tx_complete = 0;
4882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->elp = false;
4892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->psm = 0;
4902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->tx_queue_stopped = false;
49180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->power_level = WL1251_DEFAULT_POWER_LEVEL;
4929780279c60c32cb5f14531aa34ae991bb714c90cKalle Valo	wl->channel = WL1251_DEFAULT_CHANNEL;
4932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
49480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debugfs_reset(wl);
4952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
4972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
4982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
49980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_add_interface(struct ieee80211_hw *hw,
5002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				   struct ieee80211_if_init_conf *conf)
5012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
50280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
5032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret = 0;
5042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
505e91d83346ad9b30f44469c92b982206dcd7dcaf0Johannes Berg	wl1251_debug(DEBUG_MAC80211, "mac80211 add interface type %d mac %pM",
506e91d83346ad9b30f44469c92b982206dcd7dcaf0Johannes Berg		     conf->type, conf->mac_addr);
5072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
5092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	switch (conf->type) {
5112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case NL80211_IFTYPE_STATION:
5122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->bss_type = BSS_TYPE_STA_BSS;
5132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
5142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case NL80211_IFTYPE_ADHOC:
5152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->bss_type = BSS_TYPE_IBSS;
5162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
5172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	default:
5182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -EOPNOTSUPP;
5192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
5202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
5212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (memcmp(wl->mac_addr, conf->mac_addr, ETH_ALEN)) {
5232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memcpy(wl->mac_addr, conf->mac_addr, ETH_ALEN);
5242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		SET_IEEE80211_PERM_ADDR(wl->hw, wl->mac_addr);
52580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_acx_station_id(wl);
5262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
5272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
5282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
5292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout:
5312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
5322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
5332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
5342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
53580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_op_remove_interface(struct ieee80211_hw *hw,
5362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo					 struct ieee80211_if_init_conf *conf)
5372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
53880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 remove interface");
5392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
5402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
54180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_build_null_data(struct wl1251 *wl)
5422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
5432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	struct wl12xx_null_data_template template;
5442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (!is_zero_ether_addr(wl->bssid)) {
5462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memcpy(template.header.da, wl->bssid, ETH_ALEN);
5472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memcpy(template.header.bssid, wl->bssid, ETH_ALEN);
5482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	} else {
5492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memset(template.header.da, 0xff, ETH_ALEN);
5502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memset(template.header.bssid, 0xff, ETH_ALEN);
5512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
5522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memcpy(template.header.sa, wl->mac_addr, ETH_ALEN);
5542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	template.header.frame_ctl = cpu_to_le16(IEEE80211_FTYPE_DATA |
5552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo						IEEE80211_STYPE_NULLFUNC);
5562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
55780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	return wl1251_cmd_template_set(wl, CMD_NULL_DATA, &template,
5582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       sizeof(template));
5592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
5612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
56280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_build_ps_poll(struct wl1251 *wl, u16 aid)
5632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
5642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	struct wl12xx_ps_poll_template template;
5652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memcpy(template.bssid, wl->bssid, ETH_ALEN);
5672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memcpy(template.ta, wl->mac_addr, ETH_ALEN);
5682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	template.aid = aid;
5692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	template.fc = cpu_to_le16(IEEE80211_FTYPE_CTL | IEEE80211_STYPE_PSPOLL);
5702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
57180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	return wl1251_cmd_template_set(wl, CMD_PS_POLL, &template,
5722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       sizeof(template));
5732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
5752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
57680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_config(struct ieee80211_hw *hw, u32 changed)
5772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
57880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
5792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	struct ieee80211_conf *conf = &hw->conf;
5802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int channel, ret = 0;
5812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	channel = ieee80211_frequency_to_channel(conf->channel->center_freq);
5832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
58480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 config ch %d psm %s power %d",
5852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		     channel,
5862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		     conf->flags & IEEE80211_CONF_PS ? "on" : "off",
5872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		     conf->power_level);
5882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
5902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
59180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_ps_elp_wakeup(wl);
592c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo	if (ret < 0)
593c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out;
59401d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
5952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (channel != wl->channel) {
596ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo		ret = wl1251_join(wl, wl->bss_type, wl->channel,
597ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo				  wl->beacon_int, wl->dtim_period);
5982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
599c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo			goto out_sleep;
6002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->channel = channel;
6022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
6032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
60480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_build_null_data(wl);
6052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
606c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out_sleep;
6072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (conf->flags & IEEE80211_CONF_PS && !wl->psm_requested) {
60947af3fe36dc478f7eddc8bec104ff1876d71f37cLuciano Coelho		wl1251_debug(DEBUG_PSM, "psm enabled");
6102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->psm_requested = true;
6122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		/*
6142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * We enter PSM only if we're already associated.
6152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * If we're not, we'll enter it when joining an SSID,
6162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * through the bss_info_changed() hook.
6172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 */
61880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_ps_set_mode(wl, STATION_POWER_SAVE_MODE);
6192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	} else if (!(conf->flags & IEEE80211_CONF_PS) &&
6202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		   wl->psm_requested) {
62147af3fe36dc478f7eddc8bec104ff1876d71f37cLuciano Coelho		wl1251_debug(DEBUG_PSM, "psm disabled");
6222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->psm_requested = false;
6242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (wl->psm)
62680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			ret = wl1251_ps_set_mode(wl, STATION_ACTIVE_MODE);
6272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
6282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (conf->power_level != wl->power_level) {
63080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_acx_tx_power(wl, conf->power_level);
6312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
6322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
6332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->power_level = conf->power_level;
6352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
6362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
637c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout_sleep:
63880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_ps_elp_sleep(wl);
639c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo
640c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout:
6412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
642c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo
6432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
6442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
6452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
64680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo#define WL1251_SUPPORTED_FILTERS (FIF_PROMISC_IN_BSS | \
6472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				  FIF_ALLMULTI | \
6482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				  FIF_FCSFAIL | \
6492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				  FIF_BCN_PRBRESP_PROMISC | \
6502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				  FIF_CONTROL | \
6512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				  FIF_OTHER_BSS)
6522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
65380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_op_configure_filter(struct ieee80211_hw *hw,
6542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       unsigned int changed,
6552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       unsigned int *total,
6562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       int mc_count,
6572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       struct dev_addr_list *mc_list)
6582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
65980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
6602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
66180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 configure filter");
6622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
66380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	*total &= WL1251_SUPPORTED_FILTERS;
66480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	changed &= WL1251_SUPPORTED_FILTERS;
6652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (changed == 0)
6672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		/* no filters which we support changed */
6682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return;
6692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* FIXME: wl->rx_config and wl->rx_filter are not protected */
6712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
67280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->rx_config = WL1251_DEFAULT_RX_CONFIG;
67380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->rx_filter = WL1251_DEFAULT_RX_FILTER;
6742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (*total & FIF_PROMISC_IN_BSS) {
6762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_config |= CFG_BSSID_FILTER_EN;
6772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_config |= CFG_RX_ALL_GOOD;
6782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
6792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (*total & FIF_ALLMULTI)
6802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		/*
6812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * CFG_MC_FILTER_EN in rx_config needs to be 0 to receive
6822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * all multicast frames
6832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 */
6842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_config &= ~CFG_MC_FILTER_EN;
6852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (*total & FIF_FCSFAIL)
6862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_filter |= CFG_RX_FCS_ERROR;
6872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (*total & FIF_BCN_PRBRESP_PROMISC) {
6882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_config &= ~CFG_BSSID_FILTER_EN;
6892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_config &= ~CFG_SSID_FILTER_EN;
6902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
6912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (*total & FIF_CONTROL)
6922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_filter |= CFG_RX_CTL_EN;
6932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (*total & FIF_OTHER_BSS)
6942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_filter &= ~CFG_BSSID_FILTER_EN;
6952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/*
6972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * FIXME: workqueues need to be properly cancelled on stop(), for
6982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * now let's just disable changing the filter settings. They will
6992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * be updated any on config().
7002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 */
7012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* schedule_work(&wl->filter_work); */
7022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
7032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo/* HW encryption */
70580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_set_key_type(struct wl1251 *wl,
70680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			       struct wl1251_cmd_set_keys *key,
7072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			       enum set_key_cmd cmd,
7082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			       struct ieee80211_key_conf *mac80211_key,
7092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			       const u8 *addr)
7102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
7112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	switch (mac80211_key->alg) {
7122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case ALG_WEP:
7132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (is_broadcast_ether_addr(addr))
7142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			key->key_type = KEY_WEP_DEFAULT;
7152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		else
7162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			key->key_type = KEY_WEP_ADDR;
7172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		mac80211_key->hw_key_idx = mac80211_key->keyidx;
7192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
7202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case ALG_TKIP:
7212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (is_broadcast_ether_addr(addr))
7222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			key->key_type = KEY_TKIP_MIC_GROUP;
7232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		else
7242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			key->key_type = KEY_TKIP_MIC_PAIRWISE;
7252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		mac80211_key->hw_key_idx = mac80211_key->keyidx;
7272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
7282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case ALG_CCMP:
7292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (is_broadcast_ether_addr(addr))
7302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			key->key_type = KEY_AES_GROUP;
7312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		else
7322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			key->key_type = KEY_AES_PAIRWISE;
7332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		mac80211_key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
7342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
7352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	default:
73680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("Unknown key algo 0x%x", mac80211_key->alg);
7372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return -EOPNOTSUPP;
7382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
7392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return 0;
7412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
7422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
74380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
7442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     struct ieee80211_vif *vif,
7452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     struct ieee80211_sta *sta,
7462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     struct ieee80211_key_conf *key)
7472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
74880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
74980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251_cmd_set_keys *wl_cmd;
7502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	const u8 *addr;
7512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
7522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	static const u8 bcast_addr[ETH_ALEN] =
7542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		{ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
7552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
75680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 set key");
7572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
758ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	wl_cmd = kzalloc(sizeof(*wl_cmd), GFP_KERNEL);
759ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	if (!wl_cmd) {
760ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		ret = -ENOMEM;
761ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		goto out;
762ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	}
7632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	addr = sta ? sta->addr : bcast_addr;
7652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
76680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_CRYPT, "CMD: 0x%x", cmd);
76780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_dump(DEBUG_CRYPT, "ADDR: ", addr, ETH_ALEN);
76880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_CRYPT, "Key: algo:0x%x, id:%d, len:%d flags 0x%x",
7692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		     key->alg, key->keyidx, key->keylen, key->flags);
77080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_dump(DEBUG_CRYPT, "KEY: ", key->key, key->keylen);
7712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
772ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	if (is_zero_ether_addr(addr)) {
773ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		/* We dont support TX only encryption */
774ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		ret = -EOPNOTSUPP;
775ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		goto out;
776ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	}
777ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo
7782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
7792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
78080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_ps_elp_wakeup(wl);
781c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo	if (ret < 0)
782c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out_unlock;
78301d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
7842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	switch (cmd) {
7852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case SET_KEY:
786ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		wl_cmd->key_action = KEY_ADD_OR_REPLACE;
7872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
7882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case DISABLE_KEY:
789ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		wl_cmd->key_action = KEY_REMOVE;
7902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
7912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	default:
79280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("Unsupported key cmd 0x%x", cmd);
7932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
7942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
7952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
79680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_set_key_type(wl, wl_cmd, cmd, key, addr);
7972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0) {
79880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("Set KEY type failed");
799c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out_sleep;
8002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
8012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
802ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	if (wl_cmd->key_type != KEY_WEP_DEFAULT)
803ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		memcpy(wl_cmd->addr, addr, ETH_ALEN);
8042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
805ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	if ((wl_cmd->key_type == KEY_TKIP_MIC_GROUP) ||
806ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	    (wl_cmd->key_type == KEY_TKIP_MIC_PAIRWISE)) {
8072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		/*
8082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * We get the key in the following form:
8092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * TKIP (16 bytes) - TX MIC (8 bytes) - RX MIC (8 bytes)
8102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * but the target is expecting:
8112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * TKIP - RX MIC - TX MIC
8122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 */
813ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		memcpy(wl_cmd->key, key->key, 16);
814ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		memcpy(wl_cmd->key + 16, key->key + 24, 8);
815ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		memcpy(wl_cmd->key + 24, key->key + 16, 8);
8162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	} else {
818ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		memcpy(wl_cmd->key, key->key, key->keylen);
8192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
820ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	wl_cmd->key_size = key->keylen;
8212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
822ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	wl_cmd->id = key->keyidx;
823ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	wl_cmd->ssid_profile = 0;
8242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
82580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_dump(DEBUG_CRYPT, "TARGET KEY: ", wl_cmd, sizeof(*wl_cmd));
8262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
82780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_cmd_send(wl, CMD_SET_KEYS, wl_cmd, sizeof(*wl_cmd));
828ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	if (ret < 0) {
82980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_warning("could not set keys");
830c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out_sleep;
8312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
8322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
833c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout_sleep:
83480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_ps_elp_sleep(wl);
835c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo
836c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout_unlock:
8372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
838ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo
839ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valoout:
840ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	kfree(wl_cmd);
841ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo
8422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
8432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
8442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
84580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_build_basic_rates(char *rates)
8462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
8472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	u8 index = 0;
8482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_1MB;
8502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_2MB;
8512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_5MB;
8522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_11MB;
8532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return index;
8552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
8562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
85780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_build_extended_rates(char *rates)
8582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
8592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	u8 index = 0;
8602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_6MB;
8622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_9MB;
8632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_12MB;
8642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_18MB;
8652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_24MB;
8662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_36MB;
8672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_48MB;
8682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_54MB;
8692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return index;
8712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
8722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
87480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_build_probe_req(struct wl1251 *wl, u8 *ssid, size_t ssid_len)
8752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
8762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	struct wl12xx_probe_req_template template;
8772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	struct wl12xx_ie_rates *rates;
8782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	char *ptr;
8792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	u16 size;
8802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ptr = (char *)&template;
8822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	size = sizeof(struct ieee80211_header);
8832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memset(template.header.da, 0xff, ETH_ALEN);
8852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memset(template.header.bssid, 0xff, ETH_ALEN);
8862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memcpy(template.header.sa, wl->mac_addr, ETH_ALEN);
8872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	template.header.frame_ctl = cpu_to_le16(IEEE80211_STYPE_PROBE_REQ);
8882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* IEs */
8902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* SSID */
8912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	template.ssid.header.id = WLAN_EID_SSID;
8922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	template.ssid.header.len = ssid_len;
8932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ssid_len && ssid)
8942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memcpy(template.ssid.ssid, ssid, ssid_len);
8952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	size += sizeof(struct wl12xx_ie_header) + ssid_len;
8962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ptr += size;
8972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* Basic Rates */
8992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates = (struct wl12xx_ie_rates *)ptr;
9002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates->header.id = WLAN_EID_SUPP_RATES;
90180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	rates->header.len = wl1251_build_basic_rates(rates->rates);
9022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	size += sizeof(struct wl12xx_ie_header) + rates->header.len;
9032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ptr += sizeof(struct wl12xx_ie_header) + rates->header.len;
9042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* Extended rates */
9062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates = (struct wl12xx_ie_rates *)ptr;
9072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates->header.id = WLAN_EID_EXT_SUPP_RATES;
90880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	rates->header.len = wl1251_build_extended_rates(rates->rates);
9092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	size += sizeof(struct wl12xx_ie_header) + rates->header.len;
9102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
91180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_dump(DEBUG_SCAN, "PROBE REQ: ", &template, size);
9122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
91380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	return wl1251_cmd_template_set(wl, CMD_PROBE_REQ, &template,
9142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				      size);
9152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
9162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
91780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_hw_scan(struct wl1251 *wl, u8 *ssid, size_t len,
9182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			  u8 active_scan, u8 high_prio, u8 num_channels,
9192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			  u8 probe_requests)
9202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
92180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251_cmd_trigger_scan_to *trigger = NULL;
922ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	struct cmd_scan *params = NULL;
9232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int i, ret;
9242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	u16 scan_options = 0;
9252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (wl->scanning)
9272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return -EINVAL;
9282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params = kzalloc(sizeof(*params), GFP_KERNEL);
9302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (!params)
9312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return -ENOMEM;
9322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params->params.rx_config_options = cpu_to_le32(CFG_RX_ALL_GOOD);
9342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params->params.rx_filter_options =
9352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		cpu_to_le32(CFG_RX_PRSP_EN | CFG_RX_MGMT_EN | CFG_RX_BCN_EN);
9362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* High priority scan */
9382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (!active_scan)
9392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		scan_options |= SCAN_PASSIVE;
9402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (high_prio)
9412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		scan_options |= SCAN_PRIORITY_HIGH;
9422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params->params.scan_options = scan_options;
9432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params->params.num_channels = num_channels;
9452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params->params.num_probe_requests = probe_requests;
9462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params->params.tx_rate = cpu_to_le16(1 << 1); /* 2 Mbps */
9472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params->params.tid_trigger = 0;
9482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	for (i = 0; i < num_channels; i++) {
9502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		params->channels[i].min_duration = cpu_to_le32(30000);
9512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		params->channels[i].max_duration = cpu_to_le32(60000);
9522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memset(&params->channels[i].bssid_lsb, 0xff, 4);
9532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memset(&params->channels[i].bssid_msb, 0xff, 2);
9542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		params->channels[i].early_termination = 0;
9552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		params->channels[i].tx_power_att = 0;
9562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		params->channels[i].channel = i + 1;
9572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memset(params->channels[i].pad, 0, 3);
9582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
9592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	for (i = num_channels; i < SCAN_MAX_NUM_OF_CHANNELS; i++)
9612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memset(&params->channels[i], 0,
9622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		       sizeof(struct basic_scan_channel_parameters));
9632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (len && ssid) {
9652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		params->params.ssid_len = len;
9662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memcpy(params->params.ssid, ssid, len);
9672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	} else {
9682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		params->params.ssid_len = 0;
9692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memset(params->params.ssid, 0, 32);
9702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
9712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
97280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_build_probe_req(wl, ssid, len);
9732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0) {
97480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("PROBE request template failed");
9752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
9762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
9772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
978ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	trigger = kzalloc(sizeof(*trigger), GFP_KERNEL);
979ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	if (!trigger)
980ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		goto out;
981ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo
982ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	trigger->timeout = 0;
983ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo
98480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_cmd_send(wl, CMD_TRIGGER_SCAN_TO, trigger,
985ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo			      sizeof(*trigger));
9862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0) {
98780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("trigger scan to failed for hw scan");
9882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
9892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
9902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
99180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_dump(DEBUG_SCAN, "SCAN: ", params, sizeof(*params));
9922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->scanning = true;
9942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
99580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_cmd_send(wl, CMD_SCAN, params, sizeof(*params));
9962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
99780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("SCAN failed");
9982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9990764de64c8628f653c7e8493017d6bd8d43f4e3bBob Copeland	wl1251_mem_read(wl, wl->cmd_box_addr, params, sizeof(*params));
10002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1001ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	if (params->header.status != CMD_STATUS_SUCCESS) {
100280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("TEST command answer error: %d",
1003ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo			     params->header.status);
10042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->scanning = false;
10052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -EIO;
10062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
10072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
10082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout:
10102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	kfree(params);
10112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
10122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
10142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
101580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_hw_scan(struct ieee80211_hw *hw,
10162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     struct cfg80211_scan_request *req)
10172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
101880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
10192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
10202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	u8 *ssid = NULL;
10212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	size_t ssid_len = 0;
10222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
102380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 hw scan");
10242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (req->n_ssids) {
10262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ssid = req->ssids[0].ssid;
10272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ssid_len = req->ssids[0].ssid_len;
10282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
10292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
1031c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo
103280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_ps_elp_wakeup(wl);
1033c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo	if (ret < 0)
1034c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out;
103501d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
103680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_hw_scan(hw->priv, ssid, ssid_len, 1, 0, 13, 3);
103701d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
103880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_ps_elp_sleep(wl);
1039c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo
1040c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout:
10412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
10422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
10442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
10452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
104680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_set_rts_threshold(struct ieee80211_hw *hw, u32 value)
10472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
104880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
10492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
10502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1051cee4fd2712a3db21f432bdff14e59aed160453b2Kalle Valo	mutex_lock(&wl->mutex);
1052cee4fd2712a3db21f432bdff14e59aed160453b2Kalle Valo
105380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_ps_elp_wakeup(wl);
1054c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo	if (ret < 0)
1055c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out;
105601d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
105780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_acx_rts_threshold(wl, (u16) value);
10582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
105980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_warning("wl1251_op_set_rts_threshold failed: %d", ret);
10602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
106180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_ps_elp_sleep(wl);
106201d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
1063c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout:
1064cee4fd2712a3db21f432bdff14e59aed160453b2Kalle Valo	mutex_unlock(&wl->mutex);
1065cee4fd2712a3db21f432bdff14e59aed160453b2Kalle Valo
10662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
10672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
10682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
106980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_op_bss_info_changed(struct ieee80211_hw *hw,
10702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       struct ieee80211_vif *vif,
10712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       struct ieee80211_bss_conf *bss_conf,
10722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       u32 changed)
10732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
107480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	enum wl1251_cmd_ps_mode mode;
107580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
10762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	struct sk_buff *beacon;
10772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
10782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
107980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 bss info changed");
10802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
10822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
108380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_ps_elp_wakeup(wl);
1084c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo	if (ret < 0)
1085c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out;
108601d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
10872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (changed & BSS_CHANGED_ASSOC) {
10882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (bss_conf->assoc) {
1089e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo			wl->beacon_int = bss_conf->beacon_int;
1090e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo			wl->dtim_period = bss_conf->dtim_period;
1091e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo
1092e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo			/* FIXME: call join */
1093e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo
10942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			wl->aid = bss_conf->aid;
10952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
109680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			ret = wl1251_build_ps_poll(wl, wl->aid);
10972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			if (ret < 0)
1098c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo				goto out_sleep;
10992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
110080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			ret = wl1251_acx_aid(wl, wl->aid);
11012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			if (ret < 0)
1102c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo				goto out_sleep;
11032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			/* If we want to go in PSM but we're not there yet */
11052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			if (wl->psm_requested && !wl->psm) {
11062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				mode = STATION_POWER_SAVE_MODE;
110780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo				ret = wl1251_ps_set_mode(wl, mode);
11082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				if (ret < 0)
1109c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo					goto out_sleep;
11102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			}
1111e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo		} else {
1112e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo			/* use defaults when not associated */
1113e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo			wl->beacon_int = WL1251_DEFAULT_BEACON_INT;
1114e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo			wl->dtim_period = WL1251_DEFAULT_DTIM_PERIOD;
11152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		}
11162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
11172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (changed & BSS_CHANGED_ERP_SLOT) {
11182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (bss_conf->use_short_slot)
111980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			ret = wl1251_acx_slot(wl, SLOT_TIME_SHORT);
11202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		else
112180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			ret = wl1251_acx_slot(wl, SLOT_TIME_LONG);
11222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0) {
112380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			wl1251_warning("Set slot time failed %d", ret);
1124c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo			goto out_sleep;
11252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		}
11262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
11272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (changed & BSS_CHANGED_ERP_PREAMBLE) {
11292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (bss_conf->use_short_preamble)
113080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			wl1251_acx_set_preamble(wl, ACX_PREAMBLE_SHORT);
11312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		else
113280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			wl1251_acx_set_preamble(wl, ACX_PREAMBLE_LONG);
11332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
11342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (changed & BSS_CHANGED_ERP_CTS_PROT) {
11362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (bss_conf->use_cts_prot)
113780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			ret = wl1251_acx_cts_protect(wl, CTSPROTECT_ENABLE);
11382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		else
113980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			ret = wl1251_acx_cts_protect(wl, CTSPROTECT_DISABLE);
11402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0) {
114180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			wl1251_warning("Set ctsprotect failed %d", ret);
114280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			goto out;
11432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		}
11442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
11452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (changed & BSS_CHANGED_BSSID) {
11472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memcpy(wl->bssid, bss_conf->bssid, ETH_ALEN);
11482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
114980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_build_null_data(wl);
11502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
11512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
11522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (wl->bss_type != BSS_TYPE_IBSS) {
1154ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo			ret = wl1251_join(wl, wl->bss_type, wl->channel,
1155ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo					  wl->beacon_int, wl->dtim_period);
11562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			if (ret < 0)
115780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo				goto out_sleep;
115880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			wl1251_warning("Set ctsprotect failed %d", ret);
115980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			goto out_sleep;
11602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		}
11612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
11622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (changed & BSS_CHANGED_BEACON) {
11642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		beacon = ieee80211_beacon_get(hw, vif);
116580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_cmd_template_set(wl, CMD_BEACON, beacon->data,
11662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo					      beacon->len);
11672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0) {
11692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			dev_kfree_skb(beacon);
11702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
11712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		}
11722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
117380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_cmd_template_set(wl, CMD_PROBE_RESP, beacon->data,
11742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo					      beacon->len);
11752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		dev_kfree_skb(beacon);
11772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
11792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
11802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1181ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo		ret = wl1251_join(wl, wl->bss_type, wl->beacon_int,
1182ae46ae17d1d8b953eb5859764737c065e4e3c86bKalle Valo				  wl->channel, wl->dtim_period);
11832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
11852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
11862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
11872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1188c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout_sleep:
118980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_ps_elp_sleep(wl);
1190c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo
1191c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout:
11922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
11932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
11942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo/* can't be const, mac80211 writes to this */
119780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic struct ieee80211_rate wl1251_rates[] = {
11982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 10,
11992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x1,
12002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x1, },
12012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 20,
12022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x2,
12032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x2,
12042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .flags = IEEE80211_RATE_SHORT_PREAMBLE },
12052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 55,
12062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x4,
12072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x4,
12082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .flags = IEEE80211_RATE_SHORT_PREAMBLE },
12092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 110,
12102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x20,
12112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x20,
12122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .flags = IEEE80211_RATE_SHORT_PREAMBLE },
12132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 60,
12142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x8,
12152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x8, },
12162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 90,
12172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x10,
12182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x10, },
12192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 120,
12202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x40,
12212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x40, },
12222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 180,
12232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x80,
12242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x80, },
12252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 240,
12262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x200,
12272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x200, },
12282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 360,
12292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 .hw_value = 0x400,
12302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 .hw_value_short = 0x400, },
12312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 480,
12322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x800,
12332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x800, },
12342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 540,
12352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x1000,
12362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x1000, },
12372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo};
12382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo/* can't be const, mac80211 writes to this */
124080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic struct ieee80211_channel wl1251_channels[] = {
12412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 1, .center_freq = 2412},
12422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 2, .center_freq = 2417},
12432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 3, .center_freq = 2422},
12442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 4, .center_freq = 2427},
12452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 5, .center_freq = 2432},
12462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 6, .center_freq = 2437},
12472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 7, .center_freq = 2442},
12482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 8, .center_freq = 2447},
12492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 9, .center_freq = 2452},
12502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 10, .center_freq = 2457},
12512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 11, .center_freq = 2462},
12522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 12, .center_freq = 2467},
12532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 13, .center_freq = 2472},
12542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo};
12552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo/* can't be const, mac80211 writes to this */
125780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic struct ieee80211_supported_band wl1251_band_2ghz = {
125880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.channels = wl1251_channels,
125980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.n_channels = ARRAY_SIZE(wl1251_channels),
126080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.bitrates = wl1251_rates,
126180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.n_bitrates = ARRAY_SIZE(wl1251_rates),
12622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo};
12632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
126480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic const struct ieee80211_ops wl1251_ops = {
126580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.start = wl1251_op_start,
126680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.stop = wl1251_op_stop,
126780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.add_interface = wl1251_op_add_interface,
126880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.remove_interface = wl1251_op_remove_interface,
126980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.config = wl1251_op_config,
127080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.configure_filter = wl1251_op_configure_filter,
127180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.tx = wl1251_op_tx,
127280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.set_key = wl1251_op_set_key,
127380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.hw_scan = wl1251_op_hw_scan,
127480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.bss_info_changed = wl1251_op_bss_info_changed,
127580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.set_rts_threshold = wl1251_op_set_rts_threshold,
12762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo};
12772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
127880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_register_hw(struct wl1251 *wl)
12792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
12802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
12812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (wl->mac80211_registered)
12832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return 0;
12842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	SET_IEEE80211_PERM_ADDR(wl->hw, wl->mac_addr);
12862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ret = ieee80211_register_hw(wl->hw);
12882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0) {
128980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("unable to register mac80211 hw: %d", ret);
12902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return ret;
12912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
12922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->mac80211_registered = true;
12942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
129580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_notice("loaded");
12962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return 0;
12982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
12992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13008e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copelandint wl1251_init_ieee80211(struct wl1251 *wl)
13012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
13028e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland	int ret;
13038e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland
13042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* The tx descriptor buffer and the TKIP space */
13052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->hw->extra_tx_headroom = sizeof(struct tx_double_buffer_desc)
13069f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen		+ WL1251_TKIP_IV_SPACE;
13072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* unit us */
13092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* FIXME: find a proper value */
13102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->hw->channel_change_time = 10000;
13112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->hw->flags = IEEE80211_HW_SIGNAL_DBM |
13132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		IEEE80211_HW_NOISE_DBM;
13142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION);
13162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->hw->wiphy->max_scan_ssids = 1;
131780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->hw->wiphy->bands[IEEE80211_BAND_2GHZ] = &wl1251_band_2ghz;
13182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13198e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland	ret = wl1251_register_hw(wl);
13208e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland	if (ret)
13218e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland		goto out;
13222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13238e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland	wl1251_debugfs_init(wl);
13248e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland	wl1251_notice("initialized");
13252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13268e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland	ret = 0;
13278e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland
13288e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copelandout:
13298e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland	return ret;
13308e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland}
1331af8c78ebbf2a15ecf9b2b6b7b051b0d4c3ba1163Bob CopelandEXPORT_SYMBOL_GPL(wl1251_init_ieee80211);
133208d9f57251841e4870cfd286e867ffcbef81d9a4Bob Copeland
13338e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copelandstruct ieee80211_hw *wl1251_alloc_hw(void)
13342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
13352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	struct ieee80211_hw *hw;
133680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl;
13378e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland	int i;
13382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	static const u8 nokia_oui[3] = {0x00, 0x1f, 0xdf};
13392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
134080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	hw = ieee80211_alloc_hw(sizeof(*wl), &wl1251_ops);
13412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (!hw) {
134280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("could not alloc ieee80211_hw");
13438e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland		return ERR_PTR(-ENOMEM);
13442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
13452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl = hw->priv;
13472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memset(wl, 0, sizeof(*wl));
13482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->hw = hw;
13502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->data_in_count = 0;
13522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	skb_queue_head_init(&wl->tx_queue);
13542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
135580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	INIT_WORK(&wl->filter_work, wl1251_filter_work);
135680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->channel = WL1251_DEFAULT_CHANNEL;
13572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->scanning = false;
13582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->default_key = 0;
13592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->listen_int = 1;
13602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_counter = 0;
13612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_handled = 0;
13622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_current_buffer = 0;
13632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_last_id = 0;
136480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->rx_config = WL1251_DEFAULT_RX_CONFIG;
136580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->rx_filter = WL1251_DEFAULT_RX_FILTER;
13662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->elp = false;
13672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->psm = 0;
13682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->psm_requested = false;
13692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->tx_queue_stopped = false;
137080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->power_level = WL1251_DEFAULT_POWER_LEVEL;
1371e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo	wl->beacon_int = WL1251_DEFAULT_BEACON_INT;
1372e2fd4611d50a1cd13a370f84b672a5f29472ee09Kalle Valo	wl->dtim_period = WL1251_DEFAULT_DTIM_PERIOD;
13732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	for (i = 0; i < FW_TX_CMPLT_BLOCK_SIZE; i++)
13752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->tx_frames[i] = NULL;
13762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->next_tx_complete = 0;
13782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13790e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	INIT_WORK(&wl->irq_work, wl1251_irq_work);
13800e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo	INIT_WORK(&wl->tx_work, wl1251_tx_work);
13810e71bb084adc4986b9a4be3581897f0ee703cbd5Kalle Valo
13822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/*
13832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * In case our MAC address is not correctly set,
13842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * we use a random but Nokia MAC.
13852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 */
13862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memcpy(wl->mac_addr, nokia_oui, 3);
13872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	get_random_bytes(wl->mac_addr + 3, 3);
13882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
138980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->state = WL1251_STATE_OFF;
13902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_init(&wl->mutex);
13912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->tx_mgmt_frm_rate = DEFAULT_HW_GEN_TX_RATE;
13932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->tx_mgmt_frm_mod = DEFAULT_HW_GEN_MODULATION_TYPE;
13942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13954721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo	wl->rx_descriptor = kmalloc(sizeof(*wl->rx_descriptor), GFP_KERNEL);
13964721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo	if (!wl->rx_descriptor) {
139780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("could not allocate memory for rx descriptor");
13988e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland		ieee80211_free_hw(hw);
13998e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland		return ERR_PTR(-ENOMEM);
14004721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo	}
14014721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo
14028e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copeland	return hw;
14032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
1404af8c78ebbf2a15ecf9b2b6b7b051b0d4c3ba1163Bob CopelandEXPORT_SYMBOL_GPL(wl1251_alloc_hw);
14052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
14068e639c0673a9b676bb7c6bd4e50f9003bdda423eBob Copelandint wl1251_free_hw(struct wl1251 *wl)
14072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
14082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ieee80211_unregister_hw(wl->hw);
14092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
141080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debugfs_exit(wl);
14112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
14122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	kfree(wl->target_mem_map);
14132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	kfree(wl->data_path);
14142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	kfree(wl->fw);
14152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->fw = NULL;
14162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	kfree(wl->nvs);
14172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->nvs = NULL;
14184721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo
14194721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo	kfree(wl->rx_descriptor);
14204721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo	wl->rx_descriptor = NULL;
14214721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo
14222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ieee80211_free_hw(wl->hw);
14232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
14242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return 0;
14252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
1426af8c78ebbf2a15ecf9b2b6b7b051b0d4c3ba1163Bob CopelandEXPORT_SYMBOL_GPL(wl1251_free_hw);
1427af8c78ebbf2a15ecf9b2b6b7b051b0d4c3ba1163Bob Copeland
1428af8c78ebbf2a15ecf9b2b6b7b051b0d4c3ba1163Bob CopelandMODULE_DESCRIPTION("TI wl1251 Wireles LAN Driver Core");
1429af8c78ebbf2a15ecf9b2b6b7b051b0d4c3ba1163Bob CopelandMODULE_LICENSE("GPL");
1430af8c78ebbf2a15ecf9b2b6b7b051b0d4c3ba1163Bob CopelandMODULE_AUTHOR("Kalle Valo <Kalle.Valo@nokia.com>");
1431af8c78ebbf2a15ecf9b2b6b7b051b0d4c3ba1163Bob CopelandMODULE_AUTHOR("Luciano Coelho <luciano.coelho@nokia.com>");
1432