mfd/gpio: add a GPIO interface to the UCB1400 MFD chip driver via gpiolib
[linux-2.6.git] / drivers / mfd / ucb1400_core.c
1 /*
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>
11  * If something doesnt work and it worked before spliting, e-mail me,
12  * 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>
24 #include <linux/ucb1400.h>
25
26 unsigned int ucb1400_adc_read(struct snd_ac97 *ac97, u16 adc_channel,
27                 int adcsync)
28 {
29         unsigned int val;
30
31         if (adcsync)
32                 adc_channel |= UCB_ADC_SYNC_ENA;
33
34         ucb1400_reg_write(ac97, UCB_ADC_CR, UCB_ADC_ENA | adc_channel);
35         ucb1400_reg_write(ac97, UCB_ADC_CR, UCB_ADC_ENA | adc_channel |
36                         UCB_ADC_START);
37
38         while (!((val = ucb1400_reg_read(ac97, UCB_ADC_DATA))
39                                 & UCB_ADC_DAT_VALID))
40                 schedule_timeout_uninterruptible(1);
41
42         return val & UCB_ADC_DAT_MASK;
43 }
44 EXPORT_SYMBOL_GPL(ucb1400_adc_read);
45
46 static int ucb1400_core_probe(struct device *dev)
47 {
48         int err;
49         struct ucb1400 *ucb;
50         struct ucb1400_ts ucb_ts;
51         struct ucb1400_gpio ucb_gpio;
52         struct snd_ac97 *ac97;
53
54         memset(&ucb_ts, 0, sizeof(ucb_ts));
55         memset(&ucb_gpio, 0, sizeof(ucb_gpio));
56
57         ucb = kzalloc(sizeof(struct ucb1400), GFP_KERNEL);
58         if (!ucb) {
59                 err = -ENOMEM;
60                 goto err;
61         }
62
63         dev_set_drvdata(dev, ucb);
64
65         ac97 = to_ac97_t(dev);
66
67         ucb_ts.id = ucb1400_reg_read(ac97, UCB_ID);
68         if (ucb_ts.id != UCB_ID_1400) {
69                 err = -ENODEV;
70                 goto err0;
71         }
72
73         /* GPIO */
74         ucb_gpio.ac97 = ac97;
75         ucb->ucb1400_gpio = platform_device_alloc("ucb1400_gpio", -1);
76         if (!ucb->ucb1400_gpio) {
77                 err = -ENOMEM;
78                 goto err0;
79         }
80         err = platform_device_add_data(ucb->ucb1400_gpio, &ucb_gpio,
81                                         sizeof(ucb_gpio));
82         if (err)
83                 goto err1;
84         err = platform_device_add(ucb->ucb1400_gpio);
85         if (err)
86                 goto err1;
87
88         /* TOUCHSCREEN */
89         ucb_ts.ac97 = ac97;
90         ucb->ucb1400_ts = platform_device_alloc("ucb1400_ts", -1);
91         if (!ucb->ucb1400_ts) {
92                 err = -ENOMEM;
93                 goto err2;
94         }
95         err = platform_device_add_data(ucb->ucb1400_ts, &ucb_ts,
96                                         sizeof(ucb_ts));
97         if (err)
98                 goto err3;
99         err = platform_device_add(ucb->ucb1400_ts);
100         if (err)
101                 goto err3;
102
103         return 0;
104
105 err3:
106         platform_device_put(ucb->ucb1400_ts);
107 err2:
108         platform_device_unregister(ucb->ucb1400_gpio);
109 err1:
110         platform_device_put(ucb->ucb1400_gpio);
111 err0:
112         kfree(ucb);
113 err:
114         return err;
115 }
116
117 static int ucb1400_core_remove(struct device *dev)
118 {
119         struct ucb1400 *ucb = dev_get_drvdata(dev);
120
121         platform_device_unregister(ucb->ucb1400_ts);
122         platform_device_unregister(ucb->ucb1400_gpio);
123
124         kfree(ucb);
125         return 0;
126 }
127
128 static struct device_driver ucb1400_core_driver = {
129         .name   = "ucb1400_core",
130         .bus    = &ac97_bus_type,
131         .probe  = ucb1400_core_probe,
132         .remove = ucb1400_core_remove,
133 };
134
135 static int __init ucb1400_core_init(void)
136 {
137         return driver_register(&ucb1400_core_driver);
138 }
139
140 static void __exit ucb1400_core_exit(void)
141 {
142         driver_unregister(&ucb1400_core_driver);
143 }
144
145 module_init(ucb1400_core_init);
146 module_exit(ucb1400_core_exit);
147
148 MODULE_DESCRIPTION("Philips UCB1400 driver");
149 MODULE_LICENSE("GPL");