forked from Minki/linux
1d732e8cf3
On wl128x based devices, when TX packets are aggregated, each packet size must be aligned to the SDIO block size, and sent using block mode transfers. The block size is set to 256 bytes, which is less than the maximum possible byte transfer. Thus, if two small packets (< 256 bytes) are aggregated, the aggregation buffer size would be 512, and will be sent using byte mode transfers. This can have undesired side effects. Fix this by setting the MMC_QUIRK_BLKSZ_FOR_BYTE_MODE mmc card quirk. For 127x chips this has no effect, as the block size is set to 512 bytes. Signed-off-by: Arik Nemtsov <arik@wizery.com> Signed-off-by: Ido Yariv <ido@wizery.com> Signed-off-by: Luciano Coelho <coelho@ti.com>
369 lines
8.4 KiB
C
369 lines
8.4 KiB
C
/*
|
|
* This file is part of wl1271
|
|
*
|
|
* Copyright (C) 2009-2010 Nokia Corporation
|
|
*
|
|
* Contact: Luciano Coelho <luciano.coelho@nokia.com>
|
|
*
|
|
* 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/irq.h>
|
|
#include <linux/module.h>
|
|
#include <linux/crc7.h>
|
|
#include <linux/vmalloc.h>
|
|
#include <linux/mmc/sdio_func.h>
|
|
#include <linux/mmc/sdio_ids.h>
|
|
#include <linux/mmc/card.h>
|
|
#include <linux/mmc/host.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/wl12xx.h>
|
|
#include <linux/pm_runtime.h>
|
|
|
|
#include "wl12xx.h"
|
|
#include "wl12xx_80211.h"
|
|
#include "io.h"
|
|
|
|
#ifndef SDIO_VENDOR_ID_TI
|
|
#define SDIO_VENDOR_ID_TI 0x0097
|
|
#endif
|
|
|
|
#ifndef SDIO_DEVICE_ID_TI_WL1271
|
|
#define SDIO_DEVICE_ID_TI_WL1271 0x4076
|
|
#endif
|
|
|
|
static const struct sdio_device_id wl1271_devices[] = {
|
|
{ SDIO_DEVICE(SDIO_VENDOR_ID_TI, SDIO_DEVICE_ID_TI_WL1271) },
|
|
{}
|
|
};
|
|
MODULE_DEVICE_TABLE(sdio, wl1271_devices);
|
|
|
|
/* The max SDIO block size is 256 when working with tx padding to SDIO block */
|
|
#define TX_PAD_SDIO_BLK_SIZE 256
|
|
|
|
static void wl1271_sdio_set_block_size(struct wl1271 *wl)
|
|
{
|
|
wl->block_size = TX_PAD_SDIO_BLK_SIZE;
|
|
|
|
sdio_claim_host(wl->if_priv);
|
|
sdio_set_block_size(wl->if_priv, TX_PAD_SDIO_BLK_SIZE);
|
|
sdio_release_host(wl->if_priv);
|
|
}
|
|
|
|
static inline struct sdio_func *wl_to_func(struct wl1271 *wl)
|
|
{
|
|
return wl->if_priv;
|
|
}
|
|
|
|
static struct device *wl1271_sdio_wl_to_dev(struct wl1271 *wl)
|
|
{
|
|
return &(wl_to_func(wl)->dev);
|
|
}
|
|
|
|
static irqreturn_t wl1271_hardirq(int irq, void *cookie)
|
|
{
|
|
struct wl1271 *wl = cookie;
|
|
unsigned long flags;
|
|
|
|
wl1271_debug(DEBUG_IRQ, "IRQ");
|
|
|
|
/* complete the ELP completion */
|
|
spin_lock_irqsave(&wl->wl_lock, flags);
|
|
set_bit(WL1271_FLAG_IRQ_RUNNING, &wl->flags);
|
|
if (wl->elp_compl) {
|
|
complete(wl->elp_compl);
|
|
wl->elp_compl = NULL;
|
|
}
|
|
spin_unlock_irqrestore(&wl->wl_lock, flags);
|
|
|
|
return IRQ_WAKE_THREAD;
|
|
}
|
|
|
|
static void wl1271_sdio_disable_interrupts(struct wl1271 *wl)
|
|
{
|
|
disable_irq(wl->irq);
|
|
}
|
|
|
|
static void wl1271_sdio_enable_interrupts(struct wl1271 *wl)
|
|
{
|
|
enable_irq(wl->irq);
|
|
}
|
|
|
|
static void wl1271_sdio_reset(struct wl1271 *wl)
|
|
{
|
|
}
|
|
|
|
static void wl1271_sdio_init(struct wl1271 *wl)
|
|
{
|
|
}
|
|
|
|
static void wl1271_sdio_raw_read(struct wl1271 *wl, int addr, void *buf,
|
|
size_t len, bool fixed)
|
|
{
|
|
int ret;
|
|
struct sdio_func *func = wl_to_func(wl);
|
|
|
|
if (unlikely(addr == HW_ACCESS_ELP_CTRL_REG_ADDR)) {
|
|
((u8 *)buf)[0] = sdio_f0_readb(func, addr, &ret);
|
|
wl1271_debug(DEBUG_SDIO, "sdio read 52 addr 0x%x, byte 0x%02x",
|
|
addr, ((u8 *)buf)[0]);
|
|
} else {
|
|
if (fixed)
|
|
ret = sdio_readsb(func, buf, addr, len);
|
|
else
|
|
ret = sdio_memcpy_fromio(func, buf, addr, len);
|
|
|
|
wl1271_debug(DEBUG_SDIO, "sdio read 53 addr 0x%x, %zu bytes",
|
|
addr, len);
|
|
wl1271_dump_ascii(DEBUG_SDIO, "data: ", buf, len);
|
|
}
|
|
|
|
if (ret)
|
|
wl1271_error("sdio read failed (%d)", ret);
|
|
}
|
|
|
|
static void wl1271_sdio_raw_write(struct wl1271 *wl, int addr, void *buf,
|
|
size_t len, bool fixed)
|
|
{
|
|
int ret;
|
|
struct sdio_func *func = wl_to_func(wl);
|
|
|
|
if (unlikely(addr == HW_ACCESS_ELP_CTRL_REG_ADDR)) {
|
|
sdio_f0_writeb(func, ((u8 *)buf)[0], addr, &ret);
|
|
wl1271_debug(DEBUG_SDIO, "sdio write 52 addr 0x%x, byte 0x%02x",
|
|
addr, ((u8 *)buf)[0]);
|
|
} else {
|
|
wl1271_debug(DEBUG_SDIO, "sdio write 53 addr 0x%x, %zu bytes",
|
|
addr, len);
|
|
wl1271_dump_ascii(DEBUG_SDIO, "data: ", buf, len);
|
|
|
|
if (fixed)
|
|
ret = sdio_writesb(func, addr, buf, len);
|
|
else
|
|
ret = sdio_memcpy_toio(func, addr, buf, len);
|
|
}
|
|
|
|
if (ret)
|
|
wl1271_error("sdio write failed (%d)", ret);
|
|
}
|
|
|
|
static int wl1271_sdio_power_on(struct wl1271 *wl)
|
|
{
|
|
struct sdio_func *func = wl_to_func(wl);
|
|
int ret;
|
|
|
|
/* Make sure the card will not be powered off by runtime PM */
|
|
ret = pm_runtime_get_sync(&func->dev);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
/* Runtime PM might be disabled, so power up the card manually */
|
|
ret = mmc_power_restore_host(func->card->host);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
sdio_claim_host(func);
|
|
sdio_enable_func(func);
|
|
|
|
/* Set the default block size in case it was modified */
|
|
sdio_set_block_size(func, 0);
|
|
|
|
out:
|
|
return ret;
|
|
}
|
|
|
|
static int wl1271_sdio_power_off(struct wl1271 *wl)
|
|
{
|
|
struct sdio_func *func = wl_to_func(wl);
|
|
int ret;
|
|
|
|
sdio_disable_func(func);
|
|
sdio_release_host(func);
|
|
|
|
/* Runtime PM might be disabled, so power off the card manually */
|
|
ret = mmc_power_save_host(func->card->host);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Let runtime PM know the card is powered off */
|
|
return pm_runtime_put_sync(&func->dev);
|
|
}
|
|
|
|
static int wl1271_sdio_set_power(struct wl1271 *wl, bool enable)
|
|
{
|
|
if (enable)
|
|
return wl1271_sdio_power_on(wl);
|
|
else
|
|
return wl1271_sdio_power_off(wl);
|
|
}
|
|
|
|
static struct wl1271_if_operations sdio_ops = {
|
|
.read = wl1271_sdio_raw_read,
|
|
.write = wl1271_sdio_raw_write,
|
|
.reset = wl1271_sdio_reset,
|
|
.init = wl1271_sdio_init,
|
|
.power = wl1271_sdio_set_power,
|
|
.dev = wl1271_sdio_wl_to_dev,
|
|
.enable_irq = wl1271_sdio_enable_interrupts,
|
|
.disable_irq = wl1271_sdio_disable_interrupts,
|
|
.set_block_size = wl1271_sdio_set_block_size,
|
|
};
|
|
|
|
static int __devinit wl1271_probe(struct sdio_func *func,
|
|
const struct sdio_device_id *id)
|
|
{
|
|
struct ieee80211_hw *hw;
|
|
const struct wl12xx_platform_data *wlan_data;
|
|
struct wl1271 *wl;
|
|
int ret;
|
|
|
|
/* We are only able to handle the wlan function */
|
|
if (func->num != 0x02)
|
|
return -ENODEV;
|
|
|
|
hw = wl1271_alloc_hw();
|
|
if (IS_ERR(hw))
|
|
return PTR_ERR(hw);
|
|
|
|
wl = hw->priv;
|
|
|
|
wl->if_priv = func;
|
|
wl->if_ops = &sdio_ops;
|
|
|
|
/* Grab access to FN0 for ELP reg. */
|
|
func->card->quirks |= MMC_QUIRK_LENIENT_FN0;
|
|
|
|
/* Use block mode for transferring over one block size of data */
|
|
func->card->quirks |= MMC_QUIRK_BLKSZ_FOR_BYTE_MODE;
|
|
|
|
wlan_data = wl12xx_get_platform_data();
|
|
if (IS_ERR(wlan_data)) {
|
|
ret = PTR_ERR(wlan_data);
|
|
wl1271_error("missing wlan platform data: %d", ret);
|
|
goto out_free;
|
|
}
|
|
|
|
wl->irq = wlan_data->irq;
|
|
wl->ref_clock = wlan_data->board_ref_clock;
|
|
wl->tcxo_clock = wlan_data->board_tcxo_clock;
|
|
|
|
ret = request_threaded_irq(wl->irq, wl1271_hardirq, wl1271_irq,
|
|
IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
|
|
DRIVER_NAME, wl);
|
|
if (ret < 0) {
|
|
wl1271_error("request_irq() failed: %d", ret);
|
|
goto out_free;
|
|
}
|
|
|
|
disable_irq(wl->irq);
|
|
|
|
ret = wl1271_init_ieee80211(wl);
|
|
if (ret)
|
|
goto out_irq;
|
|
|
|
ret = wl1271_register_hw(wl);
|
|
if (ret)
|
|
goto out_irq;
|
|
|
|
sdio_set_drvdata(func, wl);
|
|
|
|
/* Tell PM core that we don't need the card to be powered now */
|
|
pm_runtime_put_noidle(&func->dev);
|
|
|
|
wl1271_notice("initialized");
|
|
|
|
return 0;
|
|
|
|
out_irq:
|
|
free_irq(wl->irq, wl);
|
|
|
|
out_free:
|
|
wl1271_free_hw(wl);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void __devexit wl1271_remove(struct sdio_func *func)
|
|
{
|
|
struct wl1271 *wl = sdio_get_drvdata(func);
|
|
|
|
/* Undo decrement done above in wl1271_probe */
|
|
pm_runtime_get_noresume(&func->dev);
|
|
|
|
wl1271_unregister_hw(wl);
|
|
free_irq(wl->irq, wl);
|
|
wl1271_free_hw(wl);
|
|
}
|
|
|
|
static int wl1271_suspend(struct device *dev)
|
|
{
|
|
/* Tell MMC/SDIO core it's OK to power down the card
|
|
* (if it isn't already), but not to remove it completely */
|
|
return 0;
|
|
}
|
|
|
|
static int wl1271_resume(struct device *dev)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static const struct dev_pm_ops wl1271_sdio_pm_ops = {
|
|
.suspend = wl1271_suspend,
|
|
.resume = wl1271_resume,
|
|
};
|
|
|
|
static struct sdio_driver wl1271_sdio_driver = {
|
|
.name = "wl1271_sdio",
|
|
.id_table = wl1271_devices,
|
|
.probe = wl1271_probe,
|
|
.remove = __devexit_p(wl1271_remove),
|
|
.drv = {
|
|
.pm = &wl1271_sdio_pm_ops,
|
|
},
|
|
};
|
|
|
|
static int __init wl1271_init(void)
|
|
{
|
|
int ret;
|
|
|
|
ret = sdio_register_driver(&wl1271_sdio_driver);
|
|
if (ret < 0) {
|
|
wl1271_error("failed to register sdio driver: %d", ret);
|
|
goto out;
|
|
}
|
|
|
|
out:
|
|
return ret;
|
|
}
|
|
|
|
static void __exit wl1271_exit(void)
|
|
{
|
|
sdio_unregister_driver(&wl1271_sdio_driver);
|
|
|
|
wl1271_notice("unloaded");
|
|
}
|
|
|
|
module_init(wl1271_init);
|
|
module_exit(wl1271_exit);
|
|
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_AUTHOR("Luciano Coelho <coelho@ti.com>");
|
|
MODULE_AUTHOR("Juuso Oikarinen <juuso.oikarinen@nokia.com>");
|
|
MODULE_FIRMWARE(WL1271_FW_NAME);
|
|
MODULE_FIRMWARE(WL128X_FW_NAME);
|
|
MODULE_FIRMWARE(WL127X_AP_FW_NAME);
|
|
MODULE_FIRMWARE(WL128X_AP_FW_NAME);
|