blob: e9031fa9d53d1983e0dfe5ee5307bf8d24f79857 [file] [log] [blame]
Marek Vašutd9105c22008-08-03 21:34:08 +01001/*
2 * Core functions for:
3 * Philips UCB1400 multifunction chip
4 *
5 * Based on ucb1400_ts.c:
6 * Author: Nicolas Pitre
7 * Created: September 25, 2006
8 * Copyright: MontaVista Software, Inc.
9 *
10 * Spliting done by: Marek Vasut <marek.vasut@gmail.com>
Lucas De Marchi25985ed2011-03-30 22:57:33 -030011 * If something doesn't work and it worked before spliting, e-mail me,
Marek Vašutd9105c22008-08-03 21:34:08 +010012 * dont bother Nicolas please ;-)
13 *
14 * This program is free software; you can redistribute it and/or modify
15 * it under the terms of the GNU General Public License version 2 as
16 * published by the Free Software Foundation.
17 *
18 * This code is heavily based on ucb1x00-*.c copyrighted by Russell King
19 * covering the UCB1100, UCB1200 and UCB1300.. Support for the UCB1400 has
20 * been made separate from ucb1x00-core/ucb1x00-ts on Russell's request.
21 */
22
23#include <linux/module.h>
Alexey Dobriyana99bbaf2009-10-04 16:11:37 +040024#include <linux/sched.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090025#include <linux/slab.h>
Marek Vašutd9105c22008-08-03 21:34:08 +010026#include <linux/ucb1400.h>
27
Sebastian Andrzej Siewiorcbf806d2009-05-27 06:22:58 -070028unsigned int ucb1400_adc_read(struct snd_ac97 *ac97, u16 adc_channel,
29 int adcsync)
30{
31 unsigned int val;
32
33 if (adcsync)
34 adc_channel |= UCB_ADC_SYNC_ENA;
35
36 ucb1400_reg_write(ac97, UCB_ADC_CR, UCB_ADC_ENA | adc_channel);
37 ucb1400_reg_write(ac97, UCB_ADC_CR, UCB_ADC_ENA | adc_channel |
38 UCB_ADC_START);
39
40 while (!((val = ucb1400_reg_read(ac97, UCB_ADC_DATA))
41 & UCB_ADC_DAT_VALID))
42 schedule_timeout_uninterruptible(1);
43
44 return val & UCB_ADC_DAT_MASK;
45}
46EXPORT_SYMBOL_GPL(ucb1400_adc_read);
47
Marek Vašutd9105c22008-08-03 21:34:08 +010048static int ucb1400_core_probe(struct device *dev)
49{
50 int err;
51 struct ucb1400 *ucb;
52 struct ucb1400_ts ucb_ts;
Marek Vasut4cf8e532009-09-22 16:46:35 -070053 struct ucb1400_gpio ucb_gpio;
Marek Vašutd9105c22008-08-03 21:34:08 +010054 struct snd_ac97 *ac97;
Marek Vasutfb141592009-11-08 19:45:54 -080055 struct ucb1400_pdata *pdata = dev->platform_data;
Marek Vašutd9105c22008-08-03 21:34:08 +010056
57 memset(&ucb_ts, 0, sizeof(ucb_ts));
Marek Vasut4cf8e532009-09-22 16:46:35 -070058 memset(&ucb_gpio, 0, sizeof(ucb_gpio));
Marek Vašutd9105c22008-08-03 21:34:08 +010059
60 ucb = kzalloc(sizeof(struct ucb1400), GFP_KERNEL);
61 if (!ucb) {
62 err = -ENOMEM;
63 goto err;
64 }
65
66 dev_set_drvdata(dev, ucb);
67
68 ac97 = to_ac97_t(dev);
69
70 ucb_ts.id = ucb1400_reg_read(ac97, UCB_ID);
71 if (ucb_ts.id != UCB_ID_1400) {
72 err = -ENODEV;
73 goto err0;
74 }
75
Marek Vasut4cf8e532009-09-22 16:46:35 -070076 /* GPIO */
77 ucb_gpio.ac97 = ac97;
Marek Vasut360e64d2013-04-14 20:35:48 +020078 if (pdata) {
79 ucb_gpio.gpio_setup = pdata->gpio_setup;
80 ucb_gpio.gpio_teardown = pdata->gpio_teardown;
81 ucb_gpio.gpio_offset = pdata->gpio_offset;
82 }
Marek Vasut4cf8e532009-09-22 16:46:35 -070083 ucb->ucb1400_gpio = platform_device_alloc("ucb1400_gpio", -1);
84 if (!ucb->ucb1400_gpio) {
85 err = -ENOMEM;
86 goto err0;
87 }
88 err = platform_device_add_data(ucb->ucb1400_gpio, &ucb_gpio,
89 sizeof(ucb_gpio));
90 if (err)
91 goto err1;
92 err = platform_device_add(ucb->ucb1400_gpio);
93 if (err)
94 goto err1;
95
Marek Vašutd9105c22008-08-03 21:34:08 +010096 /* TOUCHSCREEN */
97 ucb_ts.ac97 = ac97;
Marek Vasutfb141592009-11-08 19:45:54 -080098
99 if (pdata != NULL && pdata->irq >= 0)
100 ucb_ts.irq = pdata->irq;
101 else
102 ucb_ts.irq = -1;
103
Marek Vašutd9105c22008-08-03 21:34:08 +0100104 ucb->ucb1400_ts = platform_device_alloc("ucb1400_ts", -1);
105 if (!ucb->ucb1400_ts) {
106 err = -ENOMEM;
Marek Vasut4cf8e532009-09-22 16:46:35 -0700107 goto err2;
Marek Vašutd9105c22008-08-03 21:34:08 +0100108 }
109 err = platform_device_add_data(ucb->ucb1400_ts, &ucb_ts,
110 sizeof(ucb_ts));
111 if (err)
Marek Vasut4cf8e532009-09-22 16:46:35 -0700112 goto err3;
Marek Vašutd9105c22008-08-03 21:34:08 +0100113 err = platform_device_add(ucb->ucb1400_ts);
114 if (err)
Marek Vasut4cf8e532009-09-22 16:46:35 -0700115 goto err3;
Marek Vašutd9105c22008-08-03 21:34:08 +0100116
117 return 0;
118
Marek Vasut4cf8e532009-09-22 16:46:35 -0700119err3:
Marek Vašutd9105c22008-08-03 21:34:08 +0100120 platform_device_put(ucb->ucb1400_ts);
Marek Vasut4cf8e532009-09-22 16:46:35 -0700121err2:
Axel Linef256172010-08-03 16:34:13 +0800122 platform_device_del(ucb->ucb1400_gpio);
Marek Vasut4cf8e532009-09-22 16:46:35 -0700123err1:
124 platform_device_put(ucb->ucb1400_gpio);
Marek Vašutd9105c22008-08-03 21:34:08 +0100125err0:
126 kfree(ucb);
127err:
128 return err;
129}
130
131static int ucb1400_core_remove(struct device *dev)
132{
133 struct ucb1400 *ucb = dev_get_drvdata(dev);
134
135 platform_device_unregister(ucb->ucb1400_ts);
Marek Vasut4cf8e532009-09-22 16:46:35 -0700136 platform_device_unregister(ucb->ucb1400_gpio);
137
Marek Vašutd9105c22008-08-03 21:34:08 +0100138 kfree(ucb);
139 return 0;
140}
141
142static struct device_driver ucb1400_core_driver = {
143 .name = "ucb1400_core",
144 .bus = &ac97_bus_type,
145 .probe = ucb1400_core_probe,
146 .remove = ucb1400_core_remove,
147};
148
149static int __init ucb1400_core_init(void)
150{
151 return driver_register(&ucb1400_core_driver);
152}
153
154static void __exit ucb1400_core_exit(void)
155{
156 driver_unregister(&ucb1400_core_driver);
157}
158
159module_init(ucb1400_core_init);
160module_exit(ucb1400_core_exit);
161
162MODULE_DESCRIPTION("Philips UCB1400 driver");
163MODULE_LICENSE("GPL");