projects / deliverable / linux.git / blame
| Commit | Line | Data |
|---|---|---|
| a87d5638 MD |
1 | /* |
| 2 | * SuperH Mobile SDHI | |
| 3 | * | |
| 4 | * Copyright (C) 2009 Magnus Damm | |
| 5 | * | |
| 6 | * This program is free software; you can redistribute it and/or modify | |
| 7 | * it under the terms of the GNU General Public License version 2 as | |
| 8 | * published by the Free Software Foundation. | |
| 9 | * | |
| 10 | * Based on "Compaq ASIC3 support": | |
| 11 | * | |
| 12 | * Copyright 2001 Compaq Computer Corporation. | |
| 13 | * Copyright 2004-2005 Phil Blundell | |
| 14 | * Copyright 2007-2008 OpenedHand Ltd. | |
| 15 | * | |
| 16 | * Authors: Phil Blundell <pb@handhelds.org>, | |
| 17 | * Samuel Ortiz <sameo@openedhand.com> | |
| 18 | * | |
| 19 | */ | |
| 20 | ||
| 21 | #include <linux/kernel.h> | |
| 22 | #include <linux/clk.h> | |
| 23 | #include <linux/platform_device.h> | |
| 24 | ||
| 25 | #include <linux/mfd/core.h> | |
| 26 | #include <linux/mfd/tmio.h> | |
| 27 | ||
| 28 | struct sh_mobile_sdhi { | |
| 29 | struct clk *clk; | |
| 30 | struct tmio_mmc_data mmc_data; | |
| 31 | struct mfd_cell cell_mmc; | |
| 32 | }; | |
| 33 | ||
| 34 | static struct resource sh_mobile_sdhi_resources[] = { | |
| 35 | { | |
| 36 | .start = 0x000, | |
| 37 | .end = 0x1ff, | |
| 38 | .flags = IORESOURCE_MEM, | |
| 39 | }, | |
| 40 | { | |
| 41 | .start = 0, | |
| 42 | .end = 0, | |
| 43 | .flags = IORESOURCE_IRQ, | |
| 44 | }, | |
| 45 | }; | |
| 46 | ||
| 47 | static struct mfd_cell sh_mobile_sdhi_cell = { | |
| 48 | .name = "tmio-mmc", | |
| 49 | .num_resources = ARRAY_SIZE(sh_mobile_sdhi_resources), | |
| 50 | .resources = sh_mobile_sdhi_resources, | |
| 51 | }; | |
| 52 | ||
| 53 | static int __init sh_mobile_sdhi_probe(struct platform_device *pdev) | |
| 54 | { | |
| 55 | struct sh_mobile_sdhi *priv; | |
| 56 | struct resource *mem; | |
| 57 | char clk_name[8]; | |
| 58 | int ret, irq; | |
| 59 | ||
| 60 | mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
| 61 | if (!mem) | |
| 62 | dev_err(&pdev->dev, "missing MEM resource\n"); | |
| 63 | ||
| 64 | irq = platform_get_irq(pdev, 0); | |
| 65 | if (irq < 0) | |
| 66 | dev_err(&pdev->dev, "missing IRQ resource\n"); | |
| 67 | ||
| 68 | if (!mem || (irq < 0)) | |
| 69 | return -EINVAL; | |
| 70 | ||
| 71 | priv = kzalloc(sizeof(struct sh_mobile_sdhi), GFP_KERNEL); | |
| 72 | if (priv == NULL) { | |
| 73 | dev_err(&pdev->dev, "kzalloc failed\n"); | |
| 74 | return -ENOMEM; | |
| 75 | } | |
| 76 | ||
| 77 | snprintf(clk_name, sizeof(clk_name), "sdhi%d", pdev->id); | |
| 78 | priv->clk = clk_get(&pdev->dev, clk_name); | |
| 79 | if (IS_ERR(priv->clk)) { | |
| 80 | dev_err(&pdev->dev, "cannot get clock \"%s\"\n", clk_name); | |
| 81 | ret = PTR_ERR(priv->clk); | |
| 82 | kfree(priv); | |
| 83 | return ret; | |
| 84 | } | |
| 85 | ||
| 86 | clk_enable(priv->clk); | |
| 87 | ||
| 88 | /* FIXME: silly const unsigned int hclk */ | |
| 89 | *(unsigned int *)&priv->mmc_data.hclk = clk_get_rate(priv->clk); | |
| 90 | ||
| 91 | memcpy(&priv->cell_mmc, &sh_mobile_sdhi_cell, sizeof(priv->cell_mmc)); | |
| 92 | priv->cell_mmc.driver_data = &priv->mmc_data; | |
| 93 | priv->cell_mmc.platform_data = &priv->cell_mmc; | |
| 94 | priv->cell_mmc.data_size = sizeof(priv->cell_mmc); | |
| 95 | ||
| 96 | platform_set_drvdata(pdev, priv); | |
| 97 | ||
| 98 | ret = mfd_add_devices(&pdev->dev, pdev->id, | |
| 99 | &priv->cell_mmc, 1, mem, irq); | |
| 100 | if (ret) { | |
| 101 | clk_disable(priv->clk); | |
| 102 | clk_put(priv->clk); | |
| 103 | kfree(priv); | |
| 104 | } | |
| 105 | ||
| 106 | return ret; | |
| 107 | } | |
| 108 | ||
| 109 | static int sh_mobile_sdhi_remove(struct platform_device *pdev) | |
| 110 | { | |
| 111 | struct sh_mobile_sdhi *priv = platform_get_drvdata(pdev); | |
| 112 | ||
| 113 | mfd_remove_devices(&pdev->dev); | |
| 114 | clk_disable(priv->clk); | |
| 115 | clk_put(priv->clk); | |
| 116 | kfree(priv); | |
| 117 | ||
| 118 | return 0; | |
| 119 | } | |
| 120 | ||
| 121 | static struct platform_driver sh_mobile_sdhi_driver = { | |
| 122 | .driver = { | |
| 123 | .name = "sh_mobile_sdhi", | |
| 124 | .owner = THIS_MODULE, | |
| 125 | }, | |
| 126 | .probe = sh_mobile_sdhi_probe, | |
| 127 | .remove = __devexit_p(sh_mobile_sdhi_remove), | |
| 128 | }; | |
| 129 | ||
| 130 | static int __init sh_mobile_sdhi_init(void) | |
| 131 | { | |
| 132 | return platform_driver_register(&sh_mobile_sdhi_driver); | |
| 133 | } | |
| 134 | ||
| 135 | static void __exit sh_mobile_sdhi_exit(void) | |
| 136 | { | |
| 137 | platform_driver_unregister(&sh_mobile_sdhi_driver); | |
| 138 | } | |
| 139 | ||
| 140 | module_init(sh_mobile_sdhi_init); | |
| 141 | module_exit(sh_mobile_sdhi_exit); | |
| 142 | ||
| 143 | MODULE_DESCRIPTION("SuperH Mobile SDHI driver"); | |
| 144 | MODULE_AUTHOR("Magnus Damm"); | |
| 145 | MODULE_LICENSE("GPL v2"); |