sdio.c

Go to the documentation of this file.

/*
 * wl12xx SDIO routines
 *
 * 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
 *
 * Copyright (C) 2005 Texas Instruments Incorporated
 * Copyright (C) 2008 Google Inc
 * Copyright (C) 2009 Bob Copeland ([email protected])
 */
#include <linux/interrupt.h>
#include <linux/module.h>
#include <linux/mod_devicetable.h>
#include <linux/mmc/sdio_func.h>
#include <linux/mmc/sdio_ids.h>
#include <linux/platform_device.h>
#include <linux/wl12xx.h>
#include <linux/irq.h>
#include <linux/pm_runtime.h>

#include "wl1251.h"

#ifndef SDIO_VENDOR_ID_TI
#define SDIO_VENDOR_ID_TI       0x104c
#endif

#ifndef SDIO_DEVICE_ID_TI_WL1251
#define SDIO_DEVICE_ID_TI_WL1251    0x9066
#endif

struct wl1251_sdio {
    struct sdio_func *func;
    u32 elp_val;
};

static struct sdio_func *wl_to_func(struct wl1251 *wl)
{
    struct wl1251_sdio *wl_sdio = wl->if_priv;
    return wl_sdio->func;
}

static void wl1251_sdio_interrupt(struct sdio_func *func)
{
    struct wl1251 *wl = sdio_get_drvdata(func);

    wl1251_debug(DEBUG_IRQ, "IRQ");

    /* FIXME should be synchronous for sdio */
    ieee80211_queue_work(wl->hw, &wl->irq_work);
}

static const struct sdio_device_id wl1251_devices[] = {
    { SDIO_DEVICE(SDIO_VENDOR_ID_TI, SDIO_DEVICE_ID_TI_WL1251) },
    {}
};
MODULE_DEVICE_TABLE(sdio, wl1251_devices);


static void wl1251_sdio_read(struct wl1251 *wl, int addr,
                 void *buf, size_t len)
{
    int ret;
    struct sdio_func *func = wl_to_func(wl);

    sdio_claim_host(func);
    ret = sdio_memcpy_fromio(func, buf, addr, len);
    if (ret)
        wl1251_error("sdio read failed (%d)", ret);
    sdio_release_host(func);
}

static void wl1251_sdio_write(struct wl1251 *wl, int addr,
                  void *buf, size_t len)
{
    int ret;
    struct sdio_func *func = wl_to_func(wl);

    sdio_claim_host(func);
    ret = sdio_memcpy_toio(func, addr, buf, len);
    if (ret)
        wl1251_error("sdio write failed (%d)", ret);
    sdio_release_host(func);
}

static void wl1251_sdio_read_elp(struct wl1251 *wl, int addr, u32 *val)
{
    int ret = 0;
    struct wl1251_sdio *wl_sdio = wl->if_priv;
    struct sdio_func *func = wl_sdio->func;

    /*
     * The hardware only supports RAW (read after write) access for
     * reading, regular sdio_readb won't work here (it interprets
     * the unused bits of CMD52 as write data even if we send read
     * request).
     */
    sdio_claim_host(func);
    *val = sdio_writeb_readb(func, wl_sdio->elp_val, addr, &ret);
    sdio_release_host(func);

    if (ret)
        wl1251_error("sdio_readb failed (%d)", ret);
}

static void wl1251_sdio_write_elp(struct wl1251 *wl, int addr, u32 val)
{
    int ret = 0;
    struct wl1251_sdio *wl_sdio = wl->if_priv;
    struct sdio_func *func = wl_sdio->func;

    sdio_claim_host(func);
    sdio_writeb(func, val, addr, &ret);
    sdio_release_host(func);

    if (ret)
        wl1251_error("sdio_writeb failed (%d)", ret);
    else
        wl_sdio->elp_val = val;
}

static void wl1251_sdio_reset(struct wl1251 *wl)
{
}

static void wl1251_sdio_enable_irq(struct wl1251 *wl)
{
    struct sdio_func *func = wl_to_func(wl);

    sdio_claim_host(func);
    sdio_claim_irq(func, wl1251_sdio_interrupt);
    sdio_release_host(func);
}

static void wl1251_sdio_disable_irq(struct wl1251 *wl)
{
    struct sdio_func *func = wl_to_func(wl);

    sdio_claim_host(func);
    sdio_release_irq(func);
    sdio_release_host(func);
}

/* Interrupts when using dedicated WLAN_IRQ pin */
static irqreturn_t wl1251_line_irq(int irq, void *cookie)
{
    struct wl1251 *wl = cookie;

    ieee80211_queue_work(wl->hw, &wl->irq_work);

    return IRQ_HANDLED;
}

static void wl1251_enable_line_irq(struct wl1251 *wl)
{
    return enable_irq(wl->irq);
}

static void wl1251_disable_line_irq(struct wl1251 *wl)
{
    return disable_irq(wl->irq);
}

