Linux Audio

Check our new training course

Loading...
v3.5.6
  1/*
  2 * drivers/mmc/host/sdhci-spear.c
  3 *
  4 * Support of SDHCI platform devices for spear soc family
  5 *
  6 * Copyright (C) 2010 ST Microelectronics
  7 * Viresh Kumar <viresh.linux@gmail.com>
  8 *
  9 * Inspired by sdhci-pltfm.c
 10 *
 11 * This file is licensed under the terms of the GNU General Public
 12 * License version 2. This program is licensed "as is" without any
 13 * warranty of any kind, whether express or implied.
 14 */
 15
 16#include <linux/clk.h>
 17#include <linux/delay.h>
 18#include <linux/gpio.h>
 19#include <linux/highmem.h>
 20#include <linux/module.h>
 21#include <linux/interrupt.h>
 22#include <linux/irq.h>
 23#include <linux/platform_device.h>
 24#include <linux/pm.h>
 25#include <linux/slab.h>
 26#include <linux/mmc/host.h>
 27#include <linux/mmc/sdhci-spear.h>
 28#include <linux/io.h>
 29#include "sdhci.h"
 30
 31struct spear_sdhci {
 32	struct clk *clk;
 33	struct sdhci_plat_data *data;
 34};
 35
 36/* sdhci ops */
 37static struct sdhci_ops sdhci_pltfm_ops = {
 38	/* Nothing to do for now. */
 39};
 40
 41/* gpio card detection interrupt handler */
 42static irqreturn_t sdhci_gpio_irq(int irq, void *dev_id)
 43{
 44	struct platform_device *pdev = dev_id;
 45	struct sdhci_host *host = platform_get_drvdata(pdev);
 46	struct spear_sdhci *sdhci = dev_get_platdata(&pdev->dev);
 47	unsigned long gpio_irq_type;
 48	int val;
 49
 50	val = gpio_get_value(sdhci->data->card_int_gpio);
 51
 52	/* val == 1 -> card removed, val == 0 -> card inserted */
 53	/* if card removed - set irq for low level, else vice versa */
 54	gpio_irq_type = val ? IRQF_TRIGGER_LOW : IRQF_TRIGGER_HIGH;
 55	irq_set_irq_type(irq, gpio_irq_type);
 56
 57	if (sdhci->data->card_power_gpio >= 0) {
 58		if (!sdhci->data->power_always_enb) {
 59			/* if card inserted, give power, otherwise remove it */
 60			val = sdhci->data->power_active_high ? !val : val ;
 61			gpio_set_value(sdhci->data->card_power_gpio, val);
 62		}
 63	}
 64
 65	/* inform sdhci driver about card insertion/removal */
 66	tasklet_schedule(&host->card_tasklet);
 67
 68	return IRQ_HANDLED;
 69}
 70
 71static int __devinit sdhci_probe(struct platform_device *pdev)
 72{
 73	struct sdhci_host *host;
 74	struct resource *iomem;
 75	struct spear_sdhci *sdhci;
 76	int ret;
 77
 
 
 78	iomem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 79	if (!iomem) {
 80		ret = -ENOMEM;
 81		dev_dbg(&pdev->dev, "memory resource not defined\n");
 82		goto err;
 83	}
 84
 85	if (!devm_request_mem_region(&pdev->dev, iomem->start,
 86				resource_size(iomem), "spear-sdhci")) {
 87		ret = -EBUSY;
 88		dev_dbg(&pdev->dev, "cannot request region\n");
 89		goto err;
 90	}
 91
 92	sdhci = devm_kzalloc(&pdev->dev, sizeof(*sdhci), GFP_KERNEL);
 93	if (!sdhci) {
 94		ret = -ENOMEM;
 95		dev_dbg(&pdev->dev, "cannot allocate memory for sdhci\n");
 96		goto err;
 97	}
 98
 99	/* clk enable */
100	sdhci->clk = clk_get(&pdev->dev, NULL);
101	if (IS_ERR(sdhci->clk)) {
102		ret = PTR_ERR(sdhci->clk);
103		dev_dbg(&pdev->dev, "Error getting clock\n");
104		goto err;
105	}
106
107	ret = clk_enable(sdhci->clk);
108	if (ret) {
109		dev_dbg(&pdev->dev, "Error enabling clock\n");
110		goto put_clk;
111	}
112
113	/* overwrite platform_data */
114	sdhci->data = dev_get_platdata(&pdev->dev);
115	pdev->dev.platform_data = sdhci;
116
117	if (pdev->dev.parent)
118		host = sdhci_alloc_host(pdev->dev.parent, 0);
119	else
120		host = sdhci_alloc_host(&pdev->dev, 0);
121
122	if (IS_ERR(host)) {
123		ret = PTR_ERR(host);
124		dev_dbg(&pdev->dev, "error allocating host\n");
125		goto disable_clk;
126	}
127
128	host->hw_name = "sdhci";
129	host->ops = &sdhci_pltfm_ops;
130	host->irq = platform_get_irq(pdev, 0);
131	host->quirks = SDHCI_QUIRK_BROKEN_ADMA;
132
133	host->ioaddr = devm_ioremap(&pdev->dev, iomem->start,
134			resource_size(iomem));
135	if (!host->ioaddr) {
136		ret = -ENOMEM;
137		dev_dbg(&pdev->dev, "failed to remap registers\n");
138		goto free_host;
139	}
140
141	ret = sdhci_add_host(host);
142	if (ret) {
143		dev_dbg(&pdev->dev, "error adding host\n");
144		goto free_host;
145	}
146
147	platform_set_drvdata(pdev, host);
148
149	/*
150	 * It is optional to use GPIOs for sdhci Power control & sdhci card
151	 * interrupt detection. If sdhci->data is NULL, then use original sdhci
152	 * lines otherwise GPIO lines.
153	 * If GPIO is selected for power control, then power should be disabled
154	 * after card removal and should be enabled when card insertion
155	 * interrupt occurs
156	 */
157	if (!sdhci->data)
158		return 0;
159
160	if (sdhci->data->card_power_gpio >= 0) {
161		int val = 0;
162
163		ret = devm_gpio_request(&pdev->dev,
164				sdhci->data->card_power_gpio, "sdhci");
165		if (ret < 0) {
166			dev_dbg(&pdev->dev, "gpio request fail: %d\n",
167					sdhci->data->card_power_gpio);
168			goto set_drvdata;
169		}
170
171		if (sdhci->data->power_always_enb)
172			val = sdhci->data->power_active_high;
173		else
174			val = !sdhci->data->power_active_high;
175
176		ret = gpio_direction_output(sdhci->data->card_power_gpio, val);
177		if (ret) {
178			dev_dbg(&pdev->dev, "gpio set direction fail: %d\n",
179					sdhci->data->card_power_gpio);
180			goto set_drvdata;
181		}
 
 
182	}
183
184	if (sdhci->data->card_int_gpio >= 0) {
185		ret = devm_gpio_request(&pdev->dev, sdhci->data->card_int_gpio,
186				"sdhci");
187		if (ret < 0) {
188			dev_dbg(&pdev->dev, "gpio request fail: %d\n",
189					sdhci->data->card_int_gpio);
190			goto set_drvdata;
191		}
192
193		ret = gpio_direction_input(sdhci->data->card_int_gpio);
194		if (ret) {
195			dev_dbg(&pdev->dev, "gpio set direction fail: %d\n",
196					sdhci->data->card_int_gpio);
197			goto set_drvdata;
198		}
199		ret = devm_request_irq(&pdev->dev,
200				gpio_to_irq(sdhci->data->card_int_gpio),
201				sdhci_gpio_irq, IRQF_TRIGGER_LOW,
202				mmc_hostname(host->mmc), pdev);
203		if (ret) {
204			dev_dbg(&pdev->dev, "gpio request irq fail: %d\n",
205					sdhci->data->card_int_gpio);
206			goto set_drvdata;
207		}
208
209	}
210
211	return 0;
212
213set_drvdata:
 
 
 
 
 
 
 
 
214	platform_set_drvdata(pdev, NULL);
215	sdhci_remove_host(host, 1);
216free_host:
 
 
217	sdhci_free_host(host);
218disable_clk:
219	clk_disable(sdhci->clk);
220put_clk:
221	clk_put(sdhci->clk);
 
 
 
 
222err:
223	dev_err(&pdev->dev, "spear-sdhci probe failed: %d\n", ret);
224	return ret;
225}
226
227static int __devexit sdhci_remove(struct platform_device *pdev)
228{
229	struct sdhci_host *host = platform_get_drvdata(pdev);
 
230	struct spear_sdhci *sdhci = dev_get_platdata(&pdev->dev);
231	int dead = 0;
232	u32 scratch;
233
 
 
 
 
 
 
 
 
 
 
234	platform_set_drvdata(pdev, NULL);
 
235	scratch = readl(host->ioaddr + SDHCI_INT_STATUS);
236	if (scratch == (u32)-1)
237		dead = 1;
238
239	sdhci_remove_host(host, dead);
 
240	sdhci_free_host(host);
241	clk_disable(sdhci->clk);
242	clk_put(sdhci->clk);
 
 
 
243
244	return 0;
245}
246
247#ifdef CONFIG_PM
248static int sdhci_suspend(struct device *dev)
249{
250	struct sdhci_host *host = dev_get_drvdata(dev);
251	struct spear_sdhci *sdhci = dev_get_platdata(dev);
252	int ret;
253
254	ret = sdhci_suspend_host(host);
255	if (!ret)
256		clk_disable(sdhci->clk);
257
258	return ret;
259}
260
261static int sdhci_resume(struct device *dev)
262{
263	struct sdhci_host *host = dev_get_drvdata(dev);
264	struct spear_sdhci *sdhci = dev_get_platdata(dev);
265	int ret;
266
267	ret = clk_enable(sdhci->clk);
268	if (ret) {
269		dev_dbg(dev, "Resume: Error enabling clock\n");
270		return ret;
271	}
272
273	return sdhci_resume_host(host);
274}
275#endif
276
277static SIMPLE_DEV_PM_OPS(sdhci_pm_ops, sdhci_suspend, sdhci_resume);
278
279static struct platform_driver sdhci_driver = {
280	.driver = {
281		.name	= "sdhci",
282		.owner	= THIS_MODULE,
283		.pm	= &sdhci_pm_ops,
284	},
285	.probe		= sdhci_probe,
286	.remove		= __devexit_p(sdhci_remove),
287};
288
289module_platform_driver(sdhci_driver);
 
 
 
 
 
 
 
 
 
 
290
291MODULE_DESCRIPTION("SPEAr Secure Digital Host Controller Interface driver");
292MODULE_AUTHOR("Viresh Kumar <viresh.linux@gmail.com>");
293MODULE_LICENSE("GPL v2");
v3.1
  1/*
  2 * drivers/mmc/host/sdhci-spear.c
  3 *
  4 * Support of SDHCI platform devices for spear soc family
  5 *
  6 * Copyright (C) 2010 ST Microelectronics
  7 * Viresh Kumar<viresh.kumar@st.com>
  8 *
  9 * Inspired by sdhci-pltfm.c
 10 *
 11 * This file is licensed under the terms of the GNU General Public
 12 * License version 2. This program is licensed "as is" without any
 13 * warranty of any kind, whether express or implied.
 14 */
 15
 16#include <linux/clk.h>
 17#include <linux/delay.h>
 18#include <linux/gpio.h>
 19#include <linux/highmem.h>
 
 20#include <linux/interrupt.h>
 21#include <linux/irq.h>
 22#include <linux/platform_device.h>
 
 23#include <linux/slab.h>
 24#include <linux/mmc/host.h>
 25#include <linux/mmc/sdhci-spear.h>
 26#include <linux/io.h>
 27#include "sdhci.h"
 28
 29struct spear_sdhci {
 30	struct clk *clk;
 31	struct sdhci_plat_data *data;
 32};
 33
 34/* sdhci ops */
 35static struct sdhci_ops sdhci_pltfm_ops = {
 36	/* Nothing to do for now. */
 37};
 38
 39/* gpio card detection interrupt handler */
 40static irqreturn_t sdhci_gpio_irq(int irq, void *dev_id)
 41{
 42	struct platform_device *pdev = dev_id;
 43	struct sdhci_host *host = platform_get_drvdata(pdev);
 44	struct spear_sdhci *sdhci = dev_get_platdata(&pdev->dev);
 45	unsigned long gpio_irq_type;
 46	int val;
 47
 48	val = gpio_get_value(sdhci->data->card_int_gpio);
 49
 50	/* val == 1 -> card removed, val == 0 -> card inserted */
 51	/* if card removed - set irq for low level, else vice versa */
 52	gpio_irq_type = val ? IRQF_TRIGGER_LOW : IRQF_TRIGGER_HIGH;
 53	irq_set_irq_type(irq, gpio_irq_type);
 54
 55	if (sdhci->data->card_power_gpio >= 0) {
 56		if (!sdhci->data->power_always_enb) {
 57			/* if card inserted, give power, otherwise remove it */
 58			val = sdhci->data->power_active_high ? !val : val ;
 59			gpio_set_value(sdhci->data->card_power_gpio, val);
 60		}
 61	}
 62
 63	/* inform sdhci driver about card insertion/removal */
 64	tasklet_schedule(&host->card_tasklet);
 65
 66	return IRQ_HANDLED;
 67}
 68
 69static int __devinit sdhci_probe(struct platform_device *pdev)
 70{
 71	struct sdhci_host *host;
 72	struct resource *iomem;
 73	struct spear_sdhci *sdhci;
 74	int ret;
 75
 76	BUG_ON(pdev == NULL);
 77
 78	iomem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 79	if (!iomem) {
 80		ret = -ENOMEM;
 81		dev_dbg(&pdev->dev, "memory resource not defined\n");
 82		goto err;
 83	}
 84
 85	if (!request_mem_region(iomem->start, resource_size(iomem),
 86				"spear-sdhci")) {
 87		ret = -EBUSY;
 88		dev_dbg(&pdev->dev, "cannot request region\n");
 89		goto err;
 90	}
 91
 92	sdhci = kzalloc(sizeof(*sdhci), GFP_KERNEL);
 93	if (!sdhci) {
 94		ret = -ENOMEM;
 95		dev_dbg(&pdev->dev, "cannot allocate memory for sdhci\n");
 96		goto err_kzalloc;
 97	}
 98
 99	/* clk enable */
100	sdhci->clk = clk_get(&pdev->dev, NULL);
101	if (IS_ERR(sdhci->clk)) {
102		ret = PTR_ERR(sdhci->clk);
103		dev_dbg(&pdev->dev, "Error getting clock\n");
104		goto err_clk_get;
105	}
106
107	ret = clk_enable(sdhci->clk);
108	if (ret) {
109		dev_dbg(&pdev->dev, "Error enabling clock\n");
110		goto err_clk_enb;
111	}
112
113	/* overwrite platform_data */
114	sdhci->data = dev_get_platdata(&pdev->dev);
115	pdev->dev.platform_data = sdhci;
116
117	if (pdev->dev.parent)
118		host = sdhci_alloc_host(pdev->dev.parent, 0);
119	else
120		host = sdhci_alloc_host(&pdev->dev, 0);
121
122	if (IS_ERR(host)) {
123		ret = PTR_ERR(host);
124		dev_dbg(&pdev->dev, "error allocating host\n");
125		goto err_alloc_host;
126	}
127
128	host->hw_name = "sdhci";
129	host->ops = &sdhci_pltfm_ops;
130	host->irq = platform_get_irq(pdev, 0);
131	host->quirks = SDHCI_QUIRK_BROKEN_ADMA;
132
133	host->ioaddr = ioremap(iomem->start, resource_size(iomem));
 
134	if (!host->ioaddr) {
135		ret = -ENOMEM;
136		dev_dbg(&pdev->dev, "failed to remap registers\n");
137		goto err_ioremap;
138	}
139
140	ret = sdhci_add_host(host);
141	if (ret) {
142		dev_dbg(&pdev->dev, "error adding host\n");
143		goto err_add_host;
144	}
145
146	platform_set_drvdata(pdev, host);
147
148	/*
149	 * It is optional to use GPIOs for sdhci Power control & sdhci card
150	 * interrupt detection. If sdhci->data is NULL, then use original sdhci
151	 * lines otherwise GPIO lines.
152	 * If GPIO is selected for power control, then power should be disabled
153	 * after card removal and should be enabled when card insertion
154	 * interrupt occurs
155	 */
156	if (!sdhci->data)
157		return 0;
158
159	if (sdhci->data->card_power_gpio >= 0) {
160		int val = 0;
161
162		ret = gpio_request(sdhci->data->card_power_gpio, "sdhci");
 
163		if (ret < 0) {
164			dev_dbg(&pdev->dev, "gpio request fail: %d\n",
165					sdhci->data->card_power_gpio);
166			goto err_pgpio_request;
167		}
168
169		if (sdhci->data->power_always_enb)
170			val = sdhci->data->power_active_high;
171		else
172			val = !sdhci->data->power_active_high;
173
174		ret = gpio_direction_output(sdhci->data->card_power_gpio, val);
175		if (ret) {
176			dev_dbg(&pdev->dev, "gpio set direction fail: %d\n",
177					sdhci->data->card_power_gpio);
178			goto err_pgpio_direction;
179		}
180
181		gpio_set_value(sdhci->data->card_power_gpio, 1);
182	}
183
184	if (sdhci->data->card_int_gpio >= 0) {
185		ret = gpio_request(sdhci->data->card_int_gpio, "sdhci");
 
186		if (ret < 0) {
187			dev_dbg(&pdev->dev, "gpio request fail: %d\n",
188					sdhci->data->card_int_gpio);
189			goto err_igpio_request;
190		}
191
192		ret = gpio_direction_input(sdhci->data->card_int_gpio);
193		if (ret) {
194			dev_dbg(&pdev->dev, "gpio set direction fail: %d\n",
195					sdhci->data->card_int_gpio);
196			goto err_igpio_direction;
197		}
198		ret = request_irq(gpio_to_irq(sdhci->data->card_int_gpio),
 
199				sdhci_gpio_irq, IRQF_TRIGGER_LOW,
200				mmc_hostname(host->mmc), pdev);
201		if (ret) {
202			dev_dbg(&pdev->dev, "gpio request irq fail: %d\n",
203					sdhci->data->card_int_gpio);
204			goto err_igpio_request_irq;
205		}
206
207	}
208
209	return 0;
210
211err_igpio_request_irq:
212err_igpio_direction:
213	if (sdhci->data->card_int_gpio >= 0)
214		gpio_free(sdhci->data->card_int_gpio);
215err_igpio_request:
216err_pgpio_direction:
217	if (sdhci->data->card_power_gpio >= 0)
218		gpio_free(sdhci->data->card_power_gpio);
219err_pgpio_request:
220	platform_set_drvdata(pdev, NULL);
221	sdhci_remove_host(host, 1);
222err_add_host:
223	iounmap(host->ioaddr);
224err_ioremap:
225	sdhci_free_host(host);
226err_alloc_host:
227	clk_disable(sdhci->clk);
228err_clk_enb:
229	clk_put(sdhci->clk);
230err_clk_get:
231	kfree(sdhci);
232err_kzalloc:
233	release_mem_region(iomem->start, resource_size(iomem));
234err:
235	dev_err(&pdev->dev, "spear-sdhci probe failed: %d\n", ret);
236	return ret;
237}
238
239static int __devexit sdhci_remove(struct platform_device *pdev)
240{
241	struct sdhci_host *host = platform_get_drvdata(pdev);
242	struct resource *iomem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
243	struct spear_sdhci *sdhci = dev_get_platdata(&pdev->dev);
244	int dead;
245	u32 scratch;
246
247	if (sdhci->data) {
248		if (sdhci->data->card_int_gpio >= 0) {
249			free_irq(gpio_to_irq(sdhci->data->card_int_gpio), pdev);
250			gpio_free(sdhci->data->card_int_gpio);
251		}
252
253		if (sdhci->data->card_power_gpio >= 0)
254			gpio_free(sdhci->data->card_power_gpio);
255	}
256
257	platform_set_drvdata(pdev, NULL);
258	dead = 0;
259	scratch = readl(host->ioaddr + SDHCI_INT_STATUS);
260	if (scratch == (u32)-1)
261		dead = 1;
262
263	sdhci_remove_host(host, dead);
264	iounmap(host->ioaddr);
265	sdhci_free_host(host);
266	clk_disable(sdhci->clk);
267	clk_put(sdhci->clk);
268	kfree(sdhci);
269	if (iomem)
270		release_mem_region(iomem->start, resource_size(iomem));
271
272	return 0;
273}
274
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
275static struct platform_driver sdhci_driver = {
276	.driver = {
277		.name	= "sdhci",
278		.owner	= THIS_MODULE,
 
279	},
280	.probe		= sdhci_probe,
281	.remove		= __devexit_p(sdhci_remove),
282};
283
284static int __init sdhci_init(void)
285{
286	return platform_driver_register(&sdhci_driver);
287}
288module_init(sdhci_init);
289
290static void __exit sdhci_exit(void)
291{
292	platform_driver_unregister(&sdhci_driver);
293}
294module_exit(sdhci_exit);
295
296MODULE_DESCRIPTION("SPEAr Secure Digital Host Controller Interface driver");
297MODULE_AUTHOR("Viresh Kumar <viresh.kumar@st.com>");
298MODULE_LICENSE("GPL v2");