1 /* drivers/adc/chips/rk30_tadc.c
\r
3 * This program is free software; you can redistribute it and/or modify
\r
4 * it under the terms of the GNU General Public License as published by
\r
5 * the Free Software Foundation; either version 2 of the License.
\r
7 #include <linux/kernel.h>
\r
8 #include <linux/module.h>
\r
9 #include <linux/init.h>
\r
10 #include <linux/device.h>
\r
11 #include <linux/platform_device.h>
\r
12 #include <linux/err.h>
\r
13 #include <linux/clk.h>
\r
14 #include <linux/interrupt.h>
\r
15 #include <linux/io.h>
\r
16 #include <linux/adc.h>
\r
17 #include <linux/delay.h>
\r
18 #include <linux/slab.h>
\r
21 #include "rk30_tsadc.h"
\r
24 #define ADC_POLL 1 //if no tsadc intterupt
\r
26 struct rk30_tsadc_device {
\r
30 struct resource *ioarea;
\r
31 struct adc_host *adc;
\r
33 static void rk30_tsadc_start(struct adc_host *adc)
\r
35 struct rk30_tsadc_device *dev = adc_priv(adc);
\r
36 int chn = adc->cur->chn;
\r
38 writel(0, dev->regs + ADC_CTRL);
\r
39 writel(ADC_CTRL_POWER_UP|ADC_CTRL_CH(chn), dev->regs + ADC_CTRL);
\r
40 udelay(SAMPLE_RATE);
\r
42 writel(readl(dev->regs + ADC_CTRL)|ADC_CTRL_IRQ_ENABLE|ADC_CTRL_START,
\r
43 dev->regs + ADC_CTRL);
\r
47 static void rk30_tsadc_start_poll(struct adc_host *adc)
\r
49 struct rk30_tsadc_device *dev = adc_priv(adc);
\r
50 int chn = adc->cur->chn;
\r
52 writel(0, dev->regs + ADC_CTRL);
\r
53 writel(ADC_CTRL_POWER_UP|ADC_CTRL_CH(chn), dev->regs + ADC_CTRL);
\r
54 udelay(SAMPLE_RATE);
\r
56 writel(readl(dev->regs + ADC_CTRL)|ADC_CTRL_START,
\r
57 dev->regs + ADC_CTRL);
\r
61 static void rk30_tsadc_stop(struct adc_host *adc)
\r
63 struct rk30_tsadc_device *dev = adc_priv(adc);
\r
65 writel(0, dev->regs + ADC_CTRL);
\r
67 static int rk30_tsadc_read(struct adc_host *adc)
\r
69 struct rk30_tsadc_device *dev = adc_priv(adc);
\r
71 udelay(SAMPLE_RATE);
\r
72 return readl(dev->regs + ADC_DATA) & ADC_DATA_MASK;
\r
74 static irqreturn_t rk30_tsadc_irq(int irq, void *data)
\r
76 struct rk30_tsadc_device *dev = data;
\r
77 adc_core_irq_handle(dev->adc);
\r
80 static const struct adc_ops rk30_tsadc_ops = {
\r
81 .start = rk30_tsadc_start,
\r
82 .stop = rk30_tsadc_stop,
\r
83 .read = rk30_tsadc_read,
\r
88 struct adc_test_data {
\r
89 struct adc_client client[2];
\r
90 struct timer_list timer;
\r
91 struct work_struct timer_work;
\r
93 static void callback_test(struct adc_client *client, void *param, int result)
\r
97 dev_info(client[i].adc->dev, "[chn=%d] async_read = %d\n", client[i].chn, result);
\r
100 static void adc_timer(unsigned long data)
\r
102 //int sync_read = 0;
\r
103 struct adc_test_data *test=(struct adc_test_data *)data;
\r
105 //sync_read = adc_sync_read(test->client);
\r
106 //dev_info(test->client->adc->dev, "[chn%d] sync_read = %d\n", 0, sync_read);
\r
107 schedule_work(&test->timer_work);
\r
108 add_timer(&test->timer);
\r
111 static void adc_timer_work(struct work_struct *work)
\r
113 struct adc_test_data *test = container_of(work, struct adc_test_data,
\r
117 int ret = 0, count = 0;
\r
118 struct adc_host *adc = test->client[i].adc;
\r
119 struct rk30_tsadc_device *dev = adc_priv(adc);
\r
120 adc->cur = &test->client[i];
\r
121 rk30_tsadc_start(adc);
\r
124 udelay(SAMPLE_RATE);
\r
125 ret = readl(dev->regs + ADC_STAS);
\r
126 if(!(ret & ADC_STAS_BUSY))
\r
128 rk30_tsadc_stop(adc);
\r
133 rk30_tsadc_stop(adc);
\r
134 printk("%s:timeout\n",__func__);
\r
139 sync_read = readl(dev->regs + ADC_DATA);
\r
140 dev_info(test->client[i].adc->dev, "[chn=%d] sync_read = %d\n", i, sync_read);
\r
145 adc_async_read(&test->client[i]);
\r
146 sync_read = adc_sync_read(&test->client[i]);
\r
147 dev_info(test->client[i].adc->dev, "[chn=%d] sync_read = %d\n", i, sync_read);
\r
152 static int rk30_tsadc_test(void)
\r
154 struct adc_test_data *test = NULL;
\r
156 test = kzalloc(sizeof(struct adc_test_data), GFP_KERNEL);
\r
158 test->client[i] = *adc_register(i, callback_test, NULL);
\r
160 INIT_WORK(&test->timer_work, adc_timer_work);
\r
161 setup_timer(&test->timer, adc_timer, (unsigned long)test);
\r
162 test->timer.expires = jiffies + 200;
\r
163 add_timer(&test->timer);
\r
170 struct temp_sample_data {
\r
171 struct adc_client client[2];
\r
172 struct timer_list timer;
\r
173 struct work_struct timer_work;
\r
175 static struct temp_sample_data *gtemp;
\r
176 static void callback(struct adc_client *client, void *param, int result)
\r
180 dev_info(client[i].adc->dev, "[chn=%d] async_read = %d\n", client[i].chn, result);
\r
184 static int rk30_temp_sample_init(void)
\r
186 struct temp_sample_data *temp = NULL;
\r
188 temp = kzalloc(sizeof(struct temp_sample_data), GFP_KERNEL);
\r
190 printk("%s:no memory for adc request\n",__func__);
\r
195 temp->client[i] = *adc_register(i, callback, NULL);
\r
202 int rk30_temp_sample(int chn, int *result)
\r
205 int i = 0, num = 0;
\r
207 int ret = 0, count = 0;
\r
208 struct temp_sample_data *temp = gtemp;
\r
209 struct adc_host *adc;
\r
210 struct rk30_tsadc_device *dev;
\r
211 chn &= 0x01; //0 or 1
\r
212 adc = temp->client[chn].adc;
\r
213 dev = adc_priv(adc);
\r
214 adc->cur = &temp->client[chn];
\r
215 rk30_tsadc_start_poll(adc);
\r
218 udelay(SAMPLE_RATE);
\r
219 ret = readl(dev->regs + ADC_STAS);
\r
220 if(!(ret & ADC_STAS_BUSY))
\r
222 rk30_tsadc_stop(adc);
\r
227 rk30_tsadc_stop(adc);
\r
228 printk("%s:timeout\n",__func__);
\r
233 sync_read = readl(dev->regs + ADC_DATA);
\r
234 //dev_info(temp->client[chn].adc->dev, "[chn=%d] sync_read = %d\n", chn, sync_read);
\r
236 adc_async_read(>emp->client[chn]);
\r
237 sync_read = adc_sync_read(>emp->client[chn]);
\r
238 dev_info(gtemp->client[chn].adc->dev, "[chn=%d] sync_read = %d\n", chn, sync_read);
\r
240 //get temperature according to ADC value
\r
241 num = sizeof(table_code_to_temp)/sizeof(struct tsadc_table);
\r
242 for(i=0; i<num-1;i++)
\r
244 if((sync_read >= table_code_to_temp[i+1].code) && (sync_read < table_code_to_temp[i].code))
\r
246 *result = table_code_to_temp[i+1].temp;
\r
251 if(sync_read <= table_code_to_temp[num-1].code)
\r
253 *result = table_code_to_temp[num-1].temp;
\r
254 printk("%s:temperature is out of table\n",__func__);
\r
257 else if(sync_read >= table_code_to_temp[0].code)
\r
259 *result = table_code_to_temp[0].temp;
\r
260 printk("%s:temperature is out of table\n",__func__);
\r
268 EXPORT_SYMBOL(rk30_temp_sample);
\r
272 static int rk30_tsadc_probe(struct platform_device *pdev)
\r
274 struct adc_host *adc = NULL;
\r
275 struct rk30_tsadc_device *dev;
\r
276 struct resource *res;
\r
279 adc = adc_alloc_host(sizeof(struct rk30_tsadc_device), &pdev->dev);
\r
282 spin_lock_init(&adc->lock);
\r
283 adc->dev = &pdev->dev;
\r
284 adc->is_suspended = 0;
\r
285 adc->ops = &rk30_tsadc_ops;
\r
286 dev = adc_priv(adc);
\r
288 dev->irq = platform_get_irq(pdev, 0);
\r
289 if (dev->irq <= 0) {
\r
290 dev_err(&pdev->dev, "failed to get adc irq\n");
\r
295 ret = request_irq(dev->irq, rk30_tsadc_irq, 0, pdev->name, dev);
\r
297 dev_err(&pdev->dev, "failed to attach adc irq\n");
\r
301 dev->clk = clk_get(&pdev->dev, "saradc");
\r
302 if (IS_ERR(dev->clk)) {
\r
303 dev_err(&pdev->dev, "failed to get adc clock\n");
\r
304 ret = PTR_ERR(dev->clk);
\r
308 //ret = clk_set_rate(dev->clk, ADC_CLK_RATE * 1000 * 1000);
\r
310 // dev_err(&pdev->dev, "failed to set adc clk\n");
\r
313 clk_enable(dev->clk);
\r
315 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
\r
317 dev_err(&pdev->dev, "cannot find IO resource\n");
\r
321 dev->ioarea = request_mem_region(res->start, (res->end - res->start) + 1,
\r
323 if(dev->ioarea == NULL) {
\r
324 dev_err(&pdev->dev, "cannot request IO\n");
\r
328 dev->regs = ioremap(res->start, (res->end - res->start) + 1);
\r
330 dev_err(&pdev->dev, "cannot map IO\n");
\r
334 platform_set_drvdata(pdev, dev);
\r
335 dev_info(&pdev->dev, "rk30 adc: driver initialized\n");
\r
338 // iounmap(dev->regs);
\r
341 release_resource(dev->ioarea);
\r
342 kfree(dev->ioarea);
\r
343 clk_disable(dev->clk);
\r
349 free_irq(dev->irq, dev);
\r
352 adc_free_host(dev->adc);
\r
356 static int rk30_tsadc_remove(struct platform_device *pdev)
\r
358 struct rk30_tsadc_device *dev = platform_get_drvdata(pdev);
\r
360 iounmap(dev->regs);
\r
361 release_resource(dev->ioarea);
\r
362 kfree(dev->ioarea);
\r
363 free_irq(dev->irq, dev);
\r
364 clk_disable(dev->clk);
\r
366 adc_free_host(dev->adc);
\r
372 static int rk30_tsadc_suspend(struct platform_device *pdev, pm_message_t state)
\r
374 struct rk30_tsadc_device *dev = platform_get_drvdata(pdev);
\r
376 dev->adc->is_suspended = 1;
\r
380 static int rk30_tsadc_resume(struct platform_device *pdev)
\r
382 struct rk30_tsadc_device *dev = platform_get_drvdata(pdev);
\r
384 dev->adc->is_suspended = 0;
\r
389 #define rk30_tsadc_suspend NULL
\r
390 #define rk30_tsadc_resume NULL
\r
393 static struct platform_driver rk30_tsadc_driver = {
\r
395 .name = "rk30-tsadc",
\r
396 .owner = THIS_MODULE,
\r
398 .probe = rk30_tsadc_probe,
\r
399 .remove = __devexit_p(rk30_tsadc_remove),
\r
400 .suspend = rk30_tsadc_suspend,
\r
401 .resume = rk30_tsadc_resume,
\r
404 static int __init rk30_tsadc_init(void)
\r
406 return platform_driver_register(&rk30_tsadc_driver);
\r
408 subsys_initcall(rk30_tsadc_init);
\r
410 static void __exit rk30_tsadc_exit(void)
\r
412 platform_driver_unregister(&rk30_tsadc_driver);
\r
414 module_exit(rk30_tsadc_exit);
\r
416 MODULE_DESCRIPTION("Driver for TSADC");
\r
417 MODULE_AUTHOR("lw, lw@rock-chips.com");
\r
418 MODULE_LICENSE("GPL");
\r
420 static int __init rk30_temp_init(void)
\r
423 ret = rk30_temp_sample_init();
\r
427 printk("%s:initialized\n",__func__);
\r
431 static void __exit rk30_temp_exit(void)
\r
434 struct temp_sample_data *temp = gtemp;
\r
436 adc_unregister(&temp->client[i]);
\r
440 module_init(rk30_temp_init);
\r
441 module_exit(rk30_temp_exit);
\r