drivers/net/wireless/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/wl12xx.h>
  28 #include <linux/irq.h>
  29 #include <linux/pm_runtime.h>
  30
  31 #include "wl1251.h"
  32
  33 #ifndef SDIO_VENDOR_ID_TI
  34 #define SDIO_VENDOR_ID_TI               0x104c
  35 #endif
  36
  37 #ifndef SDIO_DEVICE_ID_TI_WL1251
  38 #define SDIO_DEVICE_ID_TI_WL1251        0x9066
  39 #endif
  40
  41 struct wl1251_sdio {
  42         struct sdio_func *func;
  43         u32 elp_val;
  44 };
  45
  46 static struct wl12xx_platform_data *wl12xx_board_data;
  47
  48 static struct sdio_func *wl_to_func(struct wl1251 *wl)
  49 {
  50         struct wl1251_sdio *wl_sdio = wl->if_priv;
  51         return wl_sdio->func;
  52 }
  53
  54 static void wl1251_sdio_interrupt(struct sdio_func *func)
  55 {
  56         struct wl1251 *wl = sdio_get_drvdata(func);
  57
  58         wl1251_debug(DEBUG_IRQ, "IRQ");
  59
  60         /* FIXME should be synchronous for sdio */
  61         ieee80211_queue_work(wl->hw, &wl->irq_work);
  62 }
  63
  64 static const struct sdio_device_id wl1251_devices[] = {
  65         { SDIO_DEVICE(SDIO_VENDOR_ID_TI, SDIO_DEVICE_ID_TI_WL1251) },
  66         {}
  67 };
  68 MODULE_DEVICE_TABLE(sdio, wl1251_devices);
  69
  70
  71 static void wl1251_sdio_read(struct wl1251 *wl, int addr,
  72                              void *buf, size_t len)
  73 {
  74         int ret;
  75         struct sdio_func *func = wl_to_func(wl);
  76
  77         sdio_claim_host(func);
  78         ret = sdio_memcpy_fromio(func, buf, addr, len);
  79         if (ret)
  80                 wl1251_error("sdio read failed (%d)", ret);
  81         sdio_release_host(func);
  82 }
  83
  84 static void wl1251_sdio_write(struct wl1251 *wl, int addr,
  85                               void *buf, size_t len)
  86 {
  87         int ret;
  88         struct sdio_func *func = wl_to_func(wl);
  89
  90         sdio_claim_host(func);
  91         ret = sdio_memcpy_toio(func, addr, buf, len);
  92         if (ret)
  93                 wl1251_error("sdio write failed (%d)", ret);
  94         sdio_release_host(func);
  95 }
  96
  97 static void wl1251_sdio_read_elp(struct wl1251 *wl, int addr, u32 *val)
  98 {
  99         int ret = 0;
 100         struct wl1251_sdio *wl_sdio = wl->if_priv;
 101         struct sdio_func *func = wl_sdio->func;
 102
 103         /*
 104          * The hardware only supports RAW (read after write) access for
 105          * reading, regular sdio_readb won't work here (it interprets
 106          * the unused bits of CMD52 as write data even if we send read
 107          * request).
 108          */
 109         sdio_claim_host(func);
 110         *val = sdio_writeb_readb(func, wl_sdio->elp_val, addr, &ret);
 111         sdio_release_host(func);
 112
 113         if (ret)
 114                 wl1251_error("sdio_readb failed (%d)", ret);
 115 }
 116
 117 static void wl1251_sdio_write_elp(struct wl1251 *wl, int addr, u32 val)
 118 {
 119         int ret = 0;
 120         struct wl1251_sdio *wl_sdio = wl->if_priv;
 121         struct sdio_func *func = wl_sdio->func;
 122
 123         sdio_claim_host(func);
 124         sdio_writeb(func, val, addr, &ret);
 125         sdio_release_host(func);
 126
 127         if (ret)
 128                 wl1251_error("sdio_writeb failed (%d)", ret);
 129         else
 130                 wl_sdio->elp_val = val;
 131 }
 132
 133 static void wl1251_sdio_reset(struct wl1251 *wl)
 134 {
 135 }
 136
 137 static void wl1251_sdio_enable_irq(struct wl1251 *wl)
 138 {
 139         struct sdio_func *func = wl_to_func(wl);
 140
 141         sdio_claim_host(func);
 142         sdio_claim_irq(func, wl1251_sdio_interrupt);
 143         sdio_release_host(func);
 144 }
 145
 146 static void wl1251_sdio_disable_irq(struct wl1251 *wl)
 147 {
 148         struct sdio_func *func = wl_to_func(wl);
 149
 150         sdio_claim_host(func);
 151         sdio_release_irq(func);
 152         sdio_release_host(func);
 153 }
 154
 155 /* Interrupts when using dedicated WLAN_IRQ pin */
 156 static irqreturn_t wl1251_line_irq(int irq, void *cookie)
 157 {
 158         struct wl1251 *wl = cookie;
 159
 160         ieee80211_queue_work(wl->hw, &wl->irq_work);
 161
 162         return IRQ_HANDLED;
 163 }
 164
 165 static void wl1251_enable_line_irq(struct wl1251 *wl)
 166 {
 167         return enable_irq(wl->irq);
 168 }
 169
 170 static void wl1251_disable_line_irq(struct wl1251 *wl)
 171 {
 172         return disable_irq(wl->irq);
 173 }
 174
 175 static int wl1251_sdio_set_power(struct wl1251 *wl, bool enable)
 176 {
 177         struct sdio_func *func = wl_to_func(wl);
 178         int ret;
 179
 180         if (enable) {
 181                 /*
 182                  * Power is controlled by runtime PM, but we still call board
 183                  * callback in case it wants to do any additional setup,
 184                  * for example enabling clock buffer for the module.
 185                  */
 186                 if (wl->set_power)
 187                         wl->set_power(true);
 188
 189                 ret = pm_runtime_get_sync(&func->dev);
 190                 if (ret < 0)
 191                         goto out;
 192
 193                 sdio_claim_host(func);
 194                 sdio_enable_func(func);
 195                 sdio_release_host(func);
 196         } else {
 197                 sdio_claim_host(func);
 198                 sdio_disable_func(func);
 199                 sdio_release_host(func);
 200
 201                 ret = pm_runtime_put_sync(&func->dev);
 202                 if (ret < 0)
 203                         goto out;
 204
 205                 if (wl->set_power)
 206                         wl->set_power(false);
 207         }
 208
 209 out:
 210         return ret;
 211 }
 212
 213 static struct wl1251_if_operations wl1251_sdio_ops = {
 214         .read = wl1251_sdio_read,
 215         .write = wl1251_sdio_write,
 216         .write_elp = wl1251_sdio_write_elp,
 217         .read_elp = wl1251_sdio_read_elp,
 218         .reset = wl1251_sdio_reset,
 219         .power = wl1251_sdio_set_power,
 220 };
 221
 222 static int wl1251_platform_probe(struct platform_device *pdev)
 223 {
 224         if (pdev->id != -1) {
 225                 wl1251_error("can only handle single device");
 226                 return -ENODEV;
 227         }
 228
 229         wl12xx_board_data = pdev->dev.platform_data;
 230         return 0;
 231 }
 232
 233 /*
 234  * Dummy platform_driver for passing platform_data to this driver,
 235  * until we have a way to pass this through SDIO subsystem or
 236  * some other way.
 237  */
 238 static struct platform_driver wl1251_platform_driver = {
 239         .driver = {
 240                 .name   = "wl1251_data",
 241                 .owner  = THIS_MODULE,
 242         },
 243         .probe  = wl1251_platform_probe,
 244 };
 245
 246 static int wl1251_sdio_probe(struct sdio_func *func,
 247                              const struct sdio_device_id *id)
 248 {
 249         int ret;
 250         struct wl1251 *wl;
 251         struct ieee80211_hw *hw;
 252         struct wl1251_sdio *wl_sdio;
 253
 254         hw = wl1251_alloc_hw();
 255         if (IS_ERR(hw))
 256                 return PTR_ERR(hw);
 257
 258         wl = hw->priv;
 259
 260         wl_sdio = kzalloc(sizeof(*wl_sdio), GFP_KERNEL);
 261         if (wl_sdio == NULL) {
 262                 ret = -ENOMEM;
 263                 goto out_free_hw;
 264         }
 265
 266         sdio_claim_host(func);
 267         ret = sdio_enable_func(func);
 268         if (ret)
 269                 goto release;
 270
 271         sdio_set_block_size(func, 512);
 272         sdio_release_host(func);
 273
 274         SET_IEEE80211_DEV(hw, &func->dev);
 275         wl_sdio->func = func;
 276         wl->if_priv = wl_sdio;
 277         wl->if_ops = &wl1251_sdio_ops;
 278
 279         if (wl12xx_board_data != NULL) {
 280                 wl->set_power = wl12xx_board_data->set_power;
 281                 wl->irq = wl12xx_board_data->irq;
 282                 wl->use_eeprom = wl12xx_board_data->use_eeprom;
 283         }
 284
 285         if (wl->irq) {
 286                 ret = request_irq(wl->irq, wl1251_line_irq, 0, "wl1251", wl);
 287                 if (ret < 0) {
 288                         wl1251_error("request_irq() failed: %d", ret);
 289                         goto disable;
 290                 }
 291
 292                 set_irq_type(wl->irq, IRQ_TYPE_EDGE_RISING);
 293                 disable_irq(wl->irq);
 294
 295                 wl1251_sdio_ops.enable_irq = wl1251_enable_line_irq;
 296                 wl1251_sdio_ops.disable_irq = wl1251_disable_line_irq;
 297
 298                 wl1251_info("using dedicated interrupt line");
 299         } else {
 300                 wl1251_sdio_ops.enable_irq = wl1251_sdio_enable_irq;
 301                 wl1251_sdio_ops.disable_irq = wl1251_sdio_disable_irq;
 302
 303                 wl1251_info("using SDIO interrupt");
 304         }
 305
 306         ret = wl1251_init_ieee80211(wl);
 307         if (ret)
 308                 goto out_free_irq;
 309
 310         sdio_set_drvdata(func, wl);
 311
 312         /* Tell PM core that we don't need the card to be powered now */
 313         pm_runtime_put_noidle(&func->dev);
 314
 315         return ret;
 316
 317 out_free_irq:
 318         if (wl->irq)
 319                 free_irq(wl->irq, wl);
 320 disable:
 321         sdio_claim_host(func);
 322         sdio_disable_func(func);
 323 release:
 324         sdio_release_host(func);
 325         kfree(wl_sdio);
 326 out_free_hw:
 327         wl1251_free_hw(wl);
 328         return ret;
 329 }
 330
 331 static void __devexit wl1251_sdio_remove(struct sdio_func *func)
 332 {
 333         struct wl1251 *wl = sdio_get_drvdata(func);
 334         struct wl1251_sdio *wl_sdio = wl->if_priv;
 335
 336         /* Undo decrement done above in wl1251_probe */
 337         pm_runtime_get_noresume(&func->dev);
 338
 339         if (wl->irq)
 340                 free_irq(wl->irq, wl);
 341         kfree(wl_sdio);
 342         wl1251_free_hw(wl);
 343
 344         sdio_claim_host(func);
 345         sdio_release_irq(func);
 346         sdio_disable_func(func);
 347         sdio_release_host(func);
 348 }
 349
 350 static int wl1251_suspend(struct device *dev)
 351 {
 352         /*
 353          * Tell MMC/SDIO core it's OK to power down the card
 354          * (if it isn't already), but not to remove it completely.
 355          */
 356         return 0;
 357 }
 358
 359 static int wl1251_resume(struct device *dev)
 360 {
 361         return 0;
 362 }
 363
 364 static const struct dev_pm_ops wl1251_sdio_pm_ops = {
 365         .suspend        = wl1251_suspend,
 366         .resume         = wl1251_resume,
 367 };
 368
 369 static struct sdio_driver wl1251_sdio_driver = {
 370         .name           = "wl1251_sdio",
 371         .id_table       = wl1251_devices,
 372         .probe          = wl1251_sdio_probe,
 373         .remove         = __devexit_p(wl1251_sdio_remove),
 374         .drv.pm         = &wl1251_sdio_pm_ops,
 375 };
 376
 377 static int __init wl1251_sdio_init(void)
 378 {
 379         int err;
 380
 381         err = platform_driver_register(&wl1251_platform_driver);
 382         if (err) {
 383                 wl1251_error("failed to register platform driver: %d", err);
 384                 return err;
 385         }
 386
 387         err = sdio_register_driver(&wl1251_sdio_driver);
 388         if (err)
 389                 wl1251_error("failed to register sdio driver: %d", err);
 390         return err;
 391 }
 392
 393 static void __exit wl1251_sdio_exit(void)
 394 {
 395         sdio_unregister_driver(&wl1251_sdio_driver);
 396         platform_driver_unregister(&wl1251_platform_driver);
 397         wl1251_notice("unloaded");
 398 }
 399
 400 module_init(wl1251_sdio_init);
 401 module_exit(wl1251_sdio_exit);
 402
 403 MODULE_LICENSE("GPL");
 404 MODULE_AUTHOR("Kalle Valo <kvalo@adurom.com>");