drivers/net/wireless/wl12xx/sdio.c

   1 /*
   2  * This file is part of wl1271
   3  *
   4  * Copyright (C) 2009-2010 Nokia Corporation
   5  *
   6  * Contact: Luciano Coelho <luciano.coelho@nokia.com>
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License
  10  * version 2 as published by the Free Software Foundation.
  11  *
  12  * This program is distributed in the hope that it will be useful, but
  13  * WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  15  * General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License
  18  * along with this program; if not, write to the Free Software
  19  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  20  * 02110-1301 USA
  21  *
  22  */
  23
  24 #include <linux/irq.h>
  25 #include <linux/module.h>
  26 #include <linux/vmalloc.h>
  27 #include <linux/platform_device.h>
  28 #include <linux/mmc/sdio_func.h>
  29 #include <linux/mmc/sdio_ids.h>
  30 #include <linux/mmc/card.h>
  31 #include <linux/mmc/host.h>
  32 #include <linux/gpio.h>
  33 #include <linux/wl12xx.h>
  34 #include <linux/pm_runtime.h>
  35
  36 #include "wl12xx.h"
  37 #include "wl12xx_80211.h"
  38 #include "io.h"
  39
  40 #ifndef SDIO_VENDOR_ID_TI
  41 #define SDIO_VENDOR_ID_TI               0x0097
  42 #endif
  43
  44 #ifndef SDIO_DEVICE_ID_TI_WL1271
  45 #define SDIO_DEVICE_ID_TI_WL1271        0x4076
  46 #endif
  47
  48 struct wl12xx_sdio_glue {
  49         struct device *dev;
  50         struct platform_device *core;
  51 };
  52
  53 static const struct sdio_device_id wl1271_devices[] __devinitconst = {
  54         { SDIO_DEVICE(SDIO_VENDOR_ID_TI, SDIO_DEVICE_ID_TI_WL1271) },
  55         {}
  56 };
  57 MODULE_DEVICE_TABLE(sdio, wl1271_devices);
  58
  59 static void wl1271_sdio_set_block_size(struct device *child,
  60                                        unsigned int blksz)
  61 {
  62         struct wl12xx_sdio_glue *glue = dev_get_drvdata(child->parent);
  63         struct sdio_func *func = dev_to_sdio_func(glue->dev);
  64
  65         sdio_claim_host(func);
  66         sdio_set_block_size(func, blksz);
  67         sdio_release_host(func);
  68 }
  69
  70 static void wl12xx_sdio_raw_read(struct device *child, int addr, void *buf,
  71                                  size_t len, bool fixed)
  72 {
  73         int ret;
  74         struct wl12xx_sdio_glue *glue = dev_get_drvdata(child->parent);
  75         struct sdio_func *func = dev_to_sdio_func(glue->dev);
  76
  77         if (unlikely(addr == HW_ACCESS_ELP_CTRL_REG_ADDR)) {
  78                 ((u8 *)buf)[0] = sdio_f0_readb(func, addr, &ret);
  79                 dev_dbg(child->parent, "sdio read 52 addr 0x%x, byte 0x%02x\n",
  80                         addr, ((u8 *)buf)[0]);
  81         } else {
  82                 if (fixed)
  83                         ret = sdio_readsb(func, buf, addr, len);
  84                 else
  85                         ret = sdio_memcpy_fromio(func, buf, addr, len);
  86
  87                 dev_dbg(child->parent, "sdio read 53 addr 0x%x, %zu bytes\n",
  88                         addr, len);
  89         }
  90
  91         if (ret)
  92                 dev_err(child->parent, "sdio read failed (%d)\n", ret);
  93 }
  94
  95 static void wl12xx_sdio_raw_write(struct device *child, int addr, void *buf,
  96                                   size_t len, bool fixed)
  97 {
  98         int ret;
  99         struct wl12xx_sdio_glue *glue = dev_get_drvdata(child->parent);
 100         struct sdio_func *func = dev_to_sdio_func(glue->dev);
 101
 102         if (unlikely(addr == HW_ACCESS_ELP_CTRL_REG_ADDR)) {
 103                 sdio_f0_writeb(func, ((u8 *)buf)[0], addr, &ret);
 104                 dev_dbg(child->parent, "sdio write 52 addr 0x%x, byte 0x%02x\n",
 105                         addr, ((u8 *)buf)[0]);
 106         } else {
 107                 dev_dbg(child->parent, "sdio write 53 addr 0x%x, %zu bytes\n",
 108                         addr, len);
 109
 110                 if (fixed)
 111                         ret = sdio_writesb(func, addr, buf, len);
 112                 else
 113                         ret = sdio_memcpy_toio(func, addr, buf, len);
 114         }
 115
 116         if (ret)
 117                 dev_err(child->parent, "sdio write failed (%d)\n", ret);
 118 }
 119
 120 static int wl12xx_sdio_power_on(struct wl12xx_sdio_glue *glue)
 121 {
 122         int ret;
 123         struct sdio_func *func = dev_to_sdio_func(glue->dev);
 124
 125         /* If enabled, tell runtime PM not to power off the card */
 126         if (pm_runtime_enabled(&func->dev)) {
 127                 ret = pm_runtime_get_sync(&func->dev);
 128                 if (ret < 0)
 129                         goto out;
 130         } else {
 131                 /* Runtime PM is disabled: power up the card manually */
 132                 ret = mmc_power_restore_host(func->card->host);
 133                 if (ret < 0)
 134                         goto out;
 135         }
 136
 137         sdio_claim_host(func);
 138         sdio_enable_func(func);
 139
 140 out:
 141         return ret;
 142 }
 143
 144 static int wl12xx_sdio_power_off(struct wl12xx_sdio_glue *glue)
 145 {
 146         int ret;
 147         struct sdio_func *func = dev_to_sdio_func(glue->dev);
 148
 149         sdio_disable_func(func);
 150         sdio_release_host(func);
 151
 152         /* Power off the card manually, even if runtime PM is enabled. */
 153         ret = mmc_power_save_host(func->card->host);
 154         if (ret < 0)
 155                 return ret;
 156
 157         /* If enabled, let runtime PM know the card is powered off */
 158         if (pm_runtime_enabled(&func->dev))
 159                 ret = pm_runtime_put_sync(&func->dev);
 160
 161         return ret;
 162 }
 163
 164 static int wl12xx_sdio_set_power(struct device *child, bool enable)
 165 {
 166         struct wl12xx_sdio_glue *glue = dev_get_drvdata(child->parent);
 167
 168         if (enable)
 169                 return wl12xx_sdio_power_on(glue);
 170         else
 171                 return wl12xx_sdio_power_off(glue);
 172 }
 173
 174 static struct wl1271_if_operations sdio_ops = {
 175         .read           = wl12xx_sdio_raw_read,
 176         .write          = wl12xx_sdio_raw_write,
 177         .power          = wl12xx_sdio_set_power,
 178         .set_block_size = wl1271_sdio_set_block_size,
 179 };
 180
 181 static int __devinit wl1271_probe(struct sdio_func *func,
 182                                   const struct sdio_device_id *id)
 183 {
 184         struct wl12xx_platform_data *wlan_data;
 185         struct wl12xx_sdio_glue *glue;
 186         struct resource res[1];
 187         mmc_pm_flag_t mmcflags;
 188         int ret = -ENOMEM;
 189
 190         /* We are only able to handle the wlan function */
 191         if (func->num != 0x02)
 192                 return -ENODEV;
 193
 194         glue = kzalloc(sizeof(*glue), GFP_KERNEL);
 195         if (!glue) {
 196                 dev_err(&func->dev, "can't allocate glue\n");
 197                 goto out;
 198         }
 199
 200         glue->dev = &func->dev;
 201
 202         /* Grab access to FN0 for ELP reg. */
 203         func->card->quirks |= MMC_QUIRK_LENIENT_FN0;
 204
 205         /* Use block mode for transferring over one block size of data */
 206         func->card->quirks |= MMC_QUIRK_BLKSZ_FOR_BYTE_MODE;
 207
 208         wlan_data = wl12xx_get_platform_data();
 209         if (IS_ERR(wlan_data)) {
 210                 ret = PTR_ERR(wlan_data);
 211                 dev_err(glue->dev, "missing wlan platform data: %d\n", ret);
 212                 goto out_free_glue;
 213         }
 214
 215         /* if sdio can keep power while host is suspended, enable wow */
 216         mmcflags = sdio_get_host_pm_caps(func);
 217         dev_dbg(glue->dev, "sdio PM caps = 0x%x\n", mmcflags);
 218
 219         if (mmcflags & MMC_PM_KEEP_POWER)
 220                 wlan_data->pwr_in_suspend = true;
 221
 222         wlan_data->ops = &sdio_ops;
 223
 224         sdio_set_drvdata(func, glue);
 225
 226         /* Tell PM core that we don't need the card to be powered now */
 227         pm_runtime_put_noidle(&func->dev);
 228
 229         glue->core = platform_device_alloc("wl12xx", -1);
 230         if (!glue->core) {
 231                 dev_err(glue->dev, "can't allocate platform_device");
 232                 ret = -ENOMEM;
 233                 goto out_free_glue;
 234         }
 235
 236         glue->core->dev.parent = &func->dev;
 237
 238         memset(res, 0x00, sizeof(res));
 239
 240         res[0].start = wlan_data->irq;
 241         res[0].flags = IORESOURCE_IRQ;
 242         res[0].name = "irq";
 243
 244         ret = platform_device_add_resources(glue->core, res, ARRAY_SIZE(res));
 245         if (ret) {
 246                 dev_err(glue->dev, "can't add resources\n");
 247                 goto out_dev_put;
 248         }
 249
 250         ret = platform_device_add_data(glue->core, wlan_data,
 251                                        sizeof(*wlan_data));
 252         if (ret) {
 253                 dev_err(glue->dev, "can't add platform data\n");
 254                 goto out_dev_put;
 255         }
 256
 257         ret = platform_device_add(glue->core);
 258         if (ret) {
 259                 dev_err(glue->dev, "can't add platform device\n");
 260                 goto out_dev_put;
 261         }
 262         return 0;
 263
 264 out_dev_put:
 265         platform_device_put(glue->core);
 266
 267 out_free_glue:
 268         kfree(glue);
 269
 270 out:
 271         return ret;
 272 }
 273
 274 static void __devexit wl1271_remove(struct sdio_func *func)
 275 {
 276         struct wl12xx_sdio_glue *glue = sdio_get_drvdata(func);
 277
 278         /* Undo decrement done above in wl1271_probe */
 279         pm_runtime_get_noresume(&func->dev);
 280
 281         platform_device_del(glue->core);
 282         platform_device_put(glue->core);
 283         kfree(glue);
 284 }
 285
 286 #ifdef CONFIG_PM
 287 static int wl1271_suspend(struct device *dev)
 288 {
 289         /* Tell MMC/SDIO core it's OK to power down the card
 290          * (if it isn't already), but not to remove it completely */
 291         struct sdio_func *func = dev_to_sdio_func(dev);
 292         struct wl12xx_sdio_glue *glue = sdio_get_drvdata(func);
 293         struct wl1271 *wl = platform_get_drvdata(glue->core);
 294         mmc_pm_flag_t sdio_flags;
 295         int ret = 0;
 296
 297         dev_dbg(dev, "wl1271 suspend. wow_enabled: %d\n",
 298                 wl->wow_enabled);
 299
 300         /* check whether sdio should keep power */
 301         if (wl->wow_enabled) {
 302                 sdio_flags = sdio_get_host_pm_caps(func);
 303
 304                 if (!(sdio_flags & MMC_PM_KEEP_POWER)) {
 305                         dev_err(dev, "can't keep power while host "
 306                                      "is suspended\n");
 307                         ret = -EINVAL;
 308                         goto out;
 309                 }
 310
 311                 /* keep power while host suspended */
 312                 ret = sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER);
 313                 if (ret) {
 314                         dev_err(dev, "error while trying to keep power\n");
 315                         goto out;
 316                 }
 317
 318                 /* release host */
 319                 sdio_release_host(func);
 320         }
 321 out:
 322         return ret;
 323 }
 324
 325 static int wl1271_resume(struct device *dev)
 326 {
 327         struct sdio_func *func = dev_to_sdio_func(dev);
 328         struct wl12xx_sdio_glue *glue = sdio_get_drvdata(func);
 329         struct wl1271 *wl = platform_get_drvdata(glue->core);
 330
 331         dev_dbg(dev, "wl1271 resume\n");
 332         if (wl->wow_enabled) {
 333                 /* claim back host */
 334                 sdio_claim_host(func);
 335         }
 336
 337         return 0;
 338 }
 339
 340 static const struct dev_pm_ops wl1271_sdio_pm_ops = {
 341         .suspend        = wl1271_suspend,
 342         .resume         = wl1271_resume,
 343 };
 344 #endif
 345
 346 static struct sdio_driver wl1271_sdio_driver = {
 347         .name           = "wl1271_sdio",
 348         .id_table       = wl1271_devices,
 349         .probe          = wl1271_probe,
 350         .remove         = __devexit_p(wl1271_remove),
 351 #ifdef CONFIG_PM
 352         .drv = {
 353                 .pm = &wl1271_sdio_pm_ops,
 354         },
 355 #endif
 356 };
 357
 358 static int __init wl1271_init(void)
 359 {
 360         return sdio_register_driver(&wl1271_sdio_driver);
 361 }
 362
 363 static void __exit wl1271_exit(void)
 364 {
 365         sdio_unregister_driver(&wl1271_sdio_driver);
 366 }
 367
 368 module_init(wl1271_init);
 369 module_exit(wl1271_exit);
 370
 371 MODULE_LICENSE("GPL");
 372 MODULE_AUTHOR("Luciano Coelho <coelho@ti.com>");
 373 MODULE_AUTHOR("Juuso Oikarinen <juuso.oikarinen@nokia.com>");
 374 MODULE_FIRMWARE(WL127X_FW_NAME);
 375 MODULE_FIRMWARE(WL128X_FW_NAME);