main.c revision 08d9f57251841e4870cfd286e867ffcbef81d9a4
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/spi/spi.h>
302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo#include <linux/crc32.h>
312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo#include <linux/etherdevice.h>
322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo#include <linux/spi/wl12xx.h>
332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
341367411858d5fc60b632a3f488f2b4adc73d12d7Kalle Valo#include "wl1251.h"
352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo#include "wl12xx_80211.h"
362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo#include "reg.h"
37e6f0b5c2993609c576a0c45e86f7e5b6dd0ae421Kalle Valo#include "wl1251_ops.h"
380764de64c8628f653c7e8493017d6bd8d43f4e3bBob Copeland#include "wl1251_io.h"
39ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_spi.h"
40ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_event.h"
419f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen#include "wl1251_tx.h"
42ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_rx.h"
43ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_ps.h"
44ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_init.h"
45ef2f8d45771490de5b8373c25e983ee1e3aee9eaKalle Valo#include "wl1251_debugfs.h"
462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_disable_interrupts(struct wl1251 *wl)
482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	disable_irq(wl->irq);
502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_power_off(struct wl1251 *wl)
532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->set_power(false);
552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_power_on(struct wl1251 *wl)
582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->set_power(true);
602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic irqreturn_t wl1251_irq(int irq, void *cookie)
632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
6480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl;
652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_IRQ, "IRQ");
672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl = cookie;
692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	schedule_work(&wl->irq_work);
712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return IRQ_HANDLED;
732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_fetch_firmware(struct wl1251 *wl)
762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	const struct firmware *fw;
786c766f413c81d5a11588552934fa093eab6ae06eBob Copeland	struct device *dev = wiphy_dev(wl->hw->wiphy);
792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
816c766f413c81d5a11588552934fa093eab6ae06eBob Copeland	ret = request_firmware(&fw, wl->chip.fw_filename, dev);
822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0) {
8480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("could not get firmware: %d", ret);
852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return ret;
862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (fw->size % 4) {
8980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("firmware size is not multiple of 32 bits: %zu",
902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     fw->size);
912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -EILSEQ;
922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->fw_len = fw->size;
962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->fw = kmalloc(wl->fw_len, GFP_KERNEL);
972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (!wl->fw) {
9980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("could not allocate memory for the firmware");
1002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -ENOMEM;
1012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
1022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
1032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memcpy(wl->fw, fw->data, wl->fw_len);
1052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ret = 0;
1072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout:
1092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	release_firmware(fw);
1102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
1122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
1132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_fetch_nvs(struct wl1251 *wl)
1152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
1162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	const struct firmware *fw;
1176c766f413c81d5a11588552934fa093eab6ae06eBob Copeland	struct device *dev = wiphy_dev(wl->hw->wiphy);
1182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
1192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1206c766f413c81d5a11588552934fa093eab6ae06eBob Copeland	ret = request_firmware(&fw, wl->chip.nvs_filename, dev);
1212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0) {
12380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("could not get nvs file: %d", ret);
1242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return ret;
1252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
1262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (fw->size % 4) {
12880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("nvs size is not multiple of 32 bits: %zu",
1292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     fw->size);
1302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -EILSEQ;
1312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
1322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
1332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->nvs_len = fw->size;
1352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->nvs = kmalloc(wl->nvs_len, GFP_KERNEL);
1362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (!wl->nvs) {
13880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("could not allocate memory for the nvs file");
1392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -ENOMEM;
1402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
1412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
1422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memcpy(wl->nvs, fw->data, wl->nvs_len);
1442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ret = 0;
1462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout:
1482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	release_firmware(fw);
1492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
1512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
1522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
15380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_fw_wakeup(struct wl1251 *wl)
1542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
1552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	u32 elp_reg;
1562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	elp_reg = ELPCTRL_WAKE_UP;
15880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_write32(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, elp_reg);
15980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	elp_reg = wl1251_read32(wl, HW_ACCESS_ELP_CTRL_REG_ADDR);
1602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
16105fac682c2ca0c572d1bd8e6a38025838ddf0e68Kalle Valo	if (!(elp_reg & ELPCTRL_WLAN_READY))
16280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_warning("WLAN not ready");
1632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
1642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
16580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_chip_wakeup(struct wl1251 *wl)
1662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
1672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret = 0;
1682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
16980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_power_on(wl);
1702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	msleep(wl->chip.power_on_sleep);
17108d9f57251841e4870cfd286e867ffcbef81d9a4Bob Copeland	wl->if_ops->reset(wl);
1722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* We don't need a real memory partition here, because we only want
1742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * to use the registers at this point. */
17580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_set_partition(wl,
1762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     0x00000000,
1772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     0x00000000,
1782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     REGISTERS_BASE,
1792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     REGISTERS_DOWN_SIZE);
1802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* ELP module wake up */
18280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_fw_wakeup(wl);
1832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* whal_FwCtrl_BootSm() */
1852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* 0. read chip id from CHIP_ID */
18780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->chip.id = wl1251_reg_read32(wl, CHIP_ID_B);
1882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* 1. check if chip id is valid */
1902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	switch (wl->chip.id) {
1922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case CHIP_ID_1251_PG12:
19380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_debug(DEBUG_BOOT, "chip id 0x%x (1251 PG12)",
1942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     wl->chip.id);
1952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl1251_setup(wl);
1972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
1992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case CHIP_ID_1251_PG10:
2002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case CHIP_ID_1251_PG11:
2012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	default:
20280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("unsupported chip id: 0x%x", wl->chip.id);
2032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -ENODEV;
2042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
2052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
2062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
2072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (wl->fw == NULL) {
20880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_fetch_firmware(wl);
2092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
2102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
2112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
2122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
2132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* No NVS from netlink, try to get it from the filesystem */
2142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (wl->nvs == NULL) {
21580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_fetch_nvs(wl);
2162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
2172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
2182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
2192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
2202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout:
2212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
2222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
2232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
22480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_filter_work(struct work_struct *work)
2252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
22680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl =
22780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		container_of(work, struct wl1251, filter_work);
2282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
2292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
2302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
2312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
23280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	if (wl->state == WL1251_STATE_OFF)
2332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
2342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
23580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_ps_elp_wakeup(wl);
236c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo	if (ret < 0)
237c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out;
23801d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
23977cc9e43cee58303893f3a4fb8eaa2a3288c9c17Juuso Oikarinen	/* FIXME: replace the magic numbers with proper definitions */
24077cc9e43cee58303893f3a4fb8eaa2a3288c9c17Juuso Oikarinen	ret = wl->chip.op_cmd_join(wl, wl->bss_type, 1, 100, 0);
2412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
242c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out_sleep;
2432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
244c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout_sleep:
24580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_ps_elp_sleep(wl);
246c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo
247c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout:
2482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
2492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
2502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
25180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_tx(struct ieee80211_hw *hw, struct sk_buff *skb)
2522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
25380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
2542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
2552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	skb_queue_tail(&wl->tx_queue, skb);
2562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
2579f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen	/*
2589f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen	 * The chip specific setup must run before the first TX packet -
2599f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen	 * before that, the tx_work will not be initialized!
2609f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen	 */
2619f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen
2622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	schedule_work(&wl->tx_work);
2632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
2642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/*
2652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * The workqueue is slow to process the tx_queue and we need stop
2662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * the queue here, otherwise the queue will get too long.
2672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 */
26880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	if (skb_queue_len(&wl->tx_queue) >= WL1251_TX_QUEUE_MAX_LENGTH) {
2692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ieee80211_stop_queues(wl->hw);
2702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
2712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		/*
2722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * FIXME: this is racy, the variable is not properly
2732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * protected. Maybe fix this by removing the stupid
2742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * variable altogether and checking the real queue state?
2752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 */
2762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->tx_queue_stopped = true;
2772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
2782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
2792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return NETDEV_TX_OK;
2802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
2812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
28280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_start(struct ieee80211_hw *hw)
2832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
28480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
2852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret = 0;
2862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
28780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 start");
2882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
2892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
2902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
29180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	if (wl->state != WL1251_STATE_OFF) {
29280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("cannot start because not in off state: %d",
2932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     wl->state);
2942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -EBUSY;
2952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
2962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
2972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
29880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_chip_wakeup(wl);
2992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
300fe643414dbf330d6d910e01edd48dd93dc6f2942Jiri Slaby		goto out;
3012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ret = wl->chip.op_boot(wl);
3032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
3042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
3052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ret = wl->chip.op_hw_init(wl);
3072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
3082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
3092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
31080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_acx_station_id(wl);
3112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
3122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
3132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
31480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->state = WL1251_STATE_ON;
3152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
31680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_info("firmware booted (%s)", wl->chip.fw_ver);
3172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout:
3192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
32080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_power_off(wl);
3212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
3232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
3252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
3262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
32780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_op_stop(struct ieee80211_hw *hw)
3282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
32980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
3302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
33180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_info("down");
3322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
33380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 stop");
3342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
3362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
33780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	WARN_ON(wl->state != WL1251_STATE_ON);
3382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (wl->scanning) {
3402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		mutex_unlock(&wl->mutex);
3412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ieee80211_scan_completed(wl->hw, true);
3422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		mutex_lock(&wl->mutex);
3432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->scanning = false;
3442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
3452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
34680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->state = WL1251_STATE_OFF;
3472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
34880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_disable_interrupts(wl);
3492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
3512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	cancel_work_sync(&wl->irq_work);
3532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	cancel_work_sync(&wl->tx_work);
3542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	cancel_work_sync(&wl->filter_work);
3552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
3572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* let's notify MAC80211 about the remaining pending TX frames */
3599f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen	wl->chip.op_tx_flush(wl);
36080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_power_off(wl);
3612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memset(wl->bssid, 0, ETH_ALEN);
3632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->listen_int = 1;
3642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->bss_type = MAX_BSS_TYPE;
3652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->data_in_count = 0;
3672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_counter = 0;
3682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_handled = 0;
3692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_current_buffer = 0;
3702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_last_id = 0;
3712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->next_tx_complete = 0;
3722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->elp = false;
3732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->psm = 0;
3742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->tx_queue_stopped = false;
37580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->power_level = WL1251_DEFAULT_POWER_LEVEL;
3762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
37780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debugfs_reset(wl);
3782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
3802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
3812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
38280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_add_interface(struct ieee80211_hw *hw,
3832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				   struct ieee80211_if_init_conf *conf)
3842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
38580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
3862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret = 0;
3872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
388e91d83346ad9b30f44469c92b982206dcd7dcaf0Johannes Berg	wl1251_debug(DEBUG_MAC80211, "mac80211 add interface type %d mac %pM",
389e91d83346ad9b30f44469c92b982206dcd7dcaf0Johannes Berg		     conf->type, conf->mac_addr);
3902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
3922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
3932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	switch (conf->type) {
3942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case NL80211_IFTYPE_STATION:
3952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->bss_type = BSS_TYPE_STA_BSS;
3962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
3972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case NL80211_IFTYPE_ADHOC:
3982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->bss_type = BSS_TYPE_IBSS;
3992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
4002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	default:
4012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -EOPNOTSUPP;
4022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
4032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
4042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (memcmp(wl->mac_addr, conf->mac_addr, ETH_ALEN)) {
4062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memcpy(wl->mac_addr, conf->mac_addr, ETH_ALEN);
4072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		SET_IEEE80211_PERM_ADDR(wl->hw, wl->mac_addr);
40880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_acx_station_id(wl);
4092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
4102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
4112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
4122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout:
4142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
4152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
4162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
4172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
41880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_op_remove_interface(struct ieee80211_hw *hw,
4192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo					 struct ieee80211_if_init_conf *conf)
4202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
42180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 remove interface");
4222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
4232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
42480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_build_null_data(struct wl1251 *wl)
4252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
4262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	struct wl12xx_null_data_template template;
4272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (!is_zero_ether_addr(wl->bssid)) {
4292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memcpy(template.header.da, wl->bssid, ETH_ALEN);
4302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memcpy(template.header.bssid, wl->bssid, ETH_ALEN);
4312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	} else {
4322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memset(template.header.da, 0xff, ETH_ALEN);
4332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memset(template.header.bssid, 0xff, ETH_ALEN);
4342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
4352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memcpy(template.header.sa, wl->mac_addr, ETH_ALEN);
4372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	template.header.frame_ctl = cpu_to_le16(IEEE80211_FTYPE_DATA |
4382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo						IEEE80211_STYPE_NULLFUNC);
4392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
44080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	return wl1251_cmd_template_set(wl, CMD_NULL_DATA, &template,
4412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       sizeof(template));
4422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
4442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
44580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_build_ps_poll(struct wl1251 *wl, u16 aid)
4462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
4472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	struct wl12xx_ps_poll_template template;
4482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memcpy(template.bssid, wl->bssid, ETH_ALEN);
4502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memcpy(template.ta, wl->mac_addr, ETH_ALEN);
4512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	template.aid = aid;
4522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	template.fc = cpu_to_le16(IEEE80211_FTYPE_CTL | IEEE80211_STYPE_PSPOLL);
4532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
45480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	return wl1251_cmd_template_set(wl, CMD_PS_POLL, &template,
4552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       sizeof(template));
4562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
4582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
45980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_config(struct ieee80211_hw *hw, u32 changed)
4602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
46180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
4622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	struct ieee80211_conf *conf = &hw->conf;
4632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int channel, ret = 0;
4642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	channel = ieee80211_frequency_to_channel(conf->channel->center_freq);
4662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
46780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 config ch %d psm %s power %d",
4682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		     channel,
4692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		     conf->flags & IEEE80211_CONF_PS ? "on" : "off",
4702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		     conf->power_level);
4712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
4732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
47480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_ps_elp_wakeup(wl);
475c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo	if (ret < 0)
476c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out;
47701d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
4782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (channel != wl->channel) {
4792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		/* FIXME: use beacon interval provided by mac80211 */
48077cc9e43cee58303893f3a4fb8eaa2a3288c9c17Juuso Oikarinen		ret = wl->chip.op_cmd_join(wl, wl->bss_type, 1, 100, 0);
4812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
482c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo			goto out_sleep;
4832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->channel = channel;
4852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
4862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
48780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_build_null_data(wl);
4882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
489c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out_sleep;
4902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (conf->flags & IEEE80211_CONF_PS && !wl->psm_requested) {
49247af3fe36dc478f7eddc8bec104ff1876d71f37cLuciano Coelho		wl1251_debug(DEBUG_PSM, "psm enabled");
4932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->psm_requested = true;
4952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
4962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		/*
4972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * We enter PSM only if we're already associated.
4982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * If we're not, we'll enter it when joining an SSID,
4992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * through the bss_info_changed() hook.
5002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 */
50180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_ps_set_mode(wl, STATION_POWER_SAVE_MODE);
5022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	} else if (!(conf->flags & IEEE80211_CONF_PS) &&
5032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		   wl->psm_requested) {
50447af3fe36dc478f7eddc8bec104ff1876d71f37cLuciano Coelho		wl1251_debug(DEBUG_PSM, "psm disabled");
5052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->psm_requested = false;
5072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (wl->psm)
50980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			ret = wl1251_ps_set_mode(wl, STATION_ACTIVE_MODE);
5102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
5112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (conf->power_level != wl->power_level) {
51380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_acx_tx_power(wl, conf->power_level);
5142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
5152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
5162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->power_level = conf->power_level;
5182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
5192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
520c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout_sleep:
52180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_ps_elp_sleep(wl);
522c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo
523c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout:
5242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
525c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo
5262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
5272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
5282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
52980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo#define WL1251_SUPPORTED_FILTERS (FIF_PROMISC_IN_BSS | \
5302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				  FIF_ALLMULTI | \
5312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				  FIF_FCSFAIL | \
5322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				  FIF_BCN_PRBRESP_PROMISC | \
5332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				  FIF_CONTROL | \
5342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				  FIF_OTHER_BSS)
5352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
53680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_op_configure_filter(struct ieee80211_hw *hw,
5372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       unsigned int changed,
5382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       unsigned int *total,
5392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       int mc_count,
5402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       struct dev_addr_list *mc_list)
5412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
54280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
5432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
54480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 configure filter");
5452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
54680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	*total &= WL1251_SUPPORTED_FILTERS;
54780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	changed &= WL1251_SUPPORTED_FILTERS;
5482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (changed == 0)
5502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		/* no filters which we support changed */
5512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return;
5522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* FIXME: wl->rx_config and wl->rx_filter are not protected */
5542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
55580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->rx_config = WL1251_DEFAULT_RX_CONFIG;
55680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->rx_filter = WL1251_DEFAULT_RX_FILTER;
5572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (*total & FIF_PROMISC_IN_BSS) {
5592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_config |= CFG_BSSID_FILTER_EN;
5602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_config |= CFG_RX_ALL_GOOD;
5612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
5622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (*total & FIF_ALLMULTI)
5632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		/*
5642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * CFG_MC_FILTER_EN in rx_config needs to be 0 to receive
5652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * all multicast frames
5662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 */
5672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_config &= ~CFG_MC_FILTER_EN;
5682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (*total & FIF_FCSFAIL)
5692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_filter |= CFG_RX_FCS_ERROR;
5702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (*total & FIF_BCN_PRBRESP_PROMISC) {
5712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_config &= ~CFG_BSSID_FILTER_EN;
5722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_config &= ~CFG_SSID_FILTER_EN;
5732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
5742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (*total & FIF_CONTROL)
5752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_filter |= CFG_RX_CTL_EN;
5762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (*total & FIF_OTHER_BSS)
5772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->rx_filter &= ~CFG_BSSID_FILTER_EN;
5782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/*
5802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * FIXME: workqueues need to be properly cancelled on stop(), for
5812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * now let's just disable changing the filter settings. They will
5822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * be updated any on config().
5832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 */
5842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* schedule_work(&wl->filter_work); */
5852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
5862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
5872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo/* HW encryption */
58880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_set_key_type(struct wl1251 *wl,
58980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			       struct wl1251_cmd_set_keys *key,
5902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			       enum set_key_cmd cmd,
5912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			       struct ieee80211_key_conf *mac80211_key,
5922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			       const u8 *addr)
5932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
5942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	switch (mac80211_key->alg) {
5952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case ALG_WEP:
5962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (is_broadcast_ether_addr(addr))
5972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			key->key_type = KEY_WEP_DEFAULT;
5982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		else
5992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			key->key_type = KEY_WEP_ADDR;
6002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		mac80211_key->hw_key_idx = mac80211_key->keyidx;
6022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
6032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case ALG_TKIP:
6042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (is_broadcast_ether_addr(addr))
6052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			key->key_type = KEY_TKIP_MIC_GROUP;
6062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		else
6072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			key->key_type = KEY_TKIP_MIC_PAIRWISE;
6082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		mac80211_key->hw_key_idx = mac80211_key->keyidx;
6102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
6112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case ALG_CCMP:
6122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (is_broadcast_ether_addr(addr))
6132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			key->key_type = KEY_AES_GROUP;
6142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		else
6152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			key->key_type = KEY_AES_PAIRWISE;
6162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		mac80211_key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
6172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
6182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	default:
61980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("Unknown key algo 0x%x", mac80211_key->alg);
6202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return -EOPNOTSUPP;
6212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
6222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return 0;
6242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
6252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
62680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
6272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     struct ieee80211_vif *vif,
6282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     struct ieee80211_sta *sta,
6292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     struct ieee80211_key_conf *key)
6302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
63180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
63280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251_cmd_set_keys *wl_cmd;
6332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	const u8 *addr;
6342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
6352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	static const u8 bcast_addr[ETH_ALEN] =
6372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		{ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
6382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
63980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 set key");
6402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
641ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	wl_cmd = kzalloc(sizeof(*wl_cmd), GFP_KERNEL);
642ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	if (!wl_cmd) {
643ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		ret = -ENOMEM;
644ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		goto out;
645ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	}
6462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
6472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	addr = sta ? sta->addr : bcast_addr;
6482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
64980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_CRYPT, "CMD: 0x%x", cmd);
65080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_dump(DEBUG_CRYPT, "ADDR: ", addr, ETH_ALEN);
65180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_CRYPT, "Key: algo:0x%x, id:%d, len:%d flags 0x%x",
6522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		     key->alg, key->keyidx, key->keylen, key->flags);
65380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_dump(DEBUG_CRYPT, "KEY: ", key->key, key->keylen);
6542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
655ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	if (is_zero_ether_addr(addr)) {
656ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		/* We dont support TX only encryption */
657ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		ret = -EOPNOTSUPP;
658ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		goto out;
659ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	}
660ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo
6612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
6622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
66380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_ps_elp_wakeup(wl);
664c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo	if (ret < 0)
665c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out_unlock;
66601d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
6672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	switch (cmd) {
6682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case SET_KEY:
669ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		wl_cmd->key_action = KEY_ADD_OR_REPLACE;
6702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
6712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	case DISABLE_KEY:
672ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		wl_cmd->key_action = KEY_REMOVE;
6732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
6742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	default:
67580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("Unsupported key cmd 0x%x", cmd);
6762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		break;
6772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
6782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
67980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_set_key_type(wl, wl_cmd, cmd, key, addr);
6802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0) {
68180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("Set KEY type failed");
682c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out_sleep;
6832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
6842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
685ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	if (wl_cmd->key_type != KEY_WEP_DEFAULT)
686ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		memcpy(wl_cmd->addr, addr, ETH_ALEN);
6872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
688ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	if ((wl_cmd->key_type == KEY_TKIP_MIC_GROUP) ||
689ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	    (wl_cmd->key_type == KEY_TKIP_MIC_PAIRWISE)) {
6902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		/*
6912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * We get the key in the following form:
6922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * TKIP (16 bytes) - TX MIC (8 bytes) - RX MIC (8 bytes)
6932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * but the target is expecting:
6942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 * TKIP - RX MIC - TX MIC
6952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		 */
696ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		memcpy(wl_cmd->key, key->key, 16);
697ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		memcpy(wl_cmd->key + 16, key->key + 24, 8);
698ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		memcpy(wl_cmd->key + 24, key->key + 16, 8);
6992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	} else {
701ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		memcpy(wl_cmd->key, key->key, key->keylen);
7022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
703ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	wl_cmd->key_size = key->keylen;
7042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
705ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	wl_cmd->id = key->keyidx;
706ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	wl_cmd->ssid_profile = 0;
7072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
70880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_dump(DEBUG_CRYPT, "TARGET KEY: ", wl_cmd, sizeof(*wl_cmd));
7092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
71080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_cmd_send(wl, CMD_SET_KEYS, wl_cmd, sizeof(*wl_cmd));
711ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	if (ret < 0) {
71280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_warning("could not set keys");
713c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out_sleep;
7142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
7152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
716c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout_sleep:
71780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_ps_elp_sleep(wl);
718c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo
719c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout_unlock:
7202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
721ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo
722ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valoout:
723ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	kfree(wl_cmd);
724ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo
7252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
7262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
7272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
72880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_build_basic_rates(char *rates)
7292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
7302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	u8 index = 0;
7312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_1MB;
7332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_2MB;
7342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_5MB;
7352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_11MB;
7362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return index;
7382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
7392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
74080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_build_extended_rates(char *rates)
7412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
7422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	u8 index = 0;
7432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_6MB;
7452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_9MB;
7462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_12MB;
7472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_18MB;
7482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_24MB;
7492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_36MB;
7502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_48MB;
7512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates[index++] = IEEE80211_OFDM_RATE_54MB;
7522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return index;
7542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
7552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
75780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_build_probe_req(struct wl1251 *wl, u8 *ssid, size_t ssid_len)
7582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
7592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	struct wl12xx_probe_req_template template;
7602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	struct wl12xx_ie_rates *rates;
7612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	char *ptr;
7622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	u16 size;
7632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ptr = (char *)&template;
7652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	size = sizeof(struct ieee80211_header);
7662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memset(template.header.da, 0xff, ETH_ALEN);
7682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memset(template.header.bssid, 0xff, ETH_ALEN);
7692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memcpy(template.header.sa, wl->mac_addr, ETH_ALEN);
7702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	template.header.frame_ctl = cpu_to_le16(IEEE80211_STYPE_PROBE_REQ);
7712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* IEs */
7732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* SSID */
7742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	template.ssid.header.id = WLAN_EID_SSID;
7752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	template.ssid.header.len = ssid_len;
7762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ssid_len && ssid)
7772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memcpy(template.ssid.ssid, ssid, ssid_len);
7782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	size += sizeof(struct wl12xx_ie_header) + ssid_len;
7792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ptr += size;
7802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* Basic Rates */
7822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates = (struct wl12xx_ie_rates *)ptr;
7832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates->header.id = WLAN_EID_SUPP_RATES;
78480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	rates->header.len = wl1251_build_basic_rates(rates->rates);
7852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	size += sizeof(struct wl12xx_ie_header) + rates->header.len;
7862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ptr += sizeof(struct wl12xx_ie_header) + rates->header.len;
7872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
7882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* Extended rates */
7892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates = (struct wl12xx_ie_rates *)ptr;
7902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	rates->header.id = WLAN_EID_EXT_SUPP_RATES;
79180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	rates->header.len = wl1251_build_extended_rates(rates->rates);
7922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	size += sizeof(struct wl12xx_ie_header) + rates->header.len;
7932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
79480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_dump(DEBUG_SCAN, "PROBE REQ: ", &template, size);
7952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
79680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	return wl1251_cmd_template_set(wl, CMD_PROBE_REQ, &template,
7972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				      size);
7982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
7992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
80080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_hw_scan(struct wl1251 *wl, u8 *ssid, size_t len,
8012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			  u8 active_scan, u8 high_prio, u8 num_channels,
8022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			  u8 probe_requests)
8032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
80480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251_cmd_trigger_scan_to *trigger = NULL;
805ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	struct cmd_scan *params = NULL;
8062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int i, ret;
8072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	u16 scan_options = 0;
8082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (wl->scanning)
8102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return -EINVAL;
8112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params = kzalloc(sizeof(*params), GFP_KERNEL);
8132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (!params)
8142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return -ENOMEM;
8152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params->params.rx_config_options = cpu_to_le32(CFG_RX_ALL_GOOD);
8172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params->params.rx_filter_options =
8182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		cpu_to_le32(CFG_RX_PRSP_EN | CFG_RX_MGMT_EN | CFG_RX_BCN_EN);
8192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* High priority scan */
8212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (!active_scan)
8222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		scan_options |= SCAN_PASSIVE;
8232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (high_prio)
8242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		scan_options |= SCAN_PRIORITY_HIGH;
8252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params->params.scan_options = scan_options;
8262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params->params.num_channels = num_channels;
8282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params->params.num_probe_requests = probe_requests;
8292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params->params.tx_rate = cpu_to_le16(1 << 1); /* 2 Mbps */
8302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	params->params.tid_trigger = 0;
8312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	for (i = 0; i < num_channels; i++) {
8332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		params->channels[i].min_duration = cpu_to_le32(30000);
8342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		params->channels[i].max_duration = cpu_to_le32(60000);
8352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memset(&params->channels[i].bssid_lsb, 0xff, 4);
8362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memset(&params->channels[i].bssid_msb, 0xff, 2);
8372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		params->channels[i].early_termination = 0;
8382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		params->channels[i].tx_power_att = 0;
8392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		params->channels[i].channel = i + 1;
8402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memset(params->channels[i].pad, 0, 3);
8412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
8422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	for (i = num_channels; i < SCAN_MAX_NUM_OF_CHANNELS; i++)
8442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memset(&params->channels[i], 0,
8452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		       sizeof(struct basic_scan_channel_parameters));
8462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (len && ssid) {
8482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		params->params.ssid_len = len;
8492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memcpy(params->params.ssid, ssid, len);
8502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	} else {
8512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		params->params.ssid_len = 0;
8522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memset(params->params.ssid, 0, 32);
8532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
8542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
85580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_build_probe_req(wl, ssid, len);
8562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0) {
85780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("PROBE request template failed");
8582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
8592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
8602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
861ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	trigger = kzalloc(sizeof(*trigger), GFP_KERNEL);
862ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	if (!trigger)
863ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo		goto out;
864ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo
865ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	trigger->timeout = 0;
866ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo
86780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_cmd_send(wl, CMD_TRIGGER_SCAN_TO, trigger,
868ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo			      sizeof(*trigger));
8692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0) {
87080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("trigger scan to failed for hw scan");
8712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
8722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
8732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
87480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_dump(DEBUG_SCAN, "SCAN: ", params, sizeof(*params));
8752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->scanning = true;
8772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
87880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_cmd_send(wl, CMD_SCAN, params, sizeof(*params));
8792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
88080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("SCAN failed");
8812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8820764de64c8628f653c7e8493017d6bd8d43f4e3bBob Copeland	wl1251_mem_read(wl, wl->cmd_box_addr, params, sizeof(*params));
8832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
884ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo	if (params->header.status != CMD_STATUS_SUCCESS) {
88580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("TEST command answer error: %d",
886ff25839bf0c99e828c26864a24417a36a6b6a31eKalle Valo			     params->header.status);
8872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->scanning = false;
8882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ret = -EIO;
8892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
8902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
8912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout:
8932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	kfree(params);
8942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
8952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
8962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
8972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
89880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_hw_scan(struct ieee80211_hw *hw,
8992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			     struct cfg80211_scan_request *req)
9002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
90180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
9022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
9032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	u8 *ssid = NULL;
9042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	size_t ssid_len = 0;
9052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
90680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 hw scan");
9072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (req->n_ssids) {
9092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ssid = req->ssids[0].ssid;
9102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		ssid_len = req->ssids[0].ssid_len;
9112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
9122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
914c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo
91580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_ps_elp_wakeup(wl);
916c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo	if (ret < 0)
917c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out;
91801d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
91980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_hw_scan(hw->priv, ssid, ssid_len, 1, 0, 13, 3);
92001d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
92180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_ps_elp_sleep(wl);
922c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo
923c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout:
9242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
9252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
9272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
9282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
92980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_op_set_rts_threshold(struct ieee80211_hw *hw, u32 value)
9302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
93180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
9322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
9332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
934cee4fd2712a3db21f432bdff14e59aed160453b2Kalle Valo	mutex_lock(&wl->mutex);
935cee4fd2712a3db21f432bdff14e59aed160453b2Kalle Valo
93680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_ps_elp_wakeup(wl);
937c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo	if (ret < 0)
938c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out;
93901d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
94080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_acx_rts_threshold(wl, (u16) value);
9412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0)
94280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_warning("wl1251_op_set_rts_threshold failed: %d", ret);
9432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
94480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_ps_elp_sleep(wl);
94501d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
946c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout:
947cee4fd2712a3db21f432bdff14e59aed160453b2Kalle Valo	mutex_unlock(&wl->mutex);
948cee4fd2712a3db21f432bdff14e59aed160453b2Kalle Valo
9492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
9502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
9512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
95280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void wl1251_op_bss_info_changed(struct ieee80211_hw *hw,
9532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       struct ieee80211_vif *vif,
9542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       struct ieee80211_bss_conf *bss_conf,
9552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				       u32 changed)
9562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
95780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	enum wl1251_cmd_ps_mode mode;
95880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = hw->priv;
9592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	struct sk_buff *beacon;
9602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
9612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
96280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debug(DEBUG_MAC80211, "mac80211 bss info changed");
9632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_lock(&wl->mutex);
9652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
96680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_ps_elp_wakeup(wl);
967c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo	if (ret < 0)
968c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo		goto out;
96901d9cfbdaadc64a46b57437c989bbad241074135Kalle Valo
9702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (changed & BSS_CHANGED_ASSOC) {
9712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (bss_conf->assoc) {
9722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			wl->aid = bss_conf->aid;
9732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
97480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			ret = wl1251_build_ps_poll(wl, wl->aid);
9752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			if (ret < 0)
976c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo				goto out_sleep;
9772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
97880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			ret = wl1251_acx_aid(wl, wl->aid);
9792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			if (ret < 0)
980c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo				goto out_sleep;
9812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
9822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			/* If we want to go in PSM but we're not there yet */
9832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			if (wl->psm_requested && !wl->psm) {
9842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				mode = STATION_POWER_SAVE_MODE;
98580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo				ret = wl1251_ps_set_mode(wl, mode);
9862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo				if (ret < 0)
987c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo					goto out_sleep;
9882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			}
9892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		}
9902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
9912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (changed & BSS_CHANGED_ERP_SLOT) {
9922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (bss_conf->use_short_slot)
99380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			ret = wl1251_acx_slot(wl, SLOT_TIME_SHORT);
9942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		else
99580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			ret = wl1251_acx_slot(wl, SLOT_TIME_LONG);
9962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0) {
99780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			wl1251_warning("Set slot time failed %d", ret);
998c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo			goto out_sleep;
9992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		}
10002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
10012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (changed & BSS_CHANGED_ERP_PREAMBLE) {
10032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (bss_conf->use_short_preamble)
100480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			wl1251_acx_set_preamble(wl, ACX_PREAMBLE_SHORT);
10052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		else
100680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			wl1251_acx_set_preamble(wl, ACX_PREAMBLE_LONG);
10072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
10082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (changed & BSS_CHANGED_ERP_CTS_PROT) {
10102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (bss_conf->use_cts_prot)
101180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			ret = wl1251_acx_cts_protect(wl, CTSPROTECT_ENABLE);
10122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		else
101380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			ret = wl1251_acx_cts_protect(wl, CTSPROTECT_DISABLE);
10142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0) {
101580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			wl1251_warning("Set ctsprotect failed %d", ret);
101680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			goto out;
10172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		}
10182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
10192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (changed & BSS_CHANGED_BSSID) {
10212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		memcpy(wl->bssid, bss_conf->bssid, ETH_ALEN);
10222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
102380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_build_null_data(wl);
10242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
10252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
10262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (wl->bss_type != BSS_TYPE_IBSS) {
102880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			ret = wl1251_cmd_join(wl, wl->bss_type, 5, 100, 1);
10292f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			if (ret < 0)
103080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo				goto out_sleep;
103180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			wl1251_warning("Set ctsprotect failed %d", ret);
103280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo			goto out_sleep;
10332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		}
10342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
10352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (changed & BSS_CHANGED_BEACON) {
10372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		beacon = ieee80211_beacon_get(hw, vif);
103880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_cmd_template_set(wl, CMD_BEACON, beacon->data,
10392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo					      beacon->len);
10402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0) {
10422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			dev_kfree_skb(beacon);
10432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
10442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		}
10452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
104680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		ret = wl1251_cmd_template_set(wl, CMD_PROBE_RESP, beacon->data,
10472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo					      beacon->len);
10482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		dev_kfree_skb(beacon);
10502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
10522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
10532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
105477cc9e43cee58303893f3a4fb8eaa2a3288c9c17Juuso Oikarinen		ret = wl->chip.op_cmd_join(wl, wl->bss_type, 1, 100, 0);
10552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		if (ret < 0)
10572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo			goto out;
10582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
10592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
1060c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout_sleep:
106180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_ps_elp_sleep(wl);
1062c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valo
1063c5483b71936333ba9474f57d0f3a7a7abf9b87a0Kalle Valoout:
10642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_unlock(&wl->mutex);
10652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
10662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
10682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo/* can't be const, mac80211 writes to this */
106980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic struct ieee80211_rate wl1251_rates[] = {
10702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 10,
10712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x1,
10722f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x1, },
10732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 20,
10742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x2,
10752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x2,
10762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .flags = IEEE80211_RATE_SHORT_PREAMBLE },
10772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 55,
10782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x4,
10792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x4,
10802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .flags = IEEE80211_RATE_SHORT_PREAMBLE },
10812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 110,
10822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x20,
10832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x20,
10842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .flags = IEEE80211_RATE_SHORT_PREAMBLE },
10852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 60,
10862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x8,
10872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x8, },
10882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 90,
10892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x10,
10902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x10, },
10912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 120,
10922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x40,
10932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x40, },
10942f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 180,
10952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x80,
10962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x80, },
10972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 240,
10982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x200,
10992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x200, },
11002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 360,
11012f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 .hw_value = 0x400,
11022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 .hw_value_short = 0x400, },
11032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 480,
11042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x800,
11052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x800, },
11062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .bitrate = 540,
11072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value = 0x1000,
11082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	  .hw_value_short = 0x1000, },
11092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo};
11102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo/* can't be const, mac80211 writes to this */
111280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic struct ieee80211_channel wl1251_channels[] = {
11132f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 1, .center_freq = 2412},
11142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 2, .center_freq = 2417},
11152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 3, .center_freq = 2422},
11162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 4, .center_freq = 2427},
11172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 5, .center_freq = 2432},
11182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 6, .center_freq = 2437},
11192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 7, .center_freq = 2442},
11202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 8, .center_freq = 2447},
11212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 9, .center_freq = 2452},
11222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 10, .center_freq = 2457},
11232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 11, .center_freq = 2462},
11242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 12, .center_freq = 2467},
11252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	{ .hw_value = 13, .center_freq = 2472},
11262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo};
11272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo/* can't be const, mac80211 writes to this */
112980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic struct ieee80211_supported_band wl1251_band_2ghz = {
113080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.channels = wl1251_channels,
113180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.n_channels = ARRAY_SIZE(wl1251_channels),
113280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.bitrates = wl1251_rates,
113380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.n_bitrates = ARRAY_SIZE(wl1251_rates),
11342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo};
11352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
113680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic const struct ieee80211_ops wl1251_ops = {
113780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.start = wl1251_op_start,
113880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.stop = wl1251_op_stop,
113980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.add_interface = wl1251_op_add_interface,
114080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.remove_interface = wl1251_op_remove_interface,
114180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.config = wl1251_op_config,
114280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.configure_filter = wl1251_op_configure_filter,
114380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.tx = wl1251_op_tx,
114480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.set_key = wl1251_op_set_key,
114580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.hw_scan = wl1251_op_hw_scan,
114680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.bss_info_changed = wl1251_op_bss_info_changed,
114780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.set_rts_threshold = wl1251_op_set_rts_threshold,
11482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo};
11492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
115080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_register_hw(struct wl1251 *wl)
11512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
11522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
11532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (wl->mac80211_registered)
11552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return 0;
11562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	SET_IEEE80211_PERM_ADDR(wl->hw, wl->mac_addr);
11582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ret = ieee80211_register_hw(wl->hw);
11602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0) {
116180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("unable to register mac80211 hw: %d", ret);
11622f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return ret;
11632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
11642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->mac80211_registered = true;
11662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
116780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_notice("loaded");
11682f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11692f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return 0;
11702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
11712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
117280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int wl1251_init_ieee80211(struct wl1251 *wl)
11732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
11742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* The tx descriptor buffer and the TKIP space */
11752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->hw->extra_tx_headroom = sizeof(struct tx_double_buffer_desc)
11769f2ad4fb52916e58a1b75e9a30f42638655932d3Juuso Oikarinen		+ WL1251_TKIP_IV_SPACE;
11772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* unit us */
11792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* FIXME: find a proper value */
11802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->hw->channel_change_time = 10000;
11812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->hw->flags = IEEE80211_HW_SIGNAL_DBM |
11832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		IEEE80211_HW_NOISE_DBM;
11842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION);
11862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->hw->wiphy->max_scan_ssids = 1;
118780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->hw->wiphy->bands[IEEE80211_BAND_2GHZ] = &wl1251_band_2ghz;
11882f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	SET_IEEE80211_DEV(wl->hw, &wl->spi->dev);
11902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
11912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return 0;
11922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
11932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
119408d9f57251841e4870cfd286e867ffcbef81d9a4Bob Copelandextern struct wl1251_if_operations wl1251_spi_ops;
119508d9f57251841e4870cfd286e867ffcbef81d9a4Bob Copeland
119680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo#define WL1251_DEFAULT_CHANNEL 1
119780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int __devinit wl1251_probe(struct spi_device *spi)
11982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
11992f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	struct wl12xx_platform_data *pdata;
12002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	struct ieee80211_hw *hw;
120180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl;
12022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret, i;
12032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	static const u8 nokia_oui[3] = {0x00, 0x1f, 0xdf};
12042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	pdata = spi->dev.platform_data;
12062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (!pdata) {
120780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("no platform data");
12082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return -ENODEV;
12092f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
12102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
121180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	hw = ieee80211_alloc_hw(sizeof(*wl), &wl1251_ops);
12122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (!hw) {
121380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("could not alloc ieee80211_hw");
12142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		return -ENOMEM;
12152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
12162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12172f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl = hw->priv;
12182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memset(wl, 0, sizeof(*wl));
12192f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->hw = hw;
12212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	dev_set_drvdata(&spi->dev, wl);
12222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->spi = spi;
122308d9f57251841e4870cfd286e867ffcbef81d9a4Bob Copeland	wl->if_ops = &wl1251_spi_ops;
12242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->data_in_count = 0;
12262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12272f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	skb_queue_head_init(&wl->tx_queue);
12282f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
122980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	INIT_WORK(&wl->filter_work, wl1251_filter_work);
123080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->channel = WL1251_DEFAULT_CHANNEL;
12312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->scanning = false;
12322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->default_key = 0;
12332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->listen_int = 1;
12342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_counter = 0;
12352f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_handled = 0;
12362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_current_buffer = 0;
12372f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->rx_last_id = 0;
123880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->rx_config = WL1251_DEFAULT_RX_CONFIG;
123980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->rx_filter = WL1251_DEFAULT_RX_FILTER;
12402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->elp = false;
12412f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->psm = 0;
12422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->psm_requested = false;
12432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->tx_queue_stopped = false;
124480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->power_level = WL1251_DEFAULT_POWER_LEVEL;
12452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* We use the default power on sleep time until we know which chip
12472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * we're using */
124880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->chip.power_on_sleep = WL1251_DEFAULT_POWER_ON_SLEEP;
12492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12502f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	for (i = 0; i < FW_TX_CMPLT_BLOCK_SIZE; i++)
12512f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		wl->tx_frames[i] = NULL;
12522f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12532f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->next_tx_complete = 0;
12542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/*
12562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * In case our MAC address is not correctly set,
12572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * we use a random but Nokia MAC.
12582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 */
12592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	memcpy(wl->mac_addr, nokia_oui, 3);
12602f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	get_random_bytes(wl->mac_addr + 3, 3);
12612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
126280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl->state = WL1251_STATE_OFF;
12632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	mutex_init(&wl->mutex);
12642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->tx_mgmt_frm_rate = DEFAULT_HW_GEN_TX_RATE;
12662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->tx_mgmt_frm_mod = DEFAULT_HW_GEN_MODULATION_TYPE;
12672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12684721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo	wl->rx_descriptor = kmalloc(sizeof(*wl->rx_descriptor), GFP_KERNEL);
12694721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo	if (!wl->rx_descriptor) {
127080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("could not allocate memory for rx descriptor");
12714721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo		ret = -ENOMEM;
12724721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo		goto out_free;
12734721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo	}
12744721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo
12752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	/* This is the only SPI value that we need to set here, the rest
12762f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	 * comes from the board-peripherals file */
12772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	spi->bits_per_word = 32;
12782f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ret = spi_setup(spi);
12802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0) {
128180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("spi_setup failed");
12822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out_free;
12832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
12842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->set_power = pdata->set_power;
12862f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (!wl->set_power) {
128780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("set power function missing in platform data");
1288c4f5c8521868789caaf704c9c2d523b40ccfcb02Kalle Valo		ret = -ENODEV;
1289c4f5c8521868789caaf704c9c2d523b40ccfcb02Kalle Valo		goto out_free;
12902f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
12912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
12922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->irq = spi->irq;
12932f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (wl->irq < 0) {
129480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("irq missing in platform data");
1295c4f5c8521868789caaf704c9c2d523b40ccfcb02Kalle Valo		ret = -ENODEV;
1296c4f5c8521868789caaf704c9c2d523b40ccfcb02Kalle Valo		goto out_free;
12972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
12982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
129980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = request_irq(wl->irq, wl1251_irq, 0, DRIVER_NAME, wl);
13002f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0) {
130180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("request_irq() failed: %d", ret);
13022f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out_free;
13032f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
13042f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13052f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	set_irq_type(wl->irq, IRQ_TYPE_EDGE_RISING);
13062f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13072f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	disable_irq(wl->irq);
13082f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
130980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_init_ieee80211(wl);
13102f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret)
13112f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out_irq;
13122f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
131380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = wl1251_register_hw(wl);
13142f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret)
13152f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out_irq;
13162f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
131780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debugfs_init(wl);
13182f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
131980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_notice("initialized");
13202f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13212f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return 0;
13222f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13232f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo out_irq:
13242f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	free_irq(wl->irq, wl);
13252f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13262f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo out_free:
13274721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo	kfree(wl->rx_descriptor);
13284721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo	wl->rx_descriptor = NULL;
13294721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo
13302f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ieee80211_free_hw(hw);
13312f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13322f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
13332f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
13342f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
133580301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int __devexit wl1251_remove(struct spi_device *spi)
13362f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
133780301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	struct wl1251 *wl = dev_get_drvdata(&spi->dev);
13382f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13392f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ieee80211_unregister_hw(wl->hw);
13402f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
134180301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_debugfs_exit(wl);
13422f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13432f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	free_irq(wl->irq, wl);
13442f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	kfree(wl->target_mem_map);
13452f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	kfree(wl->data_path);
13462f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	kfree(wl->fw);
13472f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->fw = NULL;
13482f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	kfree(wl->nvs);
13492f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	wl->nvs = NULL;
13504721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo
13514721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo	kfree(wl->rx_descriptor);
13524721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo	wl->rx_descriptor = NULL;
13534721213fdde4456a36a5e63f02e5c2556a4df398Kalle Valo
13542f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	ieee80211_free_hw(wl->hw);
13552f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13562f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return 0;
13572f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
13582f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13592f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
136080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic struct spi_driver wl1251_spi_driver = {
13612f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	.driver = {
136280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		/* FIXME: use wl12xx name to not break the user space */
13632f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		.name		= "wl12xx",
13642f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		.bus		= &spi_bus_type,
13652f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		.owner		= THIS_MODULE,
13662f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	},
13672f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
136880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.probe		= wl1251_probe,
136980301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	.remove		= __devexit_p(wl1251_remove),
13702f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo};
13712f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
137280301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic int __init wl1251_init(void)
13732f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
13742f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	int ret;
13752f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
137680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	ret = spi_register_driver(&wl1251_spi_driver);
13772f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	if (ret < 0) {
137880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo		wl1251_error("failed to register spi driver: %d", ret);
13792f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		goto out;
13802f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	}
13812f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13822f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valoout:
13832f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo	return ret;
13842f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
13852f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
138680301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valostatic void __exit wl1251_exit(void)
13872f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo{
138880301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	spi_unregister_driver(&wl1251_spi_driver);
13892f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
139080301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valo	wl1251_notice("unloaded");
13912f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo}
13922f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
139380301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valomodule_init(wl1251_init);
139480301cdcfe44e3533175be23d7d52a9fc8c3fdb0Kalle Valomodule_exit(wl1251_exit);
13952f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo
13962f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle ValoMODULE_LICENSE("GPL");
13972f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle ValoMODULE_AUTHOR("Kalle Valo <Kalle.Valo@nokia.com>, "
13982f01a1f58889fbfeb68b1bc1b52e4197f3333490Kalle Valo		"Luciano Coelho <luciano.coelho@nokia.com>");
1399