static int wl1251_sdio_set_power(struct wl1251 *wl, bool enable)
{
    struct sdio_func *func = wl_to_func(wl);
    int ret;

    if (enable) {
        /*
         * Power is controlled by runtime PM, but we still call board
         * callback in case it wants to do any additional setup,
         * for example enabling clock buffer for the module.
         */
        if (wl->set_power)
            wl->set_power(true);

        ret = pm_runtime_get_sync(&func->dev);
        if (ret < 0)
            goto out;

        sdio_claim_host(func);
        sdio_enable_func(func);
        sdio_release_host(func);
    } else {
        sdio_claim_host(func);
        sdio_disable_func(func);
        sdio_release_host(func);

        ret = pm_runtime_put_sync(&func->dev);
        if (ret < 0)
            goto out;

        if (wl->set_power)
            wl->set_power(false);
    }

out:
    return ret;
}

static struct wl1251_if_operations wl1251_sdio_ops = {
    .read = wl1251_sdio_read,
    .write = wl1251_sdio_write,
    .write_elp = wl1251_sdio_write_elp,
    .read_elp = wl1251_sdio_read_elp,
    .reset = wl1251_sdio_reset,
    .power = wl1251_sdio_set_power,
};

static int wl1251_sdio_probe(struct sdio_func *func,
                 const struct sdio_device_id *id)
{
    int ret;
    struct wl1251 *wl;
    struct ieee80211_hw *hw;
    struct wl1251_sdio *wl_sdio;
    const struct wl12xx_platform_data *wl12xx_board_data;

    hw = wl1251_alloc_hw();
    if (IS_ERR(hw))
        return PTR_ERR(hw);

    wl = hw->priv;

    wl_sdio = kzalloc(sizeof(*wl_sdio), GFP_KERNEL);
    if (wl_sdio == NULL) {
        ret = -ENOMEM;
        goto out_free_hw;
    }

    sdio_claim_host(func);
    ret = sdio_enable_func(func);
    if (ret)
        goto release;

    sdio_set_block_size(func, 512);
    sdio_release_host(func);

    SET_IEEE80211_DEV(hw, &func->dev);
    wl_sdio->func = func;
    wl->if_priv = wl_sdio;
    wl->if_ops = &wl1251_sdio_ops;

    wl12xx_board_data = wl12xx_get_platform_data();
    if (!IS_ERR(wl12xx_board_data)) {
        wl->set_power = wl12xx_board_data->set_power;
        wl->irq = wl12xx_board_data->irq;
        wl->use_eeprom = wl12xx_board_data->use_eeprom;
    }

    if (wl->irq) {
        irq_set_status_flags(wl->irq, IRQ_NOAUTOEN);
        ret = request_irq(wl->irq, wl1251_line_irq, 0, "wl1251", wl);
        if (ret < 0) {
            wl1251_error("request_irq() failed: %d", ret);
            goto disable;
        }

        irq_set_irq_type(wl->irq, IRQ_TYPE_EDGE_RISING);

        wl1251_sdio_ops.enable_irq = wl1251_enable_line_irq;
        wl1251_sdio_ops.disable_irq = wl1251_disable_line_irq;

        wl1251_info("using dedicated interrupt line");
    } else {
        wl1251_sdio_ops.enable_irq = wl1251_sdio_enable_irq;
        wl1251_sdio_ops.disable_irq = wl1251_sdio_disable_irq;

        wl1251_info("using SDIO interrupt");
    }

    ret = wl1251_init_ieee80211(wl);
    if (ret)
        goto out_free_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);

    return ret;

out_free_irq:
    if (wl->irq)
        free_irq(wl->irq, wl);
disable:
    sdio_claim_host(func);
    sdio_disable_func(func);
release:
    sdio_release_host(func);
    kfree(wl_sdio);
out_free_hw:
    wl1251_free_hw(wl);
    return ret;
}

static void __devexit wl1251_sdio_remove(struct sdio_func *func)
{
    struct wl1251 *wl = sdio_get_drvdata(func);
    struct wl1251_sdio *wl_sdio = wl->if_priv;

    /* Undo decrement done above in wl1251_probe */
    pm_runtime_get_noresume(&func->dev);

    if (wl->irq)
        free_irq(wl->irq, wl);
    wl1251_free_hw(wl);
    kfree(wl_sdio);

    sdio_claim_host(func);
    sdio_release_irq(func);
    sdio_disable_func(func);
    sdio_release_host(func);
}

static int wl1251_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 wl1251_resume(struct device *dev)
{
    return 0;
}

static const struct dev_pm_ops wl1251_sdio_pm_ops = {
    .suspend        = wl1251_suspend,
    .resume         = wl1251_resume,
};

static struct sdio_driver wl1251_sdio_driver = {
    .name       = "wl1251_sdio",
    .id_table   = wl1251_devices,
    .probe      = wl1251_sdio_probe,
    .remove     = __devexit_p(wl1251_sdio_remove),
    .drv.pm     = &wl1251_sdio_pm_ops,
};

static int __init wl1251_sdio_init(void)
{
    int err;

    err = sdio_register_driver(&wl1251_sdio_driver);
    if (err)
        wl1251_error("failed to register sdio driver: %d", err);
    return err;
}

static void __exit wl1251_sdio_exit(void)
{
    sdio_unregister_driver(&wl1251_sdio_driver);
    wl1251_notice("unloaded");
}

module_init(wl1251_sdio_init);
module_exit(wl1251_sdio_exit);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Kalle Valo <[email protected]>");