aoa/core/gpio-pmf.c

14 static void pmf_gpio_set_##name(struct gpio_runtime *rt, int on)\
19 	if (unlikely(!rt)) return;				\
20 	rc = pmf_call_function(rt->node, #name "-mute", &args);	\
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;		\
37 static void pmf_gpio_set_hw_reset(struct gpio_runtime *rt, int on)
42 	if (unlikely(!rt)) return;
43 	rc = pmf_call_function(rt->node, "hw-reset", &args);
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);
83 static void pmf_gpio_init(struct gpio_runtime *rt)
85 	pmf_gpio_all_amps_off(rt);
86 	rt->implementation_private = 0;
87 	INIT_DELAYED_WORK(&rt->headphone_notify.work, pmf_handle_notify);
88 	INIT_DELAYED_WORK(&rt->line_in_notify.work, pmf_handle_notify);
89 	INIT_DELAYED_WORK(&rt->line_out_notify.work, pmf_handle_notify);
90 	mutex_init(&rt->headphone_notify.mutex);
91 	mutex_init(&rt->line_in_notify.mutex);
92 	mutex_init(&rt->line_out_notify.mutex);
95 static void pmf_gpio_exit(struct gpio_runtime *rt)
97 	pmf_gpio_all_amps_off(rt);
98 	rt->implementation_private = 0;
100 	if (rt->headphone_notify.gpio_private)
101 		pmf_unregister_irq_client(rt->headphone_notify.gpio_private);
102 	if (rt->line_in_notify.gpio_private)
103 		pmf_unregister_irq_client(rt->line_in_notify.gpio_private);
104 	if (rt->line_out_notify.gpio_private)
105 		pmf_unregister_irq_client(rt->line_out_notify.gpio_private);
109 	cancel_delayed_work_sync(&rt->headphone_notify.work);
110 	cancel_delayed_work_sync(&rt->line_in_notify.work);
111 	cancel_delayed_work_sync(&rt->line_out_notify.work);
113 	mutex_destroy(&rt->headphone_notify.mutex);
114 	mutex_destroy(&rt->line_in_notify.mutex);
115 	mutex_destroy(&rt->line_out_notify.mutex);
117 	kfree(rt->headphone_notify.gpio_private);
118 	kfree(rt->line_in_notify.gpio_private);
119 	kfree(rt->line_out_notify.gpio_private);
129 static int pmf_set_notify(struct gpio_runtime *rt,
142 		notif = &rt->headphone_notify;
146 		notif = &rt->line_in_notify;
150 		notif = &rt->line_out_notify;
188 		err = pmf_register_irq_client(rt->node,
208 static int pmf_get_detect(struct gpio_runtime *rt,
229 	err = pmf_call_function(rt->node, name, &args);