OMAPDSS: VENC: fix NULL pointer dereference in DSS2 VENC sysfs debug attr on OMAP4
[zen-stable.git] / drivers / mmc / host / sh_mobile_sdhi.c
blob58da3c44acc5d129428198b7ec80f987fe73d68a
1 /*
2 * SuperH Mobile SDHI
4 * Copyright (C) 2009 Magnus Damm
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.
10 * Based on "Compaq ASIC3 support":
12 * Copyright 2001 Compaq Computer Corporation.
13 * Copyright 2004-2005 Phil Blundell
14 * Copyright 2007-2008 OpenedHand Ltd.
16 * Authors: Phil Blundell <pb@handhelds.org>,
17 * Samuel Ortiz <sameo@openedhand.com>
21 #include <linux/kernel.h>
22 #include <linux/clk.h>
23 #include <linux/slab.h>
24 #include <linux/module.h>
25 #include <linux/platform_device.h>
26 #include <linux/mmc/host.h>
27 #include <linux/mmc/sh_mobile_sdhi.h>
28 #include <linux/mfd/tmio.h>
29 #include <linux/sh_dma.h>
30 #include <linux/delay.h>
32 #include "tmio_mmc.h"
34 struct sh_mobile_sdhi {
35 struct clk *clk;
36 struct tmio_mmc_data mmc_data;
37 struct sh_dmae_slave param_tx;
38 struct sh_dmae_slave param_rx;
39 struct tmio_mmc_dma dma_priv;
42 static void sh_mobile_sdhi_set_pwr(struct platform_device *pdev, int state)
44 struct sh_mobile_sdhi_info *p = pdev->dev.platform_data;
46 if (p && p->set_pwr)
47 p->set_pwr(pdev, state);
50 static int sh_mobile_sdhi_get_cd(struct platform_device *pdev)
52 struct sh_mobile_sdhi_info *p = pdev->dev.platform_data;
54 if (p && p->get_cd)
55 return p->get_cd(pdev);
56 else
57 return -ENOSYS;
60 static int sh_mobile_sdhi_wait_idle(struct tmio_mmc_host *host)
62 int timeout = 1000;
64 while (--timeout && !(sd_ctrl_read16(host, CTL_STATUS2) & (1 << 13)))
65 udelay(1);
67 if (!timeout) {
68 dev_warn(host->pdata->dev, "timeout waiting for SD bus idle\n");
69 return -EBUSY;
72 return 0;
75 static int sh_mobile_sdhi_write16_hook(struct tmio_mmc_host *host, int addr)
77 switch (addr)
79 case CTL_SD_CMD:
80 case CTL_STOP_INTERNAL_ACTION:
81 case CTL_XFER_BLK_COUNT:
82 case CTL_SD_CARD_CLK_CTL:
83 case CTL_SD_XFER_LEN:
84 case CTL_SD_MEM_CARD_OPT:
85 case CTL_TRANSACTION_CTL:
86 case CTL_DMA_ENABLE:
87 return sh_mobile_sdhi_wait_idle(host);
90 return 0;
93 static int __devinit sh_mobile_sdhi_probe(struct platform_device *pdev)
95 struct sh_mobile_sdhi *priv;
96 struct tmio_mmc_data *mmc_data;
97 struct sh_mobile_sdhi_info *p = pdev->dev.platform_data;
98 struct tmio_mmc_host *host;
99 char clk_name[8];
100 int irq, ret, i = 0;
101 bool multiplexed_isr = true;
103 priv = kzalloc(sizeof(struct sh_mobile_sdhi), GFP_KERNEL);
104 if (priv == NULL) {
105 dev_err(&pdev->dev, "kzalloc failed\n");
106 return -ENOMEM;
109 mmc_data = &priv->mmc_data;
110 p->pdata = mmc_data;
112 snprintf(clk_name, sizeof(clk_name), "sdhi%d", pdev->id);
113 priv->clk = clk_get(&pdev->dev, clk_name);
114 if (IS_ERR(priv->clk)) {
115 dev_err(&pdev->dev, "cannot get clock \"%s\"\n", clk_name);
116 ret = PTR_ERR(priv->clk);
117 goto eclkget;
120 clk_enable(priv->clk);
122 mmc_data->hclk = clk_get_rate(priv->clk);
123 mmc_data->set_pwr = sh_mobile_sdhi_set_pwr;
124 mmc_data->get_cd = sh_mobile_sdhi_get_cd;
125 mmc_data->capabilities = MMC_CAP_MMC_HIGHSPEED;
126 if (p) {
127 mmc_data->flags = p->tmio_flags;
128 if (mmc_data->flags & TMIO_MMC_HAS_IDLE_WAIT)
129 mmc_data->write16_hook = sh_mobile_sdhi_write16_hook;
130 mmc_data->ocr_mask = p->tmio_ocr_mask;
131 mmc_data->capabilities |= p->tmio_caps;
133 if (p->dma_slave_tx > 0 && p->dma_slave_rx > 0) {
134 priv->param_tx.slave_id = p->dma_slave_tx;
135 priv->param_rx.slave_id = p->dma_slave_rx;
136 priv->dma_priv.chan_priv_tx = &priv->param_tx;
137 priv->dma_priv.chan_priv_rx = &priv->param_rx;
138 priv->dma_priv.alignment_shift = 1; /* 2-byte alignment */
139 mmc_data->dma = &priv->dma_priv;
144 * All SDHI blocks support 2-byte and larger block sizes in 4-bit
145 * bus width mode.
147 mmc_data->flags |= TMIO_MMC_BLKSZ_2BYTES;
150 * All SDHI blocks support SDIO IRQ signalling.
152 mmc_data->flags |= TMIO_MMC_SDIO_IRQ;
154 ret = tmio_mmc_host_probe(&host, pdev, mmc_data);
155 if (ret < 0)
156 goto eprobe;
159 * Allow one or more specific (named) ISRs or
160 * one or more multiplexed (un-named) ISRs.
163 irq = platform_get_irq_byname(pdev, SH_MOBILE_SDHI_IRQ_CARD_DETECT);
164 if (irq >= 0) {
165 multiplexed_isr = false;
166 ret = request_irq(irq, tmio_mmc_card_detect_irq, 0,
167 dev_name(&pdev->dev), host);
168 if (ret)
169 goto eirq_card_detect;
172 irq = platform_get_irq_byname(pdev, SH_MOBILE_SDHI_IRQ_SDIO);
173 if (irq >= 0) {
174 multiplexed_isr = false;
175 ret = request_irq(irq, tmio_mmc_sdio_irq, 0,
176 dev_name(&pdev->dev), host);
177 if (ret)
178 goto eirq_sdio;
181 irq = platform_get_irq_byname(pdev, SH_MOBILE_SDHI_IRQ_SDCARD);
182 if (irq >= 0) {
183 multiplexed_isr = false;
184 ret = request_irq(irq, tmio_mmc_sdcard_irq, 0,
185 dev_name(&pdev->dev), host);
186 if (ret)
187 goto eirq_sdcard;
188 } else if (!multiplexed_isr) {
189 dev_err(&pdev->dev,
190 "Principal SD-card IRQ is missing among named interrupts\n");
191 ret = irq;
192 goto eirq_sdcard;
195 if (multiplexed_isr) {
196 while (1) {
197 irq = platform_get_irq(pdev, i);
198 if (irq < 0)
199 break;
200 i++;
201 ret = request_irq(irq, tmio_mmc_irq, 0,
202 dev_name(&pdev->dev), host);
203 if (ret)
204 goto eirq_multiplexed;
207 /* There must be at least one IRQ source */
208 if (!i)
209 goto eirq_multiplexed;
212 dev_info(&pdev->dev, "%s base at 0x%08lx clock rate %u MHz\n",
213 mmc_hostname(host->mmc), (unsigned long)
214 (platform_get_resource(pdev,IORESOURCE_MEM, 0)->start),
215 mmc_data->hclk / 1000000);
217 return ret;
219 eirq_multiplexed:
220 while (i--) {
221 irq = platform_get_irq(pdev, i);
222 free_irq(irq, host);
224 eirq_sdcard:
225 irq = platform_get_irq_byname(pdev, SH_MOBILE_SDHI_IRQ_SDIO);
226 if (irq >= 0)
227 free_irq(irq, host);
228 eirq_sdio:
229 irq = platform_get_irq_byname(pdev, SH_MOBILE_SDHI_IRQ_CARD_DETECT);
230 if (irq >= 0)
231 free_irq(irq, host);
232 eirq_card_detect:
233 tmio_mmc_host_remove(host);
234 eprobe:
235 clk_disable(priv->clk);
236 clk_put(priv->clk);
237 eclkget:
238 kfree(priv);
239 return ret;
242 static int sh_mobile_sdhi_remove(struct platform_device *pdev)
244 struct mmc_host *mmc = platform_get_drvdata(pdev);
245 struct tmio_mmc_host *host = mmc_priv(mmc);
246 struct sh_mobile_sdhi *priv = container_of(host->pdata, struct sh_mobile_sdhi, mmc_data);
247 struct sh_mobile_sdhi_info *p = pdev->dev.platform_data;
248 int i = 0, irq;
250 p->pdata = NULL;
252 tmio_mmc_host_remove(host);
254 while (1) {
255 irq = platform_get_irq(pdev, i++);
256 if (irq < 0)
257 break;
258 free_irq(irq, host);
261 clk_disable(priv->clk);
262 clk_put(priv->clk);
263 kfree(priv);
265 return 0;
268 static const struct dev_pm_ops tmio_mmc_dev_pm_ops = {
269 .suspend = tmio_mmc_host_suspend,
270 .resume = tmio_mmc_host_resume,
271 .runtime_suspend = tmio_mmc_host_runtime_suspend,
272 .runtime_resume = tmio_mmc_host_runtime_resume,
275 static struct platform_driver sh_mobile_sdhi_driver = {
276 .driver = {
277 .name = "sh_mobile_sdhi",
278 .owner = THIS_MODULE,
279 .pm = &tmio_mmc_dev_pm_ops,
281 .probe = sh_mobile_sdhi_probe,
282 .remove = __devexit_p(sh_mobile_sdhi_remove),
285 module_platform_driver(sh_mobile_sdhi_driver);
287 MODULE_DESCRIPTION("SuperH Mobile SDHI driver");
288 MODULE_AUTHOR("Magnus Damm");
289 MODULE_LICENSE("GPL v2");
290 MODULE_ALIAS("platform:sh_mobile_sdhi");