Merge ../scsi-misc-2.6
[linux-2.6] / sound / aoa / core / snd-aoa-gpio-feature.c
1 /*
2  * Apple Onboard Audio feature call GPIO control
3  *
4  * Copyright 2006 Johannes Berg <johannes@sipsolutions.net>
5  *
6  * GPL v2, can be found in COPYING.
7  *
8  * This file contains the GPIO control routines for 
9  * direct (through feature calls) access to the GPIO
10  * registers.
11  */
12
13 #include <asm/pmac_feature.h>
14 #include <linux/interrupt.h>
15 #include "../aoa.h"
16
17 /* TODO: these are 20 global variables
18  * that aren't used on most machines...
19  * Move them into a dynamically allocated
20  * structure and use that.
21  */
22
23 /* these are the GPIO numbers (register addresses as offsets into
24  * the GPIO space) */
25 static int headphone_mute_gpio;
26 static int amp_mute_gpio;
27 static int lineout_mute_gpio;
28 static int hw_reset_gpio;
29 static int lineout_detect_gpio;
30 static int headphone_detect_gpio;
31 static int linein_detect_gpio;
32
33 /* see the SWITCH_GPIO macro */
34 static int headphone_mute_gpio_activestate;
35 static int amp_mute_gpio_activestate;
36 static int lineout_mute_gpio_activestate;
37 static int hw_reset_gpio_activestate;
38 static int lineout_detect_gpio_activestate;
39 static int headphone_detect_gpio_activestate;
40 static int linein_detect_gpio_activestate;
41
42 /* node pointers that we save when getting the GPIO number
43  * to get the interrupt later */
44 static struct device_node *lineout_detect_node;
45 static struct device_node *linein_detect_node;
46 static struct device_node *headphone_detect_node;
47
48 static int lineout_detect_irq;
49 static int linein_detect_irq;
50 static int headphone_detect_irq;
51
52 static struct device_node *get_gpio(char *name,
53                                     char *altname,
54                                     int *gpioptr,
55                                     int *gpioactiveptr)
56 {
57         struct device_node *np, *gpio;
58         u32 *reg;
59         char *audio_gpio;
60
61         *gpioptr = -1;
62
63         /* check if we can get it the easy way ... */
64         np = of_find_node_by_name(NULL, name);
65         if (!np) {
66                 /* some machines have only gpioX/extint-gpioX nodes,
67                  * and an audio-gpio property saying what it is ...
68                  * So what we have to do is enumerate all children
69                  * of the gpio node and check them all. */
70                 gpio = of_find_node_by_name(NULL, "gpio");
71                 if (!gpio)
72                         return NULL;
73                 while ((np = of_get_next_child(gpio, np))) {
74                         audio_gpio = get_property(np, "audio-gpio", NULL);
75                         if (!audio_gpio)
76                                 continue;
77                         if (strcmp(audio_gpio, name) == 0)
78                                 break;
79                         if (altname && (strcmp(audio_gpio, altname) == 0))
80                                 break;
81                 }
82                 /* still not found, assume not there */
83                 if (!np)
84                         return NULL;
85         }
86
87         reg = (u32 *)get_property(np, "reg", NULL);
88         if (!reg)
89                 return NULL;
90
91         *gpioptr = *reg;
92
93         /* this is a hack, usually the GPIOs 'reg' property
94          * should have the offset based from the GPIO space
95          * which is at 0x50, but apparently not always... */
96         if (*gpioptr < 0x50)
97                 *gpioptr += 0x50;
98
99         reg = (u32 *)get_property(np, "audio-gpio-active-state", NULL);
100         if (!reg)
101                 /* Apple seems to default to 1, but
102                  * that doesn't seem right at least on most
103                  * machines. So until proven that the opposite
104                  * is necessary, we default to 0
105                  * (which, incidentally, snd-powermac also does...) */
106                 *gpioactiveptr = 0;
107         else
108                 *gpioactiveptr = *reg;
109
110         return np;
111 }
112
113 static void get_irq(struct device_node * np, int *irqptr)
114 {
115         *irqptr = -1;
116         if (!np)
117                 return;
118         if (np->n_intrs != 1)
119                 return;
120         *irqptr = np->intrs[0].line;
121 }
122
123 /* 0x4 is outenable, 0x1 is out, thus 4 or 5 */
124 #define SWITCH_GPIO(name, v, on)                                \
125         (((v)&~1) | ((on)?                                      \
126                         (name##_gpio_activestate==0?4:5):       \
127                         (name##_gpio_activestate==0?5:4)))
128
129 #define FTR_GPIO(name, bit)                                     \
130 static void ftr_gpio_set_##name(struct gpio_runtime *rt, int on)\
131 {                                                               \
132         int v;                                                  \
133                                                                 \
134         if (unlikely(!rt)) return;                              \
135                                                                 \
136         if (name##_mute_gpio < 0)                               \
137                 return;                                         \
138                                                                 \
139         v = pmac_call_feature(PMAC_FTR_READ_GPIO, NULL,         \
140                               name##_mute_gpio,                 \
141                               0);                               \
142                                                                 \
143         /* muted = !on... */                                    \
144         v = SWITCH_GPIO(name##_mute, v, !on);                   \
145                                                                 \
146         pmac_call_feature(PMAC_FTR_WRITE_GPIO, NULL,            \
147                           name##_mute_gpio, v);                 \
148                                                                 \
149         rt->implementation_private &= ~(1<<bit);                \
150         rt->implementation_private |= (!!on << bit);            \
151 }                                                               \
152 static int ftr_gpio_get_##name(struct gpio_runtime *rt)         \
153 {                                                               \
154         if (unlikely(!rt)) return 0;                            \
155         return (rt->implementation_private>>bit)&1;             \
156 }
157
158 FTR_GPIO(headphone, 0);
159 FTR_GPIO(amp, 1);
160 FTR_GPIO(lineout, 2);
161
162 static void ftr_gpio_set_hw_reset(struct gpio_runtime *rt, int on)
163 {
164         int v;
165
166         if (unlikely(!rt)) return;
167         if (hw_reset_gpio < 0)
168                 return;
169
170         v = pmac_call_feature(PMAC_FTR_READ_GPIO, NULL,
171                               hw_reset_gpio, 0);
172         v = SWITCH_GPIO(hw_reset, v, on);
173         pmac_call_feature(PMAC_FTR_WRITE_GPIO, NULL,
174                           hw_reset_gpio, v);
175 }
176
177 static void ftr_gpio_all_amps_off(struct gpio_runtime *rt)
178 {
179         int saved;
180
181         if (unlikely(!rt)) return;
182         saved = rt->implementation_private;
183         ftr_gpio_set_headphone(rt, 0);
184         ftr_gpio_set_amp(rt, 0);
185         ftr_gpio_set_lineout(rt, 0);
186         rt->implementation_private = saved;
187 }
188
189 static void ftr_gpio_all_amps_restore(struct gpio_runtime *rt)
190 {
191         int s;
192
193         if (unlikely(!rt)) return;
194         s = rt->implementation_private;
195         ftr_gpio_set_headphone(rt, (s>>0)&1);
196         ftr_gpio_set_amp(rt, (s>>1)&1);
197         ftr_gpio_set_lineout(rt, (s>>2)&1);
198 }
199
200 static void ftr_handle_notify(void *data)
201 {
202         struct gpio_notification *notif = data;
203
204         mutex_lock(&notif->mutex);
205         if (notif->notify)
206                 notif->notify(notif->data);
207         mutex_unlock(&notif->mutex);
208 }
209
210 static void gpio_enable_dual_edge(int gpio)
211 {
212         int v;
213
214         if (gpio == -1)
215                 return;
216         v = pmac_call_feature(PMAC_FTR_READ_GPIO, NULL, gpio, 0);
217         v |= 0x80; /* enable dual edge */
218         pmac_call_feature(PMAC_FTR_WRITE_GPIO, NULL, gpio, v);
219 }
220
221 static void ftr_gpio_init(struct gpio_runtime *rt)
222 {
223         get_gpio("headphone-mute", NULL,
224                  &headphone_mute_gpio,
225                  &headphone_mute_gpio_activestate);
226         get_gpio("amp-mute", NULL,
227                  &amp_mute_gpio,
228                  &amp_mute_gpio_activestate);
229         get_gpio("lineout-mute", NULL,
230                  &lineout_mute_gpio,
231                  &lineout_mute_gpio_activestate);
232         get_gpio("hw-reset", "audio-hw-reset",
233                  &hw_reset_gpio,
234                  &hw_reset_gpio_activestate);
235
236         headphone_detect_node = get_gpio("headphone-detect", NULL,
237                                          &headphone_detect_gpio,
238                                          &headphone_detect_gpio_activestate);
239         /* go Apple, and thanks for giving these different names
240          * across the board... */
241         lineout_detect_node = get_gpio("lineout-detect", "line-output-detect",
242                                        &lineout_detect_gpio,
243                                        &lineout_detect_gpio_activestate);
244         linein_detect_node = get_gpio("linein-detect", "line-input-detect",
245                                       &linein_detect_gpio,
246                                       &linein_detect_gpio_activestate);
247
248         gpio_enable_dual_edge(headphone_detect_gpio);
249         gpio_enable_dual_edge(lineout_detect_gpio);
250         gpio_enable_dual_edge(linein_detect_gpio);
251
252         get_irq(headphone_detect_node, &headphone_detect_irq);
253         get_irq(lineout_detect_node, &lineout_detect_irq);
254         get_irq(linein_detect_node, &linein_detect_irq);
255
256         ftr_gpio_all_amps_off(rt);
257         rt->implementation_private = 0;
258         INIT_WORK(&rt->headphone_notify.work, ftr_handle_notify,
259                   &rt->headphone_notify);
260         INIT_WORK(&rt->line_in_notify.work, ftr_handle_notify,
261                   &rt->line_in_notify);
262         INIT_WORK(&rt->line_out_notify.work, ftr_handle_notify,
263                   &rt->line_out_notify);
264         mutex_init(&rt->headphone_notify.mutex);
265         mutex_init(&rt->line_in_notify.mutex);
266         mutex_init(&rt->line_out_notify.mutex);
267 }
268
269 static void ftr_gpio_exit(struct gpio_runtime *rt)
270 {
271         ftr_gpio_all_amps_off(rt);
272         rt->implementation_private = 0;
273         if (rt->headphone_notify.notify)
274                 free_irq(headphone_detect_irq, &rt->headphone_notify);
275         if (rt->line_in_notify.gpio_private)
276                 free_irq(linein_detect_irq, &rt->line_in_notify);
277         if (rt->line_out_notify.gpio_private)
278                 free_irq(lineout_detect_irq, &rt->line_out_notify);
279         cancel_delayed_work(&rt->headphone_notify.work);
280         cancel_delayed_work(&rt->line_in_notify.work);
281         cancel_delayed_work(&rt->line_out_notify.work);
282         flush_scheduled_work();
283         mutex_destroy(&rt->headphone_notify.mutex);
284         mutex_destroy(&rt->line_in_notify.mutex);
285         mutex_destroy(&rt->line_out_notify.mutex);
286 }
287
288 static irqreturn_t ftr_handle_notify_irq(int xx,
289                                          void *data,
290                                          struct pt_regs *regs)
291 {
292         struct gpio_notification *notif = data;
293
294         schedule_work(&notif->work);
295
296         return IRQ_HANDLED;
297 }
298
299 static int ftr_set_notify(struct gpio_runtime *rt,
300                           enum notify_type type,
301                           notify_func_t notify,
302                           void *data)
303 {
304         struct gpio_notification *notif;
305         notify_func_t old;
306         int irq;
307         char *name;
308         int err = -EBUSY;
309
310         switch (type) {
311         case AOA_NOTIFY_HEADPHONE:
312                 notif = &rt->headphone_notify;
313                 name = "headphone-detect";
314                 irq = headphone_detect_irq;
315                 break;
316         case AOA_NOTIFY_LINE_IN:
317                 notif = &rt->line_in_notify;
318                 name = "linein-detect";
319                 irq = linein_detect_irq;
320                 break;
321         case AOA_NOTIFY_LINE_OUT:
322                 notif = &rt->line_out_notify;
323                 name = "lineout-detect";
324                 irq = lineout_detect_irq;
325                 break;
326         default:
327                 return -EINVAL;
328         }
329
330         if (irq == -1)
331                 return -ENODEV;
332
333         mutex_lock(&notif->mutex);
334
335         old = notif->notify;
336
337         if (!old && !notify) {
338                 err = 0;
339                 goto out_unlock;
340         }
341
342         if (old && notify) {
343                 if (old == notify && notif->data == data)
344                         err = 0;
345                 goto out_unlock;
346         }
347
348         if (old && !notify)
349                 free_irq(irq, notif);
350
351         if (!old && notify) {
352                 err = request_irq(irq, ftr_handle_notify_irq, 0, name, notif);
353                 if (err)
354                         goto out_unlock;
355         }
356
357         notif->notify = notify;
358         notif->data = data;
359
360         err = 0;
361  out_unlock:
362         mutex_unlock(&notif->mutex);
363         return err;
364 }
365
366 static int ftr_get_detect(struct gpio_runtime *rt,
367                           enum notify_type type)
368 {
369         int gpio, ret, active;
370
371         switch (type) {
372         case AOA_NOTIFY_HEADPHONE:
373                 gpio = headphone_detect_gpio;
374                 active = headphone_detect_gpio_activestate;
375                 break;
376         case AOA_NOTIFY_LINE_IN:
377                 gpio = linein_detect_gpio;
378                 active = linein_detect_gpio_activestate;
379                 break;
380         case AOA_NOTIFY_LINE_OUT:
381                 gpio = lineout_detect_gpio;
382                 active = lineout_detect_gpio_activestate;
383                 break;
384         default:
385                 return -EINVAL;
386         }
387
388         if (gpio == -1)
389                 return -ENODEV;
390
391         ret = pmac_call_feature(PMAC_FTR_READ_GPIO, NULL, gpio, 0);
392         if (ret < 0)
393                 return ret;
394         return ((ret >> 1) & 1) == active;
395 }
396
397 static struct gpio_methods methods = {
398         .init                   = ftr_gpio_init,
399         .exit                   = ftr_gpio_exit,
400         .all_amps_off           = ftr_gpio_all_amps_off,
401         .all_amps_restore       = ftr_gpio_all_amps_restore,
402         .set_headphone          = ftr_gpio_set_headphone,
403         .set_speakers           = ftr_gpio_set_amp,
404         .set_lineout            = ftr_gpio_set_lineout,
405         .set_hw_reset           = ftr_gpio_set_hw_reset,
406         .get_headphone          = ftr_gpio_get_headphone,
407         .get_speakers           = ftr_gpio_get_amp,
408         .get_lineout            = ftr_gpio_get_lineout,
409         .set_notify             = ftr_set_notify,
410         .get_detect             = ftr_get_detect,
411 };
412
413 struct gpio_methods *ftr_gpio_methods = &methods;
414 EXPORT_SYMBOL_GPL(ftr_gpio_methods);