drivers/mfd/tc6387xb.c

   1 /*
   2  * Toshiba TC6387XB support
   3  * Copyright (c) 2005 Ian Molton
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License version 2 as
   7  * published by the Free Software Foundation.
   8  *
   9  * This file contains TC6387XB base support.
  10  *
  11  */
  12
  13 #include <linux/module.h>
  14 #include <linux/platform_device.h>
  15 #include <linux/err.h>
  16 #include <linux/mfd/core.h>
  17 #include <linux/mfd/tmio.h>
  18 #include <linux/mfd/tc6387xb.h>
  19
  20 enum {
  21         TC6387XB_CELL_MMC,
  22 };
  23
  24 #ifdef CONFIG_PM
  25 static int tc6387xb_suspend(struct platform_device *dev, pm_message_t state)
  26 {
  27         struct tc6387xb_platform_data *pdata = platform_get_drvdata(dev);
  28
  29         if (pdata && pdata->suspend)
  30                 pdata->suspend(dev);
  31
  32         return 0;
  33 }
  34
  35 static int tc6387xb_resume(struct platform_device *dev)
  36 {
  37         struct tc6387xb_platform_data *pdata = platform_get_drvdata(dev);
  38
  39         if (pdata && pdata->resume)
  40                 pdata->resume(dev);
  41
  42         return 0;
  43 }
  44 #else
  45 #define tc6387xb_suspend  NULL
  46 #define tc6387xb_resume   NULL
  47 #endif
  48
  49 /*--------------------------------------------------------------------------*/
  50
  51 static int tc6387xb_mmc_enable(struct platform_device *mmc)
  52 {
  53         struct platform_device *dev      = to_platform_device(mmc->dev.parent);
  54         struct tc6387xb_platform_data *tc6387xb = dev->dev.platform_data;
  55
  56         if (tc6387xb->enable_clk32k)
  57                 tc6387xb->enable_clk32k(dev);
  58
  59         return 0;
  60 }
  61
  62 static int tc6387xb_mmc_disable(struct platform_device *mmc)
  63 {
  64         struct platform_device *dev      = to_platform_device(mmc->dev.parent);
  65         struct tc6387xb_platform_data *tc6387xb = dev->dev.platform_data;
  66
  67         if (tc6387xb->disable_clk32k)
  68                 tc6387xb->disable_clk32k(dev);
  69
  70         return 0;
  71 }
  72
  73 /*--------------------------------------------------------------------------*/
  74
  75 static struct resource tc6387xb_mmc_resources[] = {
  76         {
  77                 .start = 0x800,
  78                 .end   = 0x9ff,
  79                 .flags = IORESOURCE_MEM,
  80         },
  81         {
  82                 .start = 0x200,
  83                 .end   = 0x2ff,
  84                 .flags = IORESOURCE_MEM,
  85         },
  86         {
  87                 .start = 0,
  88                 .end   = 0,
  89                 .flags = IORESOURCE_IRQ,
  90         },
  91 };
  92
  93 static struct mfd_cell tc6387xb_cells[] = {
  94         [TC6387XB_CELL_MMC] = {
  95                 .name = "tmio-mmc",
  96                 .enable = tc6387xb_mmc_enable,
  97                 .disable = tc6387xb_mmc_disable,
  98                 .num_resources = ARRAY_SIZE(tc6387xb_mmc_resources),
  99                 .resources = tc6387xb_mmc_resources,
 100         },
 101 };
 102
 103 static int tc6387xb_probe(struct platform_device *dev)
 104 {
 105         struct tc6387xb_platform_data *data = platform_get_drvdata(dev);
 106         struct resource *iomem;
 107         int irq, ret;
 108
 109         iomem = platform_get_resource(dev, IORESOURCE_MEM, 0);
 110         if (!iomem) {
 111                 ret = -EINVAL;
 112                 goto err_resource;
 113         }
 114
 115         ret  = platform_get_irq(dev, 0);
 116         if (ret >= 0)
 117                 irq = ret;
 118         else
 119                 goto err_resource;
 120
 121         if (data && data->enable)
 122                 data->enable(dev);
 123
 124         printk(KERN_INFO "Toshiba tc6387xb initialised\n");
 125
 126         tc6387xb_cells[TC6387XB_CELL_MMC].platform_data =
 127                 &tc6387xb_cells[TC6387XB_CELL_MMC];
 128         tc6387xb_cells[TC6387XB_CELL_MMC].data_size =
 129                 sizeof(tc6387xb_cells[TC6387XB_CELL_MMC]);
 130
 131         ret = mfd_add_devices(&dev->dev, dev->id, tc6387xb_cells,
 132                               ARRAY_SIZE(tc6387xb_cells), iomem, irq);
 133
 134         if (!ret)
 135                 return 0;
 136
 137 err_resource:
 138         return ret;
 139 }
 140
 141 static int tc6387xb_remove(struct platform_device *dev)
 142 {
 143         struct tc6387xb_platform_data *data = platform_get_drvdata(dev);
 144
 145         if (data && data->disable)
 146                 data->disable(dev);
 147
 148         /* FIXME - free the resources! */
 149
 150         return 0;
 151 }
 152
 153
 154 static struct platform_driver tc6387xb_platform_driver = {
 155         .driver = {
 156                 .name           = "tc6387xb",
 157         },
 158         .probe          = tc6387xb_probe,
 159         .remove         = tc6387xb_remove,
 160         .suspend        = tc6387xb_suspend,
 161         .resume         = tc6387xb_resume,
 162 };
 163
 164
 165 static int __init tc6387xb_init(void)
 166 {
 167         return platform_driver_register(&tc6387xb_platform_driver);
 168 }
 169
 170 static void __exit tc6387xb_exit(void)
 171 {
 172         platform_driver_unregister(&tc6387xb_platform_driver);
 173 }
 174
 175 module_init(tc6387xb_init);
 176 module_exit(tc6387xb_exit);
 177
 178 MODULE_DESCRIPTION("Toshiba TC6387XB core driver");
 179 MODULE_LICENSE("GPL v2");
 180 MODULE_AUTHOR("Ian Molton");
 181 MODULE_ALIAS("platform:tc6387xb");