2 * Apple Onboard Audio pmf GPIOs
4 * Copyright 2006 Johannes Berg <johannes@sipsolutions.net>
6 * GPL v2, can be found in COPYING.
9 #include <asm/pmac_feature.h>
10 #include <asm/pmac_pfunc.h>
13 #define PMF_GPIO(name, bit) \
14 static void pmf_gpio_set_##name(struct gpio_runtime *rt, int on)\
16 struct pmf_args args = { .count = 1, .u[0].v = !on }; \
19 if (unlikely(!rt)) return; \
20 rc = pmf_call_function(rt->node, #name "-mute", &args); \
21 if (rc && rc != -ENODEV) \
22 printk(KERN_WARNING "pmf_gpio_set_" #name \
23 " failed, rc: %d\n", rc); \
24 rt->implementation_private &= ~(1<<bit); \
25 rt->implementation_private |= (!!on << bit); \
27 static int pmf_gpio_get_##name(struct gpio_runtime *rt) \
29 if (unlikely(!rt)) return 0; \
30 return (rt->implementation_private>>bit)&1; \
33 PMF_GPIO(headphone, 0);
37 static void pmf_gpio_set_hw_reset(struct gpio_runtime *rt, int on)
39 struct pmf_args args = { .count = 1, .u[0].v = !!on };
42 if (unlikely(!rt)) return;
43 rc = pmf_call_function(rt->node, "hw-reset", &args);
45 printk(KERN_WARNING "pmf_gpio_set_hw_reset"
46 " failed, rc: %d\n", rc);
49 static void pmf_gpio_all_amps_off(struct gpio_runtime *rt)
53 if (unlikely(!rt)) return;
54 saved = rt->implementation_private;
55 pmf_gpio_set_headphone(rt, 0);
56 pmf_gpio_set_amp(rt, 0);
57 pmf_gpio_set_lineout(rt, 0);
58 rt->implementation_private = saved;
61 static void pmf_gpio_all_amps_restore(struct gpio_runtime *rt)
65 if (unlikely(!rt)) return;
66 s = rt->implementation_private;
67 pmf_gpio_set_headphone(rt, (s>>0)&1);
68 pmf_gpio_set_amp(rt, (s>>1)&1);
69 pmf_gpio_set_lineout(rt, (s>>2)&1);
72 static void pmf_handle_notify(void *data)
74 struct gpio_notification *notif = data;
76 mutex_lock(¬if->mutex);
78 notif->notify(notif->data);
79 mutex_unlock(¬if->mutex);
82 static void pmf_gpio_init(struct gpio_runtime *rt)
84 pmf_gpio_all_amps_off(rt);
85 rt->implementation_private = 0;
86 INIT_WORK(&rt->headphone_notify.work, pmf_handle_notify,
87 &rt->headphone_notify);
88 INIT_WORK(&rt->line_in_notify.work, pmf_handle_notify,
90 INIT_WORK(&rt->line_out_notify.work, pmf_handle_notify,
91 &rt->line_out_notify);
92 mutex_init(&rt->headphone_notify.mutex);
93 mutex_init(&rt->line_in_notify.mutex);
94 mutex_init(&rt->line_out_notify.mutex);
97 static void pmf_gpio_exit(struct gpio_runtime *rt)
99 pmf_gpio_all_amps_off(rt);
100 rt->implementation_private = 0;
102 if (rt->headphone_notify.gpio_private)
103 pmf_unregister_irq_client(rt->headphone_notify.gpio_private);
104 if (rt->line_in_notify.gpio_private)
105 pmf_unregister_irq_client(rt->line_in_notify.gpio_private);
106 if (rt->line_out_notify.gpio_private)
107 pmf_unregister_irq_client(rt->line_out_notify.gpio_private);
109 /* make sure no work is pending before freeing
111 cancel_delayed_work(&rt->headphone_notify.work);
112 cancel_delayed_work(&rt->line_in_notify.work);
113 cancel_delayed_work(&rt->line_out_notify.work);
114 flush_scheduled_work();
116 mutex_destroy(&rt->headphone_notify.mutex);
117 mutex_destroy(&rt->line_in_notify.mutex);
118 mutex_destroy(&rt->line_out_notify.mutex);
120 if (rt->headphone_notify.gpio_private)
121 kfree(rt->headphone_notify.gpio_private);
122 if (rt->line_in_notify.gpio_private)
123 kfree(rt->line_in_notify.gpio_private);
124 if (rt->line_out_notify.gpio_private)
125 kfree(rt->line_out_notify.gpio_private);
128 static void pmf_handle_notify_irq(void *data)
130 struct gpio_notification *notif = data;
132 schedule_work(¬if->work);
135 static int pmf_set_notify(struct gpio_runtime *rt,
136 enum notify_type type,
137 notify_func_t notify,
140 struct gpio_notification *notif;
142 struct pmf_irq_client *irq_client;
147 case AOA_NOTIFY_HEADPHONE:
148 notif = &rt->headphone_notify;
149 name = "headphone-detect";
151 case AOA_NOTIFY_LINE_IN:
152 notif = &rt->line_in_notify;
153 name = "linein-detect";
155 case AOA_NOTIFY_LINE_OUT:
156 notif = &rt->line_out_notify;
157 name = "lineout-detect";
163 mutex_lock(¬if->mutex);
167 if (!old && !notify) {
173 if (old == notify && notif->data == data)
178 if (old && !notify) {
179 irq_client = notif->gpio_private;
180 pmf_unregister_irq_client(irq_client);
182 notif->gpio_private = NULL;
184 if (!old && notify) {
185 irq_client = kzalloc(sizeof(struct pmf_irq_client),
187 irq_client->data = notif;
188 irq_client->handler = pmf_handle_notify_irq;
189 irq_client->owner = THIS_MODULE;
190 err = pmf_register_irq_client(rt->node,
194 printk(KERN_ERR "snd-aoa: gpio layer failed to"
195 " register %s irq (%d)\n", name, err);
199 notif->gpio_private = irq_client;
201 notif->notify = notify;
206 mutex_unlock(¬if->mutex);
210 static int pmf_get_detect(struct gpio_runtime *rt,
211 enum notify_type type)
214 int err = -EBUSY, ret;
215 struct pmf_args args = { .count = 1, .u[0].p = &ret };
218 case AOA_NOTIFY_HEADPHONE:
219 name = "headphone-detect";
221 case AOA_NOTIFY_LINE_IN:
222 name = "linein-detect";
224 case AOA_NOTIFY_LINE_OUT:
225 name = "lineout-detect";
231 err = pmf_call_function(rt->node, name, &args);
237 static struct gpio_methods methods = {
238 .init = pmf_gpio_init,
239 .exit = pmf_gpio_exit,
240 .all_amps_off = pmf_gpio_all_amps_off,
241 .all_amps_restore = pmf_gpio_all_amps_restore,
242 .set_headphone = pmf_gpio_set_headphone,
243 .set_speakers = pmf_gpio_set_amp,
244 .set_lineout = pmf_gpio_set_lineout,
245 .set_hw_reset = pmf_gpio_set_hw_reset,
246 .get_headphone = pmf_gpio_get_headphone,
247 .get_speakers = pmf_gpio_get_amp,
248 .get_lineout = pmf_gpio_get_lineout,
249 .set_notify = pmf_set_notify,
250 .get_detect = pmf_get_detect,
253 struct gpio_methods *pmf_gpio_methods = &methods;
254 EXPORT_SYMBOL_GPL(pmf_gpio_methods);