Back to home page

OSCL-LXR
 
 

     

0001 // SPDX-License-Identifier: GPL-2.0-only
0002 /*
0003  * Toshiba TC6387XB support
0004  * Copyright (c) 2005 Ian Molton
0005  *
0006  * This file contains TC6387XB base support.
0007  */
0008 
0009 #include <linux/module.h>
0010 #include <linux/platform_device.h>
0011 #include <linux/clk.h>
0012 #include <linux/err.h>
0013 #include <linux/mfd/core.h>
0014 #include <linux/mfd/tmio.h>
0015 #include <linux/mfd/tc6387xb.h>
0016 #include <linux/slab.h>
0017 
0018 enum {
0019     TC6387XB_CELL_MMC,
0020 };
0021 
0022 struct tc6387xb {
0023     void __iomem *scr;
0024     struct clk *clk32k;
0025     struct resource rscr;
0026 };
0027 
0028 static const struct resource tc6387xb_mmc_resources[] = {
0029     {
0030         .start = 0x800,
0031         .end   = 0x9ff,
0032         .flags = IORESOURCE_MEM,
0033     },
0034     {
0035         .start = 0,
0036         .end   = 0,
0037         .flags = IORESOURCE_IRQ,
0038     },
0039 };
0040 
0041 /*--------------------------------------------------------------------------*/
0042 
0043 #ifdef CONFIG_PM
0044 static int tc6387xb_suspend(struct platform_device *dev, pm_message_t state)
0045 {
0046     struct tc6387xb *tc6387xb = platform_get_drvdata(dev);
0047     struct tc6387xb_platform_data *pdata = dev_get_platdata(&dev->dev);
0048 
0049     if (pdata && pdata->suspend)
0050         pdata->suspend(dev);
0051     clk_disable_unprepare(tc6387xb->clk32k);
0052 
0053     return 0;
0054 }
0055 
0056 static int tc6387xb_resume(struct platform_device *dev)
0057 {
0058     struct tc6387xb *tc6387xb = platform_get_drvdata(dev);
0059     struct tc6387xb_platform_data *pdata = dev_get_platdata(&dev->dev);
0060 
0061     clk_prepare_enable(tc6387xb->clk32k);
0062     if (pdata && pdata->resume)
0063         pdata->resume(dev);
0064 
0065     tmio_core_mmc_resume(tc6387xb->scr + 0x200, 0,
0066         tc6387xb_mmc_resources[0].start & 0xfffe);
0067 
0068     return 0;
0069 }
0070 #else
0071 #define tc6387xb_suspend  NULL
0072 #define tc6387xb_resume   NULL
0073 #endif
0074 
0075 /*--------------------------------------------------------------------------*/
0076 
0077 static void tc6387xb_mmc_pwr(struct platform_device *mmc, int state)
0078 {
0079     struct tc6387xb *tc6387xb = dev_get_drvdata(mmc->dev.parent);
0080 
0081     tmio_core_mmc_pwr(tc6387xb->scr + 0x200, 0, state);
0082 }
0083 
0084 static void tc6387xb_mmc_clk_div(struct platform_device *mmc, int state)
0085 {
0086     struct tc6387xb *tc6387xb = dev_get_drvdata(mmc->dev.parent);
0087 
0088     tmio_core_mmc_clk_div(tc6387xb->scr + 0x200, 0, state);
0089 }
0090 
0091 
0092 static int tc6387xb_mmc_enable(struct platform_device *mmc)
0093 {
0094     struct tc6387xb *tc6387xb = dev_get_drvdata(mmc->dev.parent);
0095 
0096     clk_prepare_enable(tc6387xb->clk32k);
0097 
0098     tmio_core_mmc_enable(tc6387xb->scr + 0x200, 0,
0099         tc6387xb_mmc_resources[0].start & 0xfffe);
0100 
0101     return 0;
0102 }
0103 
0104 static int tc6387xb_mmc_disable(struct platform_device *mmc)
0105 {
0106     struct tc6387xb *tc6387xb = dev_get_drvdata(mmc->dev.parent);
0107 
0108     clk_disable_unprepare(tc6387xb->clk32k);
0109 
0110     return 0;
0111 }
0112 
0113 static struct tmio_mmc_data tc6387xb_mmc_data = {
0114     .hclk = 24000000,
0115     .set_pwr = tc6387xb_mmc_pwr,
0116     .set_clk_div = tc6387xb_mmc_clk_div,
0117 };
0118 
0119 /*--------------------------------------------------------------------------*/
0120 
0121 static const struct mfd_cell tc6387xb_cells[] = {
0122     [TC6387XB_CELL_MMC] = {
0123         .name = "tmio-mmc",
0124         .enable = tc6387xb_mmc_enable,
0125         .disable = tc6387xb_mmc_disable,
0126         .platform_data = &tc6387xb_mmc_data,
0127         .pdata_size    = sizeof(tc6387xb_mmc_data),
0128         .num_resources = ARRAY_SIZE(tc6387xb_mmc_resources),
0129         .resources = tc6387xb_mmc_resources,
0130     },
0131 };
0132 
0133 static int tc6387xb_probe(struct platform_device *dev)
0134 {
0135     struct tc6387xb_platform_data *pdata = dev_get_platdata(&dev->dev);
0136     struct resource *iomem, *rscr;
0137     struct clk *clk32k;
0138     struct tc6387xb *tc6387xb;
0139     int irq, ret;
0140 
0141     iomem = platform_get_resource(dev, IORESOURCE_MEM, 0);
0142     if (!iomem)
0143         return -EINVAL;
0144 
0145     tc6387xb = kzalloc(sizeof(*tc6387xb), GFP_KERNEL);
0146     if (!tc6387xb)
0147         return -ENOMEM;
0148 
0149     ret  = platform_get_irq(dev, 0);
0150     if (ret >= 0)
0151         irq = ret;
0152     else
0153         goto err_no_irq;
0154 
0155     clk32k = clk_get(&dev->dev, "CLK_CK32K");
0156     if (IS_ERR(clk32k)) {
0157         ret = PTR_ERR(clk32k);
0158         goto err_no_clk;
0159     }
0160 
0161     rscr = &tc6387xb->rscr;
0162     rscr->name = "tc6387xb-core";
0163     rscr->start = iomem->start;
0164     rscr->end = iomem->start + 0xff;
0165     rscr->flags = IORESOURCE_MEM;
0166 
0167     ret = request_resource(iomem, rscr);
0168     if (ret)
0169         goto err_resource;
0170 
0171     tc6387xb->scr = ioremap(rscr->start, resource_size(rscr));
0172     if (!tc6387xb->scr) {
0173         ret = -ENOMEM;
0174         goto err_ioremap;
0175     }
0176 
0177     tc6387xb->clk32k = clk32k;
0178     platform_set_drvdata(dev, tc6387xb);
0179 
0180     if (pdata && pdata->enable)
0181         pdata->enable(dev);
0182 
0183     dev_info(&dev->dev, "Toshiba tc6387xb initialised\n");
0184 
0185     ret = mfd_add_devices(&dev->dev, dev->id, tc6387xb_cells,
0186                   ARRAY_SIZE(tc6387xb_cells), iomem, irq, NULL);
0187 
0188     if (!ret)
0189         return 0;
0190 
0191     iounmap(tc6387xb->scr);
0192 err_ioremap:
0193     release_resource(&tc6387xb->rscr);
0194 err_resource:
0195     clk_put(clk32k);
0196 err_no_clk:
0197 err_no_irq:
0198     kfree(tc6387xb);
0199     return ret;
0200 }
0201 
0202 static int tc6387xb_remove(struct platform_device *dev)
0203 {
0204     struct tc6387xb *tc6387xb = platform_get_drvdata(dev);
0205 
0206     mfd_remove_devices(&dev->dev);
0207     iounmap(tc6387xb->scr);
0208     release_resource(&tc6387xb->rscr);
0209     clk_disable_unprepare(tc6387xb->clk32k);
0210     clk_put(tc6387xb->clk32k);
0211     kfree(tc6387xb);
0212 
0213     return 0;
0214 }
0215 
0216 
0217 static struct platform_driver tc6387xb_platform_driver = {
0218     .driver = {
0219         .name       = "tc6387xb",
0220     },
0221     .probe      = tc6387xb_probe,
0222     .remove     = tc6387xb_remove,
0223     .suspend        = tc6387xb_suspend,
0224     .resume         = tc6387xb_resume,
0225 };
0226 
0227 module_platform_driver(tc6387xb_platform_driver);
0228 
0229 MODULE_DESCRIPTION("Toshiba TC6387XB core driver");
0230 MODULE_LICENSE("GPL v2");
0231 MODULE_AUTHOR("Ian Molton");
0232 MODULE_ALIAS("platform:tc6387xb");
0233
[ Source navigation ] [ Diff markup ] [ Identifier search ] [ general search ]

This page was automatically generated by the 2.1.0 LXR engine.

The LXR team
Valid CSS 2.1! Valid HTML 4.01!