release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/net/wireless/wl12xx/wl1251_sdio.c

   1 /*
   2  * wl12xx SDIO routines
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License version 2 as
   6  * published by the Free Software Foundation.
   7  *
   8  * This program is distributed in the hope that it will be useful, but
   9  * WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  11  * General Public License for more details.
  12  *
  13  * You should have received a copy of the GNU General Public License
  14  * along with this program; if not, write to the Free Software
  15  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  16  * 02110-1301 USA
  17  *
  18  * Copyright (C) 2005 Texas Instruments Incorporated
  19  * Copyright (C) 2008 Google Inc
  20  * Copyright (C) 2009 Bob Copeland (me@bobcopeland.com)
  21  */
  22 #include <linux/module.h>
  23 #include <linux/mod_devicetable.h>
  24 #include <linux/mmc/sdio_func.h>
  25 #include <linux/mmc/sdio_ids.h>
  26 #include <linux/platform_device.h>
  27 #include <linux/spi/wl12xx.h>
  28 #include <linux/irq.h>
  29
  30 #include "wl1251.h"
  31
  32 #ifndef SDIO_VENDOR_ID_TI
  33 #define SDIO_VENDOR_ID_TI               0x104c
  34 #endif
  35
  36 #ifndef SDIO_DEVICE_ID_TI_WL1251
  37 #define SDIO_DEVICE_ID_TI_WL1251        0x9066
  38 #endif
  39
  40 struct wl1251_sdio {
  41         struct sdio_func *func;
  42         u32 elp_val;
  43 };
  44
  45 static struct wl12xx_platform_data *wl12xx_board_data;
  46
  47 static struct sdio_func *wl_to_func(struct wl1251 *wl)
  48 {
  49         struct wl1251_sdio *wl_sdio = wl->if_priv;
  50         return wl_sdio->func;
  51 }
  52
  53 static void wl1251_sdio_interrupt(struct sdio_func *func)
  54 {
  55         struct wl1251 *wl = sdio_get_drvdata(func);
  56
  57         wl1251_debug(DEBUG_IRQ, "IRQ");
  58
  59         ieee80211_queue_work(wl->hw, &wl->irq_work);
  60 }
  61
  62 static const struct sdio_device_id wl1251_devices[] = {
  63         { SDIO_DEVICE(SDIO_VENDOR_ID_TI, SDIO_DEVICE_ID_TI_WL1251) },
  64         {}
  65 };
  66 MODULE_DEVICE_TABLE(sdio, wl1251_devices);
  67
  68
  69 static void wl1251_sdio_read(struct wl1251 *wl, int addr,
  70                              void *buf, size_t len)
  71 {
  72         int ret;
  73         struct sdio_func *func = wl_to_func(wl);
  74
  75         sdio_claim_host(func);
  76         ret = sdio_memcpy_fromio(func, buf, addr, len);
  77         if (ret)
  78                 wl1251_error("sdio read failed (%d)", ret);
  79         sdio_release_host(func);
  80 }
  81
  82 static void wl1251_sdio_write(struct wl1251 *wl, int addr,
  83                               void *buf, size_t len)
  84 {
  85         int ret;
  86         struct sdio_func *func = wl_to_func(wl);
  87
  88         sdio_claim_host(func);
  89         ret = sdio_memcpy_toio(func, addr, buf, len);
  90         if (ret)
  91                 wl1251_error("sdio write failed (%d)", ret);
  92         sdio_release_host(func);
  93 }
  94
  95 static void wl1251_sdio_read_elp(struct wl1251 *wl, int addr, u32 *val)
  96 {
  97         int ret = 0;
  98         struct wl1251_sdio *wl_sdio = wl->if_priv;
  99         struct sdio_func *func = wl_sdio->func;
 100
 101         /*
 102          * The hardware only supports RAW (read after write) access for
 103          * reading, regular sdio_readb won't work here (it interprets
 104          * the unused bits of CMD52 as write data even if we send read
 105          * request).
 106          */
 107         sdio_claim_host(func);
 108         *val = sdio_writeb_readb(func, wl_sdio->elp_val, addr, &ret);
 109         sdio_release_host(func);
 110
 111         if (ret)
 112                 wl1251_error("sdio_readb failed (%d)", ret);
 113 }
 114
 115 static void wl1251_sdio_write_elp(struct wl1251 *wl, int addr, u32 val)
 116 {
 117         int ret = 0;
 118         struct wl1251_sdio *wl_sdio = wl->if_priv;
 119         struct sdio_func *func = wl_sdio->func;
 120
 121         sdio_claim_host(func);
 122         sdio_writeb(func, val, addr, &ret);
 123         sdio_release_host(func);
 124
 125         if (ret)
 126                 wl1251_error("sdio_writeb failed (%d)", ret);
 127         else
 128                 wl_sdio->elp_val = val;
 129 }
 130
 131 static void wl1251_sdio_reset(struct wl1251 *wl)
 132 {
 133 }
 134
 135 static void wl1251_sdio_enable_irq(struct wl1251 *wl)
 136 {
 137         struct sdio_func *func = wl_to_func(wl);
 138
 139         sdio_claim_host(func);
 140         sdio_claim_irq(func, wl1251_sdio_interrupt);
 141         sdio_release_host(func);
 142 }
 143
 144 static void wl1251_sdio_disable_irq(struct wl1251 *wl)
 145 {
 146         struct sdio_func *func = wl_to_func(wl);
 147
 148         sdio_claim_host(func);
 149         sdio_release_irq(func);
 150         sdio_release_host(func);
 151 }
 152
 153 /* Interrupts when using dedicated WLAN_IRQ pin */
 154 static irqreturn_t wl1251_line_irq(int irq, void *cookie)
 155 {
 156         struct wl1251 *wl = cookie;
 157
 158         ieee80211_queue_work(wl->hw, &wl->irq_work);
 159
 160         return IRQ_HANDLED;
 161 }
 162
 163 static void wl1251_enable_line_irq(struct wl1251 *wl)
 164 {
 165         return enable_irq(wl->irq);
 166 }
 167
 168 static void wl1251_disable_line_irq(struct wl1251 *wl)
 169 {
 170         return disable_irq(wl->irq);
 171 }
 172
 173 static void wl1251_sdio_set_power(bool enable)
 174 {
 175 }
 176
 177 static struct wl1251_if_operations wl1251_sdio_ops = {
 178         .read = wl1251_sdio_read,
 179         .write = wl1251_sdio_write,
 180         .write_elp = wl1251_sdio_write_elp,
 181         .read_elp = wl1251_sdio_read_elp,
 182         .reset = wl1251_sdio_reset,
 183 };
 184
 185 static int wl1251_platform_probe(struct platform_device *pdev)
 186 {
 187         if (pdev->id != -1) {
 188                 wl1251_error("can only handle single device");
 189                 return -ENODEV;
 190         }
 191
 192         wl12xx_board_data = pdev->dev.platform_data;
 193         return 0;
 194 }
 195
 196 /*
 197  * Dummy platform_driver for passing platform_data to this driver,
 198  * until we have a way to pass this through SDIO subsystem or
 199  * some other way.
 200  */
 201 static struct platform_driver wl1251_platform_driver = {
 202         .driver = {
 203                 .name   = "wl1251_data",
 204                 .owner  = THIS_MODULE,
 205         },
 206         .probe  = wl1251_platform_probe,
 207 };
 208
 209 static int wl1251_sdio_probe(struct sdio_func *func,
 210                              const struct sdio_device_id *id)
 211 {
 212         int ret;
 213         struct wl1251 *wl;
 214         struct ieee80211_hw *hw;
 215         struct wl1251_sdio *wl_sdio;
 216
 217         hw = wl1251_alloc_hw();
 218         if (IS_ERR(hw))
 219                 return PTR_ERR(hw);
 220
 221         wl = hw->priv;
 222
 223         wl_sdio = kzalloc(sizeof(*wl_sdio), GFP_KERNEL);
 224         if (wl_sdio == NULL) {
 225                 ret = -ENOMEM;
 226                 goto out_free_hw;
 227         }
 228
 229         sdio_claim_host(func);
 230         ret = sdio_enable_func(func);
 231         if (ret)
 232                 goto release;
 233
 234         sdio_set_block_size(func, 512);
 235         sdio_release_host(func);
 236
 237         SET_IEEE80211_DEV(hw, &func->dev);
 238         wl_sdio->func = func;
 239         wl->if_priv = wl_sdio;
 240         wl->if_ops = &wl1251_sdio_ops;
 241         wl->set_power = wl1251_sdio_set_power;
 242
 243         if (wl12xx_board_data != NULL) {
 244                 wl->set_power = wl12xx_board_data->set_power;
 245                 wl->irq = wl12xx_board_data->irq;
 246                 wl->use_eeprom = wl12xx_board_data->use_eeprom;
 247         }
 248
 249         if (wl->irq) {
 250                 ret = request_irq(wl->irq, wl1251_line_irq, 0, "wl1251", wl);
 251                 if (ret < 0) {
 252                         wl1251_error("request_irq() failed: %d", ret);
 253                         goto disable;
 254                 }
 255
 256                 set_irq_type(wl->irq, IRQ_TYPE_EDGE_RISING);
 257                 disable_irq(wl->irq);
 258
 259                 wl1251_sdio_ops.enable_irq = wl1251_enable_line_irq;
 260                 wl1251_sdio_ops.disable_irq = wl1251_disable_line_irq;
 261
 262                 wl1251_info("using dedicated interrupt line");
 263         } else {
 264                 wl1251_sdio_ops.enable_irq = wl1251_sdio_enable_irq;
 265                 wl1251_sdio_ops.disable_irq = wl1251_sdio_disable_irq;
 266
 267                 wl1251_info("using SDIO interrupt");
 268         }
 269
 270         ret = wl1251_init_ieee80211(wl);
 271         if (ret)
 272                 goto out_free_irq;
 273
 274         sdio_set_drvdata(func, wl);
 275         return ret;
 276
 277 out_free_irq:
 278         if (wl->irq)
 279                 free_irq(wl->irq, wl);
 280 disable:
 281         sdio_claim_host(func);
 282         sdio_disable_func(func);
 283 release:
 284         sdio_release_host(func);
 285         kfree(wl_sdio);
 286 out_free_hw:
 287         wl1251_free_hw(wl);
 288         return ret;
 289 }
 290
 291 static void __devexit wl1251_sdio_remove(struct sdio_func *func)
 292 {
 293         struct wl1251 *wl = sdio_get_drvdata(func);
 294         struct wl1251_sdio *wl_sdio = wl->if_priv;
 295
 296         if (wl->irq)
 297                 free_irq(wl->irq, wl);
 298         kfree(wl_sdio);
 299         wl1251_free_hw(wl);
 300
 301         sdio_claim_host(func);
 302         sdio_release_irq(func);
 303         sdio_disable_func(func);
 304         sdio_release_host(func);
 305 }
 306
 307 static struct sdio_driver wl1251_sdio_driver = {
 308         .name           = "wl1251_sdio",
 309         .id_table       = wl1251_devices,
 310         .probe          = wl1251_sdio_probe,
 311         .remove         = __devexit_p(wl1251_sdio_remove),
 312 };
 313
 314 static int __init wl1251_sdio_init(void)
 315 {
 316         int err;
 317
 318         err = platform_driver_register(&wl1251_platform_driver);
 319         if (err) {
 320                 wl1251_error("failed to register platform driver: %d", err);
 321                 return err;
 322         }
 323
 324         err = sdio_register_driver(&wl1251_sdio_driver);
 325         if (err)
 326                 wl1251_error("failed to register sdio driver: %d", err);
 327         return err;
 328 }
 329
 330 static void __exit wl1251_sdio_exit(void)
 331 {
 332         sdio_unregister_driver(&wl1251_sdio_driver);
 333         platform_driver_unregister(&wl1251_platform_driver);
 334         wl1251_notice("unloaded");
 335 }
 336
 337 module_init(wl1251_sdio_init);
 338 module_exit(wl1251_sdio_exit);
 339
 340 MODULE_LICENSE("GPL");
 341 MODULE_AUTHOR("Kalle Valo <kalle.valo@nokia.com>");