1 /* drivers/adc/chips/rk30_adc.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/adc.h>
\r
9 #include "../adc_priv.h"
\r
10 #include "rk30_adc.h"
\r
14 struct rk30_adc_device {
\r
19 struct resource *ioarea;
\r
20 struct adc_host *adc;
\r
22 static void rk30_adc_dump(struct adc_host *adc)
\r
24 struct rk30_adc_device *dev = adc_priv(adc);
\r
26 dev_info(adc->dev, "[0x00-0x0c]: 0x%08x 0x%08x 0x%08x 0x%08x\n",
\r
27 adc_readl(dev->regs + 0x00),
\r
28 adc_readl(dev->regs + 0x04),
\r
29 adc_readl(dev->regs + 0x08),
\r
30 adc_readl(dev->regs + 0x0c));
\r
32 static void rk30_adc_start(struct adc_host *adc)
\r
34 struct rk30_adc_device *dev = adc_priv(adc);
\r
37 //adc_writel(0, dev->regs + ADC_CTRL);
\r
38 adc_writel(0x08, dev->regs + ADC_DELAY_PU_SOC);
\r
39 adc_writel(ADC_CTRL_POWER_UP|ADC_CTRL_CH(chn)|ADC_CTRL_IRQ_ENABLE, dev->regs + ADC_CTRL);
\r
43 static void rk30_adc_stop(struct adc_host *adc)
\r
45 struct rk30_adc_device *dev = adc_priv(adc);
\r
47 adc_writel(0, dev->regs + ADC_CTRL);
\r
48 udelay(SAMPLE_RATE);
\r
50 static int rk30_adc_read(struct adc_host *adc)
\r
52 struct rk30_adc_device *dev = adc_priv(adc);
\r
54 return adc_readl(dev->regs + ADC_DATA) & ADC_DATA_MASK;
\r
56 static irqreturn_t rk30_adc_irq(int irq, void *data)
\r
58 struct rk30_adc_device *dev = data;
\r
60 adc_core_irq_handle(dev->adc);
\r
63 static const struct adc_ops rk30_adc_ops = {
\r
64 .start = rk30_adc_start,
\r
65 .stop = rk30_adc_stop,
\r
66 .read = rk30_adc_read,
\r
67 .dump = rk30_adc_dump,
\r
71 struct workqueue_struct *adc_wq;
\r
72 struct adc_test_data {
\r
73 struct adc_client *client;
\r
74 struct timer_list timer;
\r
75 struct work_struct timer_work;
\r
77 static void callback(struct adc_client *client, void *param, int result)
\r
79 dev_dbg(client->adc->dev, "[chn%d] async_read = %d\n", client->chn, result);
\r
82 static void adc_timer(unsigned long data)
\r
84 struct adc_test_data *test=(struct adc_test_data *)data;
\r
86 queue_work(adc_wq, &test->timer_work);
\r
87 mod_timer(&test->timer, jiffies+msecs_to_jiffies(20));
\r
89 static void adc_timer_work(struct work_struct *work)
\r
92 struct adc_test_data *test = container_of(work, struct adc_test_data,
\r
94 adc_async_read(test->client);
\r
95 sync_read = adc_sync_read(test->client);
\r
96 dev_dbg(test->client->adc->dev, "[chn%d] sync_read = %d\n", test->client->chn, sync_read);
\r
99 static int rk30_adc_test(void)
\r
102 struct adc_test_data *test[CHN_NR];
\r
104 adc_wq = create_singlethread_workqueue("adc_test");
\r
105 for(i = 0; i < CHN_NR; i++){
\r
106 test[i] = kzalloc(sizeof(struct adc_test_data), GFP_KERNEL);
\r
107 test[i]->client = adc_register(i, callback, NULL);
\r
108 INIT_WORK(&test[i]->timer_work, adc_timer_work);
\r
109 setup_timer(&test[i]->timer, adc_timer, (unsigned long)test[i]);
\r
110 mod_timer(&test[i]->timer, jiffies+msecs_to_jiffies(20));
\r
118 static int rk30_adc_probe(struct platform_device *pdev)
\r
120 struct adc_host *adc = NULL;
\r
121 struct rk30_adc_device *dev;
\r
122 struct resource *res;
\r
125 adc = adc_alloc_host(&pdev->dev, sizeof(struct rk30_adc_device), SARADC_CHN_MASK);
\r
128 adc->ops = &rk30_adc_ops;
\r
129 dev = adc_priv(adc);
\r
131 dev->irq = platform_get_irq(pdev, 0);
\r
132 if (dev->irq <= 0) {
\r
133 dev_err(&pdev->dev, "failed to get adc irq\n");
\r
138 ret = request_threaded_irq(dev->irq, NULL, rk30_adc_irq, IRQF_ONESHOT, pdev->name, dev);
\r
140 dev_err(&pdev->dev, "failed to attach adc irq\n");
\r
144 dev->pclk = clk_get(&pdev->dev, "pclk_saradc");
\r
145 if (IS_ERR(dev->pclk)) {
\r
146 dev_err(&pdev->dev, "failed to get adc pclk\n");
\r
147 ret = PTR_ERR(dev->pclk);
\r
150 clk_enable(dev->pclk);
\r
152 dev->clk = clk_get(&pdev->dev, "saradc");
\r
153 if (IS_ERR(dev->clk)) {
\r
154 dev_err(&pdev->dev, "failed to get adc clock\n");
\r
155 ret = PTR_ERR(dev->clk);
\r
159 ret = clk_set_rate(dev->clk, ADC_CLK_RATE * 1000 * 1000);
\r
161 dev_err(&pdev->dev, "failed to set adc clk\n");
\r
164 clk_enable(dev->clk);
\r
166 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
\r
168 dev_err(&pdev->dev, "cannot find IO resource\n");
\r
172 dev->ioarea = request_mem_region(res->start, (res->end - res->start) + 1,
\r
174 if(dev->ioarea == NULL) {
\r
175 dev_err(&pdev->dev, "cannot request IO\n");
\r
179 dev->regs = ioremap(res->start, (res->end - res->start) + 1);
\r
181 dev_err(&pdev->dev, "cannot map IO\n");
\r
185 platform_set_drvdata(pdev, dev);
\r
186 dev_info(&pdev->dev, "rk30 adc: driver initialized\n");
\r
190 release_resource(dev->ioarea);
\r
191 kfree(dev->ioarea);
\r
194 clk_disable(dev->clk);
\r
197 clk_disable(dev->pclk);
\r
198 clk_put(dev->pclk);
\r
204 free_irq(dev->irq, dev);
\r
207 adc_free_host(dev->adc);
\r
211 static int rk30_adc_remove(struct platform_device *pdev)
\r
213 struct rk30_adc_device *dev = platform_get_drvdata(pdev);
\r
215 iounmap(dev->regs);
\r
216 release_resource(dev->ioarea);
\r
217 kfree(dev->ioarea);
\r
218 free_irq(dev->irq, dev);
\r
219 clk_disable(dev->clk);
\r
221 clk_disable(dev->pclk);
\r
222 clk_put(dev->pclk);
\r
223 adc_free_host(dev->adc);
\r
229 static int rk30_adc_suspend(struct platform_device *pdev, pm_message_t state)
\r
231 struct rk30_adc_device *dev = platform_get_drvdata(pdev);
\r
233 dev->adc->is_suspended = 1;
\r
237 static int rk30_adc_resume(struct platform_device *pdev)
\r
239 struct rk30_adc_device *dev = platform_get_drvdata(pdev);
\r
241 dev->adc->is_suspended = 0;
\r
246 #define rk30_adc_suspend NULL
\r
247 #define rk30_adc_resume NULL
\r
250 static struct platform_driver rk30_adc_driver = {
\r
252 .name = "rk30-adc",
\r
253 .owner = THIS_MODULE,
\r
255 .probe = rk30_adc_probe,
\r
256 .remove = __devexit_p(rk30_adc_remove),
\r
257 .suspend = rk30_adc_suspend,
\r
258 .resume = rk30_adc_resume,
\r
261 static int __init rk30_adc_init(void)
\r
263 return platform_driver_register(&rk30_adc_driver);
\r
265 subsys_initcall(rk30_adc_init);
\r
267 static void __exit rk30_adc_exit(void)
\r
269 platform_driver_unregister(&rk30_adc_driver);
\r
271 module_exit(rk30_adc_exit);
\r
273 MODULE_DESCRIPTION("Driver for ADC");
\r
274 MODULE_AUTHOR("kfx, kfx@rock-chips.com");
\r
275 MODULE_LICENSE("GPL");
\r
276 static int __init adc_test_init(void)
\r
284 module_init(adc_test_init);
\r