[linux.git] / sound / aoa / core / gpio-feature.c

/*
 * Apple Onboard Audio feature call GPIO control
 *
 * Copyright 2006 Johannes Berg <[email protected]>
 *
 * GPL v2, can be found in COPYING.
 *
 * This file contains the GPIO control routines for
 * direct (through feature calls) access to the GPIO
 * registers.
 */

#include <linux/of_irq.h>
#include <linux/interrupt.h>
#include <asm/pmac_feature.h>
#include "../aoa.h"

/* TODO: these are lots of global variables
 * that aren't used on most machines...
 * Move them into a dynamically allocated
 * structure and use that.
 */

/* these are the GPIO numbers (register addresses as offsets into
 * the GPIO space) */
static int headphone_mute_gpio;
static int master_mute_gpio;
static int amp_mute_gpio;
static int lineout_mute_gpio;
static int hw_reset_gpio;
static int lineout_detect_gpio;
static int headphone_detect_gpio;
static int linein_detect_gpio;

/* see the SWITCH_GPIO macro */
static int headphone_mute_gpio_activestate;
static int master_mute_gpio_activestate;
static int amp_mute_gpio_activestate;
static int lineout_mute_gpio_activestate;
static int hw_reset_gpio_activestate;
static int lineout_detect_gpio_activestate;
static int headphone_detect_gpio_activestate;
static int linein_detect_gpio_activestate;

/* node pointers that we save when getting the GPIO number
 * to get the interrupt later */
static struct device_node *lineout_detect_node;
static struct device_node *linein_detect_node;
static struct device_node *headphone_detect_node;

static int lineout_detect_irq;
static int linein_detect_irq;
static int headphone_detect_irq;

static struct device_node *get_gpio(char *name,
				    char *altname,
				    int *gpioptr,
				    int *gpioactiveptr)
{
	struct device_node *np, *gpio;
	const u32 *reg;
	const char *audio_gpio;

	*gpioptr = -1;

	/* check if we can get it the easy way ... */
	np = of_find_node_by_name(NULL, name);
	if (!np) {
		/* some machines have only gpioX/extint-gpioX nodes,
		 * and an audio-gpio property saying what it is ...
		 * So what we have to do is enumerate all children
		 * of the gpio node and check them all. */
		gpio = of_find_node_by_name(NULL, "gpio");
		if (!gpio)
			return NULL;
		while ((np = of_get_next_child(gpio, np))) {
			audio_gpio = of_get_property(np, "audio-gpio", NULL);
			if (!audio_gpio)
				continue;
			if (strcmp(audio_gpio, name) == 0)
				break;
			if (altname && (strcmp(audio_gpio, altname) == 0))
				break;
		}
		/* still not found, assume not there */
		if (!np)
			return NULL;
	}

	reg = of_get_property(np, "reg", NULL);
	if (!reg) {
		of_node_put(np);
		return NULL;
	}

	*gpioptr = *reg;

	/* this is a hack, usually the GPIOs 'reg' property
	 * should have the offset based from the GPIO space
	 * which is at 0x50, but apparently not always... */
	if (*gpioptr < 0x50)
		*gpioptr += 0x50;

	reg = of_get_property(np, "audio-gpio-active-state", NULL);
	if (!reg)
		/* Apple seems to default to 1, but
		 * that doesn't seem right at least on most
		 * machines. So until proven that the opposite
		 * is necessary, we default to 0
		 * (which, incidentally, snd-powermac also does...) */
		*gpioactiveptr = 0;
	else
		*gpioactiveptr = *reg;

	return np;
}

static void get_irq(struct device_node * np, int *irqptr)
{
	if (np)
		*irqptr = irq_of_parse_and_map(np, 0);
	else
		*irqptr = 0;
}

