Merge master.kernel.org:/home/rmk/linux-2.6-arm
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / arch / arm / plat-s3c24xx / adc.c
blob91adfa71c1724f30b55a5d72c5e8bd25f32321bf
1 /* arch/arm/plat-s3c24xx/adc.c
3 * Copyright (c) 2008 Simtec Electronics
4 * http://armlinux.simtec.co.uk/
5 * Ben Dooks <ben@simtec.co.uk>, <ben-linux@fluff.org>
7 * S3C24XX ADC device core
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License.
14 #include <linux/module.h>
15 #include <linux/kernel.h>
16 #include <linux/platform_device.h>
17 #include <linux/list.h>
18 #include <linux/err.h>
19 #include <linux/clk.h>
20 #include <linux/interrupt.h>
21 #include <linux/io.h>
23 #include <plat/regs-adc.h>
24 #include <plat/adc.h>
26 /* This driver is designed to control the usage of the ADC block between
27 * the touchscreen and any other drivers that may need to use it, such as
28 * the hwmon driver.
30 * Priority will be given to the touchscreen driver, but as this itself is
31 * rate limited it should not starve other requests which are processed in
32 * order that they are received.
34 * Each user registers to get a client block which uniquely identifies it
35 * and stores information such as the necessary functions to callback when
36 * action is required.
39 struct s3c_adc_client {
40 struct platform_device *pdev;
41 struct list_head pend;
43 unsigned int nr_samples;
44 unsigned char is_ts;
45 unsigned char channel;
47 void (*select_cb)(unsigned selected);
48 void (*convert_cb)(unsigned val1, unsigned val2);
51 struct adc_device {
52 struct platform_device *pdev;
53 struct platform_device *owner;
54 struct clk *clk;
55 struct s3c_adc_client *cur;
56 struct s3c_adc_client *ts_pend;
57 void __iomem *regs;
59 unsigned int prescale;
61 int irq;
64 static struct adc_device *adc_dev;
66 static LIST_HEAD(adc_pending);
68 #define adc_dbg(_adc, msg...) dev_dbg(&(_adc)->pdev->dev, msg)
70 static inline void s3c_adc_convert(struct adc_device *adc)
72 unsigned con = readl(adc->regs + S3C2410_ADCCON);
74 con |= S3C2410_ADCCON_ENABLE_START;
75 writel(con, adc->regs + S3C2410_ADCCON);
78 static inline void s3c_adc_select(struct adc_device *adc,
79 struct s3c_adc_client *client)
81 unsigned con = readl(adc->regs + S3C2410_ADCCON);
83 client->select_cb(1);
85 con &= ~S3C2410_ADCCON_MUXMASK;
86 con &= ~S3C2410_ADCCON_STDBM;
87 con &= ~S3C2410_ADCCON_STARTMASK;
89 if (!client->is_ts)
90 con |= S3C2410_ADCCON_SELMUX(client->channel);
92 writel(con, adc->regs + S3C2410_ADCCON);
95 static void s3c_adc_dbgshow(struct adc_device *adc)
97 adc_dbg(adc, "CON=%08x, TSC=%08x, DLY=%08x\n",
98 readl(adc->regs + S3C2410_ADCCON),
99 readl(adc->regs + S3C2410_ADCTSC),
100 readl(adc->regs + S3C2410_ADCDLY));
103 static void s3c_adc_try(struct adc_device *adc)
105 struct s3c_adc_client *next = adc->ts_pend;
107 if (!next && !list_empty(&adc_pending)) {
108 next = list_first_entry(&adc_pending,
109 struct s3c_adc_client, pend);
110 list_del(&next->pend);
111 } else
112 adc->ts_pend = NULL;
114 if (next) {
115 adc_dbg(adc, "new client is %p\n", next);
116 adc->cur = next;
117 s3c_adc_select(adc, next);
118 s3c_adc_convert(adc);
119 s3c_adc_dbgshow(adc);
123 int s3c_adc_start(struct s3c_adc_client *client,
124 unsigned int channel, unsigned int nr_samples)
126 struct adc_device *adc = adc_dev;
127 unsigned long flags;
129 if (!adc) {
130 printk(KERN_ERR "%s: failed to find adc\n", __func__);
131 return -EINVAL;
134 if (client->is_ts && adc->ts_pend)
135 return -EAGAIN;
137 local_irq_save(flags);
139 client->channel = channel;
140 client->nr_samples = nr_samples;
142 if (client->is_ts)
143 adc->ts_pend = client;
144 else
145 list_add_tail(&client->pend, &adc_pending);
147 if (!adc->cur)
148 s3c_adc_try(adc);
149 local_irq_restore(flags);
151 return 0;
153 EXPORT_SYMBOL_GPL(s3c_adc_start);
155 static void s3c_adc_default_select(unsigned select)
159 struct s3c_adc_client *s3c_adc_register(struct platform_device *pdev,
160 void (*select)(unsigned int selected),
161 void (*conv)(unsigned d0, unsigned d1),
162 unsigned int is_ts)
164 struct s3c_adc_client *client;
166 WARN_ON(!pdev);
167 WARN_ON(!conv);
169 if (!select)
170 select = s3c_adc_default_select;
172 if (!conv || !pdev)
173 return ERR_PTR(-EINVAL);
175 client = kzalloc(sizeof(struct s3c_adc_client), GFP_KERNEL);
176 if (!client) {
177 dev_err(&pdev->dev, "no memory for adc client\n");
178 return ERR_PTR(-ENOMEM);
181 client->pdev = pdev;
182 client->is_ts = is_ts;
183 client->select_cb = select;
184 client->convert_cb = conv;
186 return client;
188 EXPORT_SYMBOL_GPL(s3c_adc_register);
190 void s3c_adc_release(struct s3c_adc_client *client)
192 /* We should really check that nothing is in progress. */
193 if (adc_dev->cur == client)
194 adc_dev->cur = NULL;
195 if (adc_dev->ts_pend == client)
196 adc_dev->ts_pend = NULL;
197 else {
198 struct list_head *p, *n;
199 struct s3c_adc_client *tmp;
201 list_for_each_safe(p, n, &adc_pending) {
202 tmp = list_entry(p, struct s3c_adc_client, pend);
203 if (tmp == client)
204 list_del(&tmp->pend);
208 if (adc_dev->cur == NULL)
209 s3c_adc_try(adc_dev);
210 kfree(client);
212 EXPORT_SYMBOL_GPL(s3c_adc_release);
214 static irqreturn_t s3c_adc_irq(int irq, void *pw)
216 struct adc_device *adc = pw;
217 struct s3c_adc_client *client = adc->cur;
218 unsigned long flags;
219 unsigned data0, data1;
221 if (!client) {
222 dev_warn(&adc->pdev->dev, "%s: no adc pending\n", __func__);
223 return IRQ_HANDLED;
226 data0 = readl(adc->regs + S3C2410_ADCDAT0);
227 data1 = readl(adc->regs + S3C2410_ADCDAT1);
228 adc_dbg(adc, "read %d: 0x%04x, 0x%04x\n", client->nr_samples, data0, data1);
230 (client->convert_cb)(data0 & 0x3ff, data1 & 0x3ff);
232 if (--client->nr_samples > 0) {
233 /* fire another conversion for this */
235 client->select_cb(1);
236 s3c_adc_convert(adc);
237 } else {
238 local_irq_save(flags);
239 (client->select_cb)(0);
240 adc->cur = NULL;
242 s3c_adc_try(adc);
243 local_irq_restore(flags);
246 return IRQ_HANDLED;
249 static int s3c_adc_probe(struct platform_device *pdev)
251 struct device *dev = &pdev->dev;
252 struct adc_device *adc;
253 struct resource *regs;
254 int ret;
256 adc = kzalloc(sizeof(struct adc_device), GFP_KERNEL);
257 if (adc == NULL) {
258 dev_err(dev, "failed to allocate adc_device\n");
259 return -ENOMEM;
262 adc->pdev = pdev;
263 adc->prescale = S3C2410_ADCCON_PRSCVL(49);
265 adc->irq = platform_get_irq(pdev, 1);
266 if (adc->irq <= 0) {
267 dev_err(dev, "failed to get adc irq\n");
268 ret = -ENOENT;
269 goto err_alloc;
272 ret = request_irq(adc->irq, s3c_adc_irq, 0, dev_name(dev), adc);
273 if (ret < 0) {
274 dev_err(dev, "failed to attach adc irq\n");
275 goto err_alloc;
278 adc->clk = clk_get(dev, "adc");
279 if (IS_ERR(adc->clk)) {
280 dev_err(dev, "failed to get adc clock\n");
281 ret = PTR_ERR(adc->clk);
282 goto err_irq;
285 regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
286 if (!regs) {
287 dev_err(dev, "failed to find registers\n");
288 ret = -ENXIO;
289 goto err_clk;
292 adc->regs = ioremap(regs->start, resource_size(regs));
293 if (!adc->regs) {
294 dev_err(dev, "failed to map registers\n");
295 ret = -ENXIO;
296 goto err_clk;
299 clk_enable(adc->clk);
301 writel(adc->prescale | S3C2410_ADCCON_PRSCEN,
302 adc->regs + S3C2410_ADCCON);
304 dev_info(dev, "attached adc driver\n");
306 platform_set_drvdata(pdev, adc);
307 adc_dev = adc;
309 return 0;
311 err_clk:
312 clk_put(adc->clk);
314 err_irq:
315 free_irq(adc->irq, adc);
317 err_alloc:
318 kfree(adc);
319 return ret;
322 static int s3c_adc_remove(struct platform_device *pdev)
324 struct adc_device *adc = platform_get_drvdata(pdev);
326 iounmap(adc->regs);
327 free_irq(adc->irq, adc);
328 clk_disable(adc->clk);
329 clk_put(adc->clk);
330 kfree(adc);
332 return 0;
335 #ifdef CONFIG_PM
336 static int s3c_adc_suspend(struct platform_device *pdev, pm_message_t state)
338 struct adc_device *adc = platform_get_drvdata(pdev);
339 u32 con;
341 con = readl(adc->regs + S3C2410_ADCCON);
342 con |= S3C2410_ADCCON_STDBM;
343 writel(con, adc->regs + S3C2410_ADCCON);
345 clk_disable(adc->clk);
347 return 0;
350 static int s3c_adc_resume(struct platform_device *pdev)
352 struct adc_device *adc = platform_get_drvdata(pdev);
354 clk_enable(adc->clk);
356 writel(adc->prescale | S3C2410_ADCCON_PRSCEN,
357 adc->regs + S3C2410_ADCCON);
359 return 0;
362 #else
363 #define s3c_adc_suspend NULL
364 #define s3c_adc_resume NULL
365 #endif
367 static struct platform_driver s3c_adc_driver = {
368 .driver = {
369 .name = "s3c24xx-adc",
370 .owner = THIS_MODULE,
372 .probe = s3c_adc_probe,
373 .remove = __devexit_p(s3c_adc_remove),
374 .suspend = s3c_adc_suspend,
375 .resume = s3c_adc_resume,
378 static int __init adc_init(void)
380 int ret;
382 ret = platform_driver_register(&s3c_adc_driver);
383 if (ret)
384 printk(KERN_ERR "%s: failed to add adc driver\n", __func__);
386 return ret;
389 arch_initcall(adc_init);