forked from Minki/linux
f380f2c4a1
This driver disables interrupt just after requesting it and enables it later, after interface is up. However currently there is a time window between request_irq() and disable_irq() where if interrupt arrives, the driver oopses because it's not yet ready to process it. This can be reproduced by inserting the module, associating and removing the module multiple times. Eliminate this race by setting IRQF_NOAUTOEN flag before request_irq(). Cc: stable@vger.kernel.org # v2.6.37+ Signed-off-by: Grazvydas Ignotas <notasas@gmail.com> Signed-off-by: John W. Linville <linville@tuxdriver.com>
355 lines
7.3 KiB
C
355 lines
7.3 KiB
C
/*
|
|
* This file is part of wl1251
|
|
*
|
|
* Copyright (C) 2008 Nokia Corporation
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* version 2 as published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
|
|
* 02110-1301 USA
|
|
*
|
|
*/
|
|
|
|
#include <linux/interrupt.h>
|
|
#include <linux/irq.h>
|
|
#include <linux/module.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/crc7.h>
|
|
#include <linux/spi/spi.h>
|
|
#include <linux/wl12xx.h>
|
|
|
|
#include "wl1251.h"
|
|
#include "reg.h"
|
|
#include "spi.h"
|
|
|
|
static irqreturn_t wl1251_irq(int irq, void *cookie)
|
|
{
|
|
struct wl1251 *wl;
|
|
|
|
wl1251_debug(DEBUG_IRQ, "IRQ");
|
|
|
|
wl = cookie;
|
|
|
|
ieee80211_queue_work(wl->hw, &wl->irq_work);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static struct spi_device *wl_to_spi(struct wl1251 *wl)
|
|
{
|
|
return wl->if_priv;
|
|
}
|
|
|
|
static void wl1251_spi_reset(struct wl1251 *wl)
|
|
{
|
|
u8 *cmd;
|
|
struct spi_transfer t;
|
|
struct spi_message m;
|
|
|
|
cmd = kzalloc(WSPI_INIT_CMD_LEN, GFP_KERNEL);
|
|
if (!cmd) {
|
|
wl1251_error("could not allocate cmd for spi reset");
|
|
return;
|
|
}
|
|
|
|
memset(&t, 0, sizeof(t));
|
|
spi_message_init(&m);
|
|
|
|
memset(cmd, 0xff, WSPI_INIT_CMD_LEN);
|
|
|
|
t.tx_buf = cmd;
|
|
t.len = WSPI_INIT_CMD_LEN;
|
|
spi_message_add_tail(&t, &m);
|
|
|
|
spi_sync(wl_to_spi(wl), &m);
|
|
|
|
wl1251_dump(DEBUG_SPI, "spi reset -> ", cmd, WSPI_INIT_CMD_LEN);
|
|
}
|
|
|
|
static void wl1251_spi_wake(struct wl1251 *wl)
|
|
{
|
|
u8 crc[WSPI_INIT_CMD_CRC_LEN], *cmd;
|
|
struct spi_transfer t;
|
|
struct spi_message m;
|
|
|
|
cmd = kzalloc(WSPI_INIT_CMD_LEN, GFP_KERNEL);
|
|
if (!cmd) {
|
|
wl1251_error("could not allocate cmd for spi init");
|
|
return;
|
|
}
|
|
|
|
memset(crc, 0, sizeof(crc));
|
|
memset(&t, 0, sizeof(t));
|
|
spi_message_init(&m);
|
|
|
|
/*
|
|
* Set WSPI_INIT_COMMAND
|
|
* the data is being send from the MSB to LSB
|
|
*/
|
|
cmd[2] = 0xff;
|
|
cmd[3] = 0xff;
|
|
cmd[1] = WSPI_INIT_CMD_START | WSPI_INIT_CMD_TX;
|
|
cmd[0] = 0;
|
|
cmd[7] = 0;
|
|
cmd[6] |= HW_ACCESS_WSPI_INIT_CMD_MASK << 3;
|
|
cmd[6] |= HW_ACCESS_WSPI_FIXED_BUSY_LEN & WSPI_INIT_CMD_FIXEDBUSY_LEN;
|
|
|
|
if (HW_ACCESS_WSPI_FIXED_BUSY_LEN == 0)
|
|
cmd[5] |= WSPI_INIT_CMD_DIS_FIXEDBUSY;
|
|
else
|
|
cmd[5] |= WSPI_INIT_CMD_EN_FIXEDBUSY;
|
|
|
|
cmd[5] |= WSPI_INIT_CMD_IOD | WSPI_INIT_CMD_IP | WSPI_INIT_CMD_CS
|
|
| WSPI_INIT_CMD_WSPI | WSPI_INIT_CMD_WS;
|
|
|
|
crc[0] = cmd[1];
|
|
crc[1] = cmd[0];
|
|
crc[2] = cmd[7];
|
|
crc[3] = cmd[6];
|
|
crc[4] = cmd[5];
|
|
|
|
cmd[4] |= crc7(0, crc, WSPI_INIT_CMD_CRC_LEN) << 1;
|
|
cmd[4] |= WSPI_INIT_CMD_END;
|
|
|
|
t.tx_buf = cmd;
|
|
t.len = WSPI_INIT_CMD_LEN;
|
|
spi_message_add_tail(&t, &m);
|
|
|
|
spi_sync(wl_to_spi(wl), &m);
|
|
|
|
wl1251_dump(DEBUG_SPI, "spi init -> ", cmd, WSPI_INIT_CMD_LEN);
|
|
}
|
|
|
|
static void wl1251_spi_reset_wake(struct wl1251 *wl)
|
|
{
|
|
wl1251_spi_reset(wl);
|
|
wl1251_spi_wake(wl);
|
|
}
|
|
|
|
static void wl1251_spi_read(struct wl1251 *wl, int addr, void *buf,
|
|
size_t len)
|
|
{
|
|
struct spi_transfer t[3];
|
|
struct spi_message m;
|
|
u8 *busy_buf;
|
|
u32 *cmd;
|
|
|
|
cmd = &wl->buffer_cmd;
|
|
busy_buf = wl->buffer_busyword;
|
|
|
|
*cmd = 0;
|
|
*cmd |= WSPI_CMD_READ;
|
|
*cmd |= (len << WSPI_CMD_BYTE_LENGTH_OFFSET) & WSPI_CMD_BYTE_LENGTH;
|
|
*cmd |= addr & WSPI_CMD_BYTE_ADDR;
|
|
|
|
spi_message_init(&m);
|
|
memset(t, 0, sizeof(t));
|
|
|
|
t[0].tx_buf = cmd;
|
|
t[0].len = 4;
|
|
spi_message_add_tail(&t[0], &m);
|
|
|
|
/* Busy and non busy words read */
|
|
t[1].rx_buf = busy_buf;
|
|
t[1].len = WL1251_BUSY_WORD_LEN;
|
|
spi_message_add_tail(&t[1], &m);
|
|
|
|
t[2].rx_buf = buf;
|
|
t[2].len = len;
|
|
spi_message_add_tail(&t[2], &m);
|
|
|
|
spi_sync(wl_to_spi(wl), &m);
|
|
|
|
/* FIXME: check busy words */
|
|
|
|
wl1251_dump(DEBUG_SPI, "spi_read cmd -> ", cmd, sizeof(*cmd));
|
|
wl1251_dump(DEBUG_SPI, "spi_read buf <- ", buf, len);
|
|
}
|
|
|
|
static void wl1251_spi_write(struct wl1251 *wl, int addr, void *buf,
|
|
size_t len)
|
|
{
|
|
struct spi_transfer t[2];
|
|
struct spi_message m;
|
|
u32 *cmd;
|
|
|
|
cmd = &wl->buffer_cmd;
|
|
|
|
*cmd = 0;
|
|
*cmd |= WSPI_CMD_WRITE;
|
|
*cmd |= (len << WSPI_CMD_BYTE_LENGTH_OFFSET) & WSPI_CMD_BYTE_LENGTH;
|
|
*cmd |= addr & WSPI_CMD_BYTE_ADDR;
|
|
|
|
spi_message_init(&m);
|
|
memset(t, 0, sizeof(t));
|
|
|
|
t[0].tx_buf = cmd;
|
|
t[0].len = sizeof(*cmd);
|
|
spi_message_add_tail(&t[0], &m);
|
|
|
|
t[1].tx_buf = buf;
|
|
t[1].len = len;
|
|
spi_message_add_tail(&t[1], &m);
|
|
|
|
spi_sync(wl_to_spi(wl), &m);
|
|
|
|
wl1251_dump(DEBUG_SPI, "spi_write cmd -> ", cmd, sizeof(*cmd));
|
|
wl1251_dump(DEBUG_SPI, "spi_write buf -> ", buf, len);
|
|
}
|
|
|
|
static void wl1251_spi_enable_irq(struct wl1251 *wl)
|
|
{
|
|
return enable_irq(wl->irq);
|
|
}
|
|
|
|
static void wl1251_spi_disable_irq(struct wl1251 *wl)
|
|
{
|
|
return disable_irq(wl->irq);
|
|
}
|
|
|
|
static int wl1251_spi_set_power(struct wl1251 *wl, bool enable)
|
|
{
|
|
if (wl->set_power)
|
|
wl->set_power(enable);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct wl1251_if_operations wl1251_spi_ops = {
|
|
.read = wl1251_spi_read,
|
|
.write = wl1251_spi_write,
|
|
.reset = wl1251_spi_reset_wake,
|
|
.enable_irq = wl1251_spi_enable_irq,
|
|
.disable_irq = wl1251_spi_disable_irq,
|
|
.power = wl1251_spi_set_power,
|
|
};
|
|
|
|
static int __devinit wl1251_spi_probe(struct spi_device *spi)
|
|
{
|
|
struct wl12xx_platform_data *pdata;
|
|
struct ieee80211_hw *hw;
|
|
struct wl1251 *wl;
|
|
int ret;
|
|
|
|
pdata = spi->dev.platform_data;
|
|
if (!pdata) {
|
|
wl1251_error("no platform data");
|
|
return -ENODEV;
|
|
}
|
|
|
|
hw = wl1251_alloc_hw();
|
|
if (IS_ERR(hw))
|
|
return PTR_ERR(hw);
|
|
|
|
wl = hw->priv;
|
|
|
|
SET_IEEE80211_DEV(hw, &spi->dev);
|
|
dev_set_drvdata(&spi->dev, wl);
|
|
wl->if_priv = spi;
|
|
wl->if_ops = &wl1251_spi_ops;
|
|
|
|
/* This is the only SPI value that we need to set here, the rest
|
|
* comes from the board-peripherals file */
|
|
spi->bits_per_word = 32;
|
|
|
|
ret = spi_setup(spi);
|
|
if (ret < 0) {
|
|
wl1251_error("spi_setup failed");
|
|
goto out_free;
|
|
}
|
|
|
|
wl->set_power = pdata->set_power;
|
|
if (!wl->set_power) {
|
|
wl1251_error("set power function missing in platform data");
|
|
return -ENODEV;
|
|
}
|
|
|
|
wl->irq = spi->irq;
|
|
if (wl->irq < 0) {
|
|
wl1251_error("irq missing in platform data");
|
|
return -ENODEV;
|
|
}
|
|
|
|
wl->use_eeprom = pdata->use_eeprom;
|
|
|
|
irq_set_status_flags(wl->irq, IRQ_NOAUTOEN);
|
|
ret = request_irq(wl->irq, wl1251_irq, 0, DRIVER_NAME, wl);
|
|
if (ret < 0) {
|
|
wl1251_error("request_irq() failed: %d", ret);
|
|
goto out_free;
|
|
}
|
|
|
|
irq_set_irq_type(wl->irq, IRQ_TYPE_EDGE_RISING);
|
|
|
|
ret = wl1251_init_ieee80211(wl);
|
|
if (ret)
|
|
goto out_irq;
|
|
|
|
return 0;
|
|
|
|
out_irq:
|
|
free_irq(wl->irq, wl);
|
|
|
|
out_free:
|
|
ieee80211_free_hw(hw);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int __devexit wl1251_spi_remove(struct spi_device *spi)
|
|
{
|
|
struct wl1251 *wl = dev_get_drvdata(&spi->dev);
|
|
|
|
free_irq(wl->irq, wl);
|
|
wl1251_free_hw(wl);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct spi_driver wl1251_spi_driver = {
|
|
.driver = {
|
|
.name = DRIVER_NAME,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
|
|
.probe = wl1251_spi_probe,
|
|
.remove = __devexit_p(wl1251_spi_remove),
|
|
};
|
|
|
|
static int __init wl1251_spi_init(void)
|
|
{
|
|
int ret;
|
|
|
|
ret = spi_register_driver(&wl1251_spi_driver);
|
|
if (ret < 0) {
|
|
wl1251_error("failed to register spi driver: %d", ret);
|
|
goto out;
|
|
}
|
|
|
|
out:
|
|
return ret;
|
|
}
|
|
|
|
static void __exit wl1251_spi_exit(void)
|
|
{
|
|
spi_unregister_driver(&wl1251_spi_driver);
|
|
|
|
wl1251_notice("unloaded");
|
|
}
|
|
|
|
module_init(wl1251_spi_init);
|
|
module_exit(wl1251_spi_exit);
|
|
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_AUTHOR("Kalle Valo <kvalo@adurom.com>");
|
|
MODULE_ALIAS("spi:wl1251");
|