/* 0x4 is outenable, 0x1 is out, thus 4 or 5 */
#define SWITCH_GPIO(name, v, on)				\
	(((v)&~1) | ((on)?					\
			(name##_gpio_activestate==0?4:5):	\
			(name##_gpio_activestate==0?5:4)))

#define FTR_GPIO(name, bit)					\
static void ftr_gpio_set_##name(struct gpio_runtime *rt, int on)\
{								\
	int v;							\
								\
	if (unlikely(!rt)) return;				\
								\
	if (name##_mute_gpio < 0)				\
		return;						\
								\
	v = pmac_call_feature(PMAC_FTR_READ_GPIO, NULL,		\
			      name##_mute_gpio,			\
			      0);				\
								\
	/* muted = !on... */					\
	v = SWITCH_GPIO(name##_mute, v, !on);			\
								\
	pmac_call_feature(PMAC_FTR_WRITE_GPIO, NULL,		\
			  name##_mute_gpio, v);			\
								\
	rt->implementation_private &= ~(1<<bit);		\
	rt->implementation_private |= (!!on << bit);		\
}								\
static int ftr_gpio_get_##name(struct gpio_runtime *rt)		\
{								\
	if (unlikely(!rt)) return 0;				\
	return (rt->implementation_private>>bit)&1;		\
}

FTR_GPIO(headphone, 0);
FTR_GPIO(amp, 1);
FTR_GPIO(lineout, 2);
FTR_GPIO(master, 3);

static void ftr_gpio_set_hw_reset(struct gpio_runtime *rt, int on)
{
	int v;

	if (unlikely(!rt)) return;
	if (hw_reset_gpio < 0)
		return;

	v = pmac_call_feature(PMAC_FTR_READ_GPIO, NULL,
			      hw_reset_gpio, 0);
	v = SWITCH_GPIO(hw_reset, v, on);
	pmac_call_feature(PMAC_FTR_WRITE_GPIO, NULL,
			  hw_reset_gpio, v);
}

static struct gpio_methods methods;

static void ftr_gpio_all_amps_off(struct gpio_runtime *rt)
{
	int saved;

	if (unlikely(!rt)) return;
	saved = rt->implementation_private;
	ftr_gpio_set_headphone(rt, 0);
	ftr_gpio_set_amp(rt, 0);
	ftr_gpio_set_lineout(rt, 0);
	if (methods.set_master)
		ftr_gpio_set_master(rt, 0);
	rt->implementation_private = saved;
}

static void ftr_gpio_all_amps_restore(struct gpio_runtime *rt)
{
	int s;

	if (unlikely(!rt)) return;
	s = rt->implementation_private;
	ftr_gpio_set_headphone(rt, (s>>0)&1);
	ftr_gpio_set_amp(rt, (s>>1)&1);
	ftr_gpio_set_lineout(rt, (s>>2)&1);
	if (methods.set_master)
		ftr_gpio_set_master(rt, (s>>3)&1);
}

static void ftr_handle_notify(struct work_struct *work)
{
	struct gpio_notification *notif =
		container_of(work, struct gpio_notification, work.work);

	mutex_lock(&notif->mutex);
	if (notif->notify)
		notif->notify(notif->data);
	mutex_unlock(&notif->mutex);
}

static void gpio_enable_dual_edge(int gpio)
{
	int v;

	if (gpio == -1)
		return;
	v = pmac_call_feature(PMAC_FTR_READ_GPIO, NULL, gpio, 0);
	v |= 0x80; /* enable dual edge */
	pmac_call_feature(PMAC_FTR_WRITE_GPIO, NULL, gpio, v);
}

static void ftr_gpio_init(struct gpio_runtime *rt)
{
	get_gpio("headphone-mute", NULL,
		 &headphone_mute_gpio,
		 &headphone_mute_gpio_activestate);
	get_gpio("amp-mute", NULL,
		 &amp_mute_gpio,
		 &amp_mute_gpio_activestate);
	get_gpio("lineout-mute", NULL,
		 &lineout_mute_gpio,
		 &lineout_mute_gpio_activestate);
	get_gpio("hw-reset", "audio-hw-reset",
		 &hw_reset_gpio,
		 &hw_reset_gpio_activestate);
	if (get_gpio("master-mute", NULL,
		     &master_mute_gpio,
		     &master_mute_gpio_activestate)) {
		methods.set_master = ftr_gpio_set_master;
		methods.get_master = ftr_gpio_get_master;
	}

	headphone_detect_node = get_gpio("headphone-detect", NULL,
					 &headphone_detect_gpio,
					 &headphone_detect_gpio_activestate);
	/* go Apple, and thanks for giving these different names
	 * across the board... */
	lineout_detect_node = get_gpio("lineout-detect", "line-output-detect",
				       &lineout_detect_gpio,
				       &lineout_detect_gpio_activestate);
	linein_detect_node = get_gpio("linein-detect", "line-input-detect",
				      &linein_detect_gpio,
				      &linein_detect_gpio_activestate);

	gpio_enable_dual_edge(headphone_detect_gpio);
	gpio_enable_dual_edge(lineout_detect_gpio);
	gpio_enable_dual_edge(linein_detect_gpio);

	get_irq(headphone_detect_node, &headphone_detect_irq);
	get_irq(lineout_detect_node, &lineout_detect_irq);
	get_irq(linein_detect_node, &linein_detect_irq);

	ftr_gpio_all_amps_off(rt);
	rt->implementation_private = 0;
	INIT_DELAYED_WORK(&rt->headphone_notify.work, ftr_handle_notify);
	INIT_DELAYED_WORK(&rt->line_in_notify.work, ftr_handle_notify);
	INIT_DELAYED_WORK(&rt->line_out_notify.work, ftr_handle_notify);
	mutex_init(&rt->headphone_notify.mutex);
	mutex_init(&rt->line_in_notify.mutex);
	mutex_init(&rt->line_out_notify.mutex);
}

static void ftr_gpio_exit(struct gpio_runtime *rt)
{
	ftr_gpio_all_amps_off(rt);
	rt->implementation_private = 0;
	if (rt->headphone_notify.notify)
		free_irq(headphone_detect_irq, &rt->headphone_notify);
	if (rt->line_in_notify.gpio_private)
		free_irq(linein_detect_irq, &rt->line_in_notify);
	if (rt->line_out_notify.gpio_private)
		free_irq(lineout_detect_irq, &rt->line_out_notify);
	cancel_delayed_work_sync(&rt->headphone_notify.work);
	cancel_delayed_work_sync(&rt->line_in_notify.work);
	cancel_delayed_work_sync(&rt->line_out_notify.work);
	mutex_destroy(&rt->headphone_notify.mutex);
	mutex_destroy(&rt->line_in_notify.mutex);
	mutex_destroy(&rt->line_out_notify.mutex);
}

static irqreturn_t ftr_handle_notify_irq(int xx, void *data)
{
	struct gpio_notification *notif = data;

	schedule_delayed_work(&notif->work, 0);

	return IRQ_HANDLED;
}

static int ftr_set_notify(struct gpio_runtime *rt,
			  enum notify_type type,
			  notify_func_t notify,
			  void *data)
{
	struct gpio_notification *notif;
	notify_func_t old;
	int irq;
	char *name;
	int err = -EBUSY;

	switch (type) {
	case AOA_NOTIFY_HEADPHONE:
		notif = &rt->headphone_notify;
		name = "headphone-detect";
		irq = headphone_detect_irq;
		break;
	case AOA_NOTIFY_LINE_IN:
		notif = &rt->line_in_notify;
		name = "linein-detect";
		irq = linein_detect_irq;
		break;
	case AOA_NOTIFY_LINE_OUT:
		notif = &rt->line_out_notify;
		name = "lineout-detect";
		irq = lineout_detect_irq;
		break;
	default:
		return -EINVAL;
	}

	if (!irq)
		return -ENODEV;

	mutex_lock(&notif->mutex);

	old = notif->notify;

	if (!old && !notify) {
		err = 0;
		goto out_unlock;
	}

	if (old && notify) {
		if (old == notify && notif->data == data)
			err = 0;
		goto out_unlock;
	}

	if (old && !notify)
		free_irq(irq, notif);

	if (!old && notify) {
		err = request_irq(irq, ftr_handle_notify_irq, 0, name, notif);
		if (err)
			goto out_unlock;
	}

	notif->notify = notify;
	notif->data = data;

	err = 0;
 out_unlock:
	mutex_unlock(&notif->mutex);
	return err;
}

static int ftr_get_detect(struct gpio_runtime *rt,
			  enum notify_type type)
{
	int gpio, ret, active;

	switch (type) {
	case AOA_NOTIFY_HEADPHONE:
		gpio = headphone_detect_gpio;
		active = headphone_detect_gpio_activestate;
		break;
	case AOA_NOTIFY_LINE_IN:
		gpio = linein_detect_gpio;
		active = linein_detect_gpio_activestate;
		break;
	case AOA_NOTIFY_LINE_OUT:
		gpio = lineout_detect_gpio;
		active = lineout_detect_gpio_activestate;
		break;
	default:
		return -EINVAL;
	}

	if (gpio == -1)
		return -ENODEV;

	ret = pmac_call_feature(PMAC_FTR_READ_GPIO, NULL, gpio, 0);
	if (ret < 0)
		return ret;
	return ((ret >> 1) & 1) == active;
}

static struct gpio_methods methods = {
	.init			= ftr_gpio_init,
	.exit			= ftr_gpio_exit,
	.all_amps_off		= ftr_gpio_all_amps_off,
	.all_amps_restore	= ftr_gpio_all_amps_restore,
	.set_headphone		= ftr_gpio_set_headphone,
	.set_speakers		= ftr_gpio_set_amp,
	.set_lineout		= ftr_gpio_set_lineout,
	.set_hw_reset		= ftr_gpio_set_hw_reset,
	.get_headphone		= ftr_gpio_get_headphone,
	.get_speakers		= ftr_gpio_get_amp,
	.get_lineout		= ftr_gpio_get_lineout,
	.set_notify		= ftr_set_notify,
	.get_detect		= ftr_get_detect,
};

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