drivers/mfd/tc6387xb.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Toshiba TC6387XB support
   4  * Copyright (c) 2005 Ian Molton
   5  *
   6  * This file contains TC6387XB base support.
   7  */
   8
   9 #include <linux/module.h>
  10 #include <linux/platform_device.h>
  11 #include <linux/clk.h>
  12 #include <linux/err.h>
  13 #include <linux/mfd/core.h>
  14 #include <linux/mfd/tmio.h>
  15 #include <linux/mfd/tc6387xb.h>
  16 #include <linux/slab.h>
  17
  18 enum {
  19         TC6387XB_CELL_MMC,
  20 };
  21
  22 struct tc6387xb {
  23         void __iomem *scr;
  24         struct clk *clk32k;
  25         struct resource rscr;
  26 };
  27
  28 static const struct resource tc6387xb_mmc_resources[] = {
  29         {
  30                 .start = 0x800,
  31                 .end   = 0x9ff,
  32                 .flags = IORESOURCE_MEM,
  33         },
  34         {
  35                 .start = 0,
  36                 .end   = 0,
  37                 .flags = IORESOURCE_IRQ,
  38         },
  39 };
  40
  41 /*--------------------------------------------------------------------------*/
  42
  43 static int tc6387xb_suspend(struct platform_device *dev, pm_message_t state)
  44 {
  45         struct tc6387xb *tc6387xb = platform_get_drvdata(dev);
  46         struct tc6387xb_platform_data *pdata = dev_get_platdata(&dev->dev);
  47
  48         if (pdata && pdata->suspend)
  49                 pdata->suspend(dev);
  50         clk_disable_unprepare(tc6387xb->clk32k);
  51
  52         return 0;
  53 }
  54
  55 static int tc6387xb_resume(struct platform_device *dev)
  56 {
  57         struct tc6387xb *tc6387xb = platform_get_drvdata(dev);
  58         struct tc6387xb_platform_data *pdata = dev_get_platdata(&dev->dev);
  59
  60         clk_prepare_enable(tc6387xb->clk32k);
  61         if (pdata && pdata->resume)
  62                 pdata->resume(dev);
  63
  64         tmio_core_mmc_resume(tc6387xb->scr + 0x200, 0,
  65                 tc6387xb_mmc_resources[0].start & 0xfffe);
  66
  67         return 0;
  68 }
  69
  70 /*--------------------------------------------------------------------------*/
  71
  72 static void tc6387xb_mmc_pwr(struct platform_device *mmc, int state)
  73 {
  74         struct tc6387xb *tc6387xb = dev_get_drvdata(mmc->dev.parent);
  75
  76         tmio_core_mmc_pwr(tc6387xb->scr + 0x200, 0, state);
  77 }
  78
  79 static void tc6387xb_mmc_clk_div(struct platform_device *mmc, int state)
  80 {
  81         struct tc6387xb *tc6387xb = dev_get_drvdata(mmc->dev.parent);
  82
  83         tmio_core_mmc_clk_div(tc6387xb->scr + 0x200, 0, state);
  84 }
  85
  86
  87 static int tc6387xb_mmc_enable(struct platform_device *mmc)
  88 {
  89         struct tc6387xb *tc6387xb = dev_get_drvdata(mmc->dev.parent);
  90
  91         clk_prepare_enable(tc6387xb->clk32k);
  92
  93         tmio_core_mmc_enable(tc6387xb->scr + 0x200, 0,
  94                 tc6387xb_mmc_resources[0].start & 0xfffe);
  95
  96         return 0;
  97 }
  98
  99 static int tc6387xb_mmc_disable(struct platform_device *mmc)
 100 {
 101         struct tc6387xb *tc6387xb = dev_get_drvdata(mmc->dev.parent);
 102
 103         clk_disable_unprepare(tc6387xb->clk32k);
 104
 105         return 0;
 106 }
 107
 108 static struct tmio_mmc_data tc6387xb_mmc_data = {
 109         .hclk = 24000000,
 110         .set_pwr = tc6387xb_mmc_pwr,
 111         .set_clk_div = tc6387xb_mmc_clk_div,
 112 };
 113
 114 /*--------------------------------------------------------------------------*/
 115
 116 static const struct mfd_cell tc6387xb_cells[] = {
 117         [TC6387XB_CELL_MMC] = {
 118                 .name = "tmio-mmc",
 119                 .enable = tc6387xb_mmc_enable,
 120                 .disable = tc6387xb_mmc_disable,
 121                 .platform_data = &tc6387xb_mmc_data,
 122                 .pdata_size    = sizeof(tc6387xb_mmc_data),
 123                 .num_resources = ARRAY_SIZE(tc6387xb_mmc_resources),
 124                 .resources = tc6387xb_mmc_resources,
 125         },
 126 };
 127
 128 static int tc6387xb_probe(struct platform_device *dev)
 129 {
 130         struct tc6387xb_platform_data *pdata = dev_get_platdata(&dev->dev);
 131         struct resource *iomem, *rscr;
 132         struct clk *clk32k;
 133         struct tc6387xb *tc6387xb;
 134         int irq, ret;
 135
 136         iomem = platform_get_resource(dev, IORESOURCE_MEM, 0);
 137         if (!iomem)
 138                 return -EINVAL;
 139
 140         tc6387xb = kzalloc(sizeof(*tc6387xb), GFP_KERNEL);
 141         if (!tc6387xb)
 142                 return -ENOMEM;
 143
 144         ret  = platform_get_irq(dev, 0);
 145         if (ret >= 0)
 146                 irq = ret;
 147         else
 148                 goto err_no_irq;
 149
 150         clk32k = clk_get(&dev->dev, "CLK_CK32K");
 151         if (IS_ERR(clk32k)) {
 152                 ret = PTR_ERR(clk32k);
 153                 goto err_no_clk;
 154         }
 155
 156         rscr = &tc6387xb->rscr;
 157         rscr->name = "tc6387xb-core";
 158         rscr->start = iomem->start;
 159         rscr->end = iomem->start + 0xff;
 160         rscr->flags = IORESOURCE_MEM;
 161
 162         ret = request_resource(iomem, rscr);
 163         if (ret)
 164                 goto err_resource;
 165
 166         tc6387xb->scr = ioremap(rscr->start, resource_size(rscr));
 167         if (!tc6387xb->scr) {
 168                 ret = -ENOMEM;
 169                 goto err_ioremap;
 170         }
 171
 172         tc6387xb->clk32k = clk32k;
 173         platform_set_drvdata(dev, tc6387xb);
 174
 175         if (pdata && pdata->enable)
 176                 pdata->enable(dev);
 177
 178         dev_info(&dev->dev, "Toshiba tc6387xb initialised\n");
 179
 180         ret = mfd_add_devices(&dev->dev, dev->id, tc6387xb_cells,
 181                               ARRAY_SIZE(tc6387xb_cells), iomem, irq, NULL);
 182
 183         if (!ret)
 184                 return 0;
 185
 186         iounmap(tc6387xb->scr);
 187 err_ioremap:
 188         release_resource(&tc6387xb->rscr);
 189 err_resource:
 190         clk_put(clk32k);
 191 err_no_clk:
 192 err_no_irq:
 193         kfree(tc6387xb);
 194         return ret;
 195 }
 196
 197 static int tc6387xb_remove(struct platform_device *dev)
 198 {
 199         struct tc6387xb *tc6387xb = platform_get_drvdata(dev);
 200
 201         mfd_remove_devices(&dev->dev);
 202         iounmap(tc6387xb->scr);
 203         release_resource(&tc6387xb->rscr);
 204         clk_disable_unprepare(tc6387xb->clk32k);
 205         clk_put(tc6387xb->clk32k);
 206         kfree(tc6387xb);
 207
 208         return 0;
 209 }
 210
 211
 212 static struct platform_driver tc6387xb_platform_driver = {
 213         .driver = {
 214                 .name           = "tc6387xb",
 215         },
 216         .probe          = tc6387xb_probe,
 217         .remove         = tc6387xb_remove,
 218         .suspend        = pm_sleep_ptr(tc6387xb_suspend),
 219         .resume         = pm_sleep_ptr(tc6387xb_resume),
 220 };
 221
 222 module_platform_driver(tc6387xb_platform_driver);
 223
 224 MODULE_DESCRIPTION("Toshiba TC6387XB core driver");
 225 MODULE_LICENSE("GPL v2");
 226 MODULE_AUTHOR("Ian Molton");
 227 MODULE_ALIAS("platform:tc6387xb");
 228