[deliverable/linux.git] / sound / soc / omap / ams-delta.c

/*
 * ams-delta.c  --  SoC audio for Amstrad E3 (Delta) videophone
 *
 * Copyright (C) 2009 Janusz Krzysztofik <jkrzyszt@tis.icnet.pl>
 *
 * Initially based on sound/soc/omap/osk5912.x
 * Copyright (C) 2008 Mistral Solutions
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * version 2 as published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
 * 02110-1301 USA
 *
 */

#include <linux/gpio.h>
#include <linux/spinlock.h>
#include <linux/tty.h>
#include <linux/module.h>

#include <sound/soc.h>
#include <sound/jack.h>

#include <asm/mach-types.h>

#include <mach/board-ams-delta.h>
#include <linux/platform_data/asoc-ti-mcbsp.h>

#include "omap-mcbsp.h"
#include "../codecs/cx20442.h"

/* Board specific DAPM widgets */
static const struct snd_soc_dapm_widget ams_delta_dapm_widgets[] = {
	/* Handset */
	SND_SOC_DAPM_MIC("Mouthpiece", NULL),
	SND_SOC_DAPM_HP("Earpiece", NULL),
	/* Handsfree/Speakerphone */
	SND_SOC_DAPM_MIC("Microphone", NULL),
	SND_SOC_DAPM_SPK("Speaker", NULL),
};

/* How they are connected to codec pins */
static const struct snd_soc_dapm_route ams_delta_audio_map[] = {
	{"TELIN", NULL, "Mouthpiece"},
	{"Earpiece", NULL, "TELOUT"},

	{"MIC", NULL, "Microphone"},
	{"Speaker", NULL, "SPKOUT"},
};

/*
 * Controls, functional after the modem line discipline is activated.
 */

/* Virtual switch: audio input/output constellations */
static const char *ams_delta_audio_mode[] =
	{"Mixed", "Handset", "Handsfree", "Speakerphone"};

/* Selection <-> pin translation */
#define AMS_DELTA_MOUTHPIECE	0
#define AMS_DELTA_EARPIECE	1
#define AMS_DELTA_MICROPHONE	2
#define AMS_DELTA_SPEAKER	3
#define AMS_DELTA_AGC		4

#define AMS_DELTA_MIXED		((1 << AMS_DELTA_EARPIECE) | \
						(1 << AMS_DELTA_MICROPHONE))
#define AMS_DELTA_HANDSET	((1 << AMS_DELTA_MOUTHPIECE) | \
						(1 << AMS_DELTA_EARPIECE))
#define AMS_DELTA_HANDSFREE	((1 << AMS_DELTA_MICROPHONE) | \
						(1 << AMS_DELTA_SPEAKER))
#define AMS_DELTA_SPEAKERPHONE	(AMS_DELTA_HANDSFREE | (1 << AMS_DELTA_AGC))

static const unsigned short ams_delta_audio_mode_pins[] = {
	AMS_DELTA_MIXED,
	AMS_DELTA_HANDSET,
	AMS_DELTA_HANDSFREE,
	AMS_DELTA_SPEAKERPHONE,
};

static unsigned short ams_delta_audio_agc;

/*
 * Used for passing a codec structure pointer
 * from the board initialization code to the tty line discipline.
 */
static struct snd_soc_codec *cx20442_codec;

static int ams_delta_set_audio_mode(struct snd_kcontrol *kcontrol,
					struct snd_ctl_elem_value *ucontrol)
{
	struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
	struct snd_soc_dapm_context *dapm = &card->dapm;
	struct soc_enum *control = (struct soc_enum *)kcontrol->private_value;
	unsigned short pins;
	int pin, changed = 0;

	/* Refuse any mode changes if we are not able to control the codec. */
	if (!cx20442_codec->hw_write)
		return -EUNATCH;

	if (ucontrol->value.enumerated.item[0] >= control->items)
		return -EINVAL;

	snd_soc_dapm_mutex_lock(dapm);

	/* Translate selection to bitmap */
	pins = ams_delta_audio_mode_pins[ucontrol->value.enumerated.item[0]];

	/* Setup pins after corresponding bits if changed */
	pin = !!(pins & (1 << AMS_DELTA_MOUTHPIECE));

	if (pin != snd_soc_dapm_get_pin_status(dapm, "Mouthpiece")) {
		changed = 1;
		if (pin)
			snd_soc_dapm_enable_pin_unlocked(dapm, "Mouthpiece");
		else
			snd_soc_dapm_disable_pin_unlocked(dapm, "Mouthpiece");
	}
	pin = !!(pins & (1 << AMS_DELTA_EARPIECE));
	if (pin != snd_soc_dapm_get_pin_status(dapm, "Earpiece")) {
		changed = 1;
		if (pin)
			snd_soc_dapm_enable_pin_unlocked(dapm, "Earpiece");
		else
			snd_soc_dapm_disable_pin_unlocked(dapm, "Earpiece");
	}
	pin = !!(pins & (1 << AMS_DELTA_MICROPHONE));
	if (pin != snd_soc_dapm_get_pin_status(dapm, "Microphone")) {
		changed = 1;
		if (pin)
			snd_soc_dapm_enable_pin_unlocked(dapm, "Microphone");
		else
			snd_soc_dapm_disable_pin_unlocked(dapm, "Microphone");
	}
	pin = !!(pins & (1 << AMS_DELTA_SPEAKER));
	if (pin != snd_soc_dapm_get_pin_status(dapm, "Speaker")) {
		changed = 1;
		if (pin)
			snd_soc_dapm_enable_pin_unlocked(dapm, "Speaker");
		else
			snd_soc_dapm_disable_pin_unlocked(dapm, "Speaker");
	}
	pin = !!(pins & (1 << AMS_DELTA_AGC));
	if (pin != ams_delta_audio_agc) {
		ams_delta_audio_agc = pin;
		changed = 1;
		if (pin)
			snd_soc_dapm_enable_pin_unlocked(dapm, "AGCIN");
		else
			snd_soc_dapm_disable_pin_unlocked(dapm, "AGCIN");
	}

	if (changed)
		snd_soc_dapm_sync_unlocked(dapm);

	snd_soc_dapm_mutex_unlock(dapm);

	return changed;
}

static int ams_delta_get_audio_mode(struct snd_kcontrol *kcontrol,
					struct snd_ctl_elem_value *ucontrol)
{
	struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
	struct snd_soc_dapm_context *dapm = &card->dapm;
	unsigned short pins, mode;

	pins = ((snd_soc_dapm_get_pin_status(dapm, "Mouthpiece") <<
							AMS_DELTA_MOUTHPIECE) |
			(snd_soc_dapm_get_pin_status(dapm, "Earpiece") <<
							AMS_DELTA_EARPIECE));
	if (pins)
		pins |= (snd_soc_dapm_get_pin_status(dapm, "Microphone") <<
							AMS_DELTA_MICROPHONE);
	else
		pins = ((snd_soc_dapm_get_pin_status(dapm, "Microphone") <<
							AMS_DELTA_MICROPHONE) |
			(snd_soc_dapm_get_pin_status(dapm, "Speaker") <<
							AMS_DELTA_SPEAKER) |
			(ams_delta_audio_agc << AMS_DELTA_AGC));

	for (mode = 0; mode < ARRAY_SIZE(ams_delta_audio_mode); mode++)
		if (pins == ams_delta_audio_mode_pins[mode])
			break;

	if (mode >= ARRAY_SIZE(ams_delta_audio_mode))
		return -EINVAL;

	ucontrol->value.enumerated.item[0] = mode;

	return 0;
}

static const SOC_ENUM_SINGLE_EXT_DECL(ams_delta_audio_enum,
				      ams_delta_audio_mode);

static const struct snd_kcontrol_new ams_delta_audio_controls[] = {
	SOC_ENUM_EXT("Audio Mode", ams_delta_audio_enum,
			ams_delta_get_audio_mode, ams_delta_set_audio_mode),
};

/* Hook switch */
static struct snd_soc_jack ams_delta_hook_switch;
static struct snd_soc_jack_gpio ams_delta_hook_switch_gpios[] = {
	{
		.gpio = 4,
		.name = "hook_switch",
		.report = SND_JACK_HEADSET,
		.invert = 1,
		.debounce_time = 150,
	}
};

/* After we are able to control the codec over the modem,
 * the hook switch can be used for dynamic DAPM reconfiguration. */
static struct snd_soc_jack_pin ams_delta_hook_switch_pins[] = {
	/* Handset */
	{
		.pin = "Mouthpiece",
		.mask = SND_JACK_MICROPHONE,
	},
	{
		.pin = "Earpiece",
		.mask = SND_JACK_HEADPHONE,
	},
	/* Handsfree */
	{
		.pin = "Microphone",
		.mask = SND_JACK_MICROPHONE,
		.invert = 1,
	},
	{
		.pin = "Speaker",
		.mask = SND_JACK_HEADPHONE,
		.invert = 1,
	},
};


/*
 * Modem line discipline, required for making above controls functional.
 * Activated from userspace with ldattach, possibly invoked from udev rule.
 */

/* To actually apply any modem controlled configuration changes to the codec,
 * we must connect codec DAI pins to the modem for a moment.  Be careful not
 * to interfere with our digital mute function that shares the same hardware. */
static struct timer_list cx81801_timer;
static bool cx81801_cmd_pending;
static bool ams_delta_muted;
static DEFINE_SPINLOCK(ams_delta_lock);

static void cx81801_timeout(unsigned long data)
{
	int muted;

	spin_lock(&ams_delta_lock);
	cx81801_cmd_pending = 0;
	muted = ams_delta_muted;
	spin_unlock(&ams_delta_lock);

	/* Reconnect the codec DAI back from the modem to the CPU DAI
	 * only if digital mute still off */
	if (!muted)
		ams_delta_latch2_write(AMS_DELTA_LATCH2_MODEM_CODEC, 0);
}

/* Line discipline .open() */
static int cx81801_open(struct tty_struct *tty)
{
	int ret;

	if (!cx20442_codec)
		return -ENODEV;

	/*
	 * Pass the codec structure pointer for use by other ldisc callbacks,
	 * both the card and the codec specific parts.
	 */
	tty->disc_data = cx20442_codec;

	ret = v253_ops.open(tty);

	if (ret < 0)
		tty->disc_data = NULL;

	return ret;
}

/* Line discipline .close() */
static void cx81801_close(struct tty_struct *tty)
{
	struct snd_soc_codec *codec = tty->disc_data;
	struct snd_soc_dapm_context *dapm = &codec->component.card->dapm;

	del_timer_sync(&cx81801_timer);

	/* Prevent the hook switch from further changing the DAPM pins */
	INIT_LIST_HEAD(&ams_delta_hook_switch.pins);

	if (!codec)
		return;

	v253_ops.close(tty);

	/* Revert back to default audio input/output constellation */
	snd_soc_dapm_mutex_lock(dapm);

	snd_soc_dapm_disable_pin_unlocked(dapm, "Mouthpiece");
	snd_soc_dapm_enable_pin_unlocked(dapm, "Earpiece");
	snd_soc_dapm_enable_pin_unlocked(dapm, "Microphone");
	snd_soc_dapm_disable_pin_unlocked(dapm, "Speaker");
	snd_soc_dapm_disable_pin_unlocked(dapm, "AGCIN");

	snd_soc_dapm_sync_unlocked(dapm);

	snd_soc_dapm_mutex_unlock(dapm);
}

/* Line discipline .hangup() */
static int cx81801_hangup(struct tty_struct *tty)
{
	cx81801_close(tty);
	return 0;
}

/* Line discipline .receive_buf() */
static void cx81801_receive(struct tty_struct *tty,
				const unsigned char *cp, char *fp, int count)
{
	struct snd_soc_codec *codec = tty->disc_data;
	const unsigned char *c;
	int apply, ret;

	if (!codec)
		return;

	if (!codec->hw_write) {
		/* First modem response, complete setup procedure */

		/* Initialize timer used for config pulse generation */
		setup_timer(&cx81801_timer, cx81801_timeout, 0);

		v253_ops.receive_buf(tty, cp, fp, count);

		/* Link hook switch to DAPM pins */
		ret = snd_soc_jack_add_pins(&ams_delta_hook_switch,
					ARRAY_SIZE(ams_delta_hook_switch_pins),
					ams_delta_hook_switch_pins);
		if (ret)
			dev_warn(codec->dev,
				"Failed to link hook switch to DAPM pins, "
				"will continue with hook switch unlinked.\n");

		return;
	}

	v253_ops.receive_buf(tty, cp, fp, count);

	for (c = &cp[count - 1]; c >= cp; c--) {
		if (*c != '\r')
			continue;
		/* Complete modem response received, apply config to codec */

		spin_lock_bh(&ams_delta_lock);
		mod_timer(&cx81801_timer, jiffies + msecs_to_jiffies(150));
		apply = !ams_delta_muted && !cx81801_cmd_pending;
		cx81801_cmd_pending = 1;
		spin_unlock_bh(&ams_delta_lock);

		/* Apply config pulse by connecting the codec to the modem
		 * if not already done */
		if (apply)
			ams_delta_latch2_write(AMS_DELTA_LATCH2_MODEM_CODEC,
						AMS_DELTA_LATCH2_MODEM_CODEC);
		break;
	}
}

/* Line discipline .write_wakeup() */
static void cx81801_wakeup(struct tty_struct *tty)
{
	v253_ops.write_wakeup(tty);
}

static struct tty_ldisc_ops cx81801_ops = {
	.magic = TTY_LDISC_MAGIC,
	.name = "cx81801",
	.owner = THIS_MODULE,
	.open = cx81801_open,
	.close = cx81801_close,
	.hangup = cx81801_hangup,
	.receive_buf = cx81801_receive,
	.write_wakeup = cx81801_wakeup,
};


/*
 * Even if not very useful, the sound card can still work without any of the
 * above functonality activated.  You can still control its audio input/output
 * constellation and speakerphone gain from userspace by issuing AT commands
 * over the modem port.
 */

static int ams_delta_hw_params(struct snd_pcm_substream *substream,
			 struct snd_pcm_hw_params *params)
{
	struct snd_soc_pcm_runtime *rtd = substream->private_data;

	/* Set cpu DAI configuration */
	return snd_soc_dai_set_fmt(rtd->cpu_dai,
				   SND_SOC_DAIFMT_DSP_A |
				   SND_SOC_DAIFMT_NB_NF |
				   SND_SOC_DAIFMT_CBM_CFM);
}

static struct snd_soc_ops ams_delta_ops = {
	.hw_params = ams_delta_hw_params,
};


/* Digital mute implemented using modem/CPU multiplexer.
 * Shares hardware with codec config pulse generation */
static bool ams_delta_muted = 1;

static int ams_delta_digital_mute(struct snd_soc_dai *dai, int mute)
{
	int apply;

	if (ams_delta_muted == mute)
		return 0;

	spin_lock_bh(&ams_delta_lock);
	ams_delta_muted = mute;
	apply = !cx81801_cmd_pending;
	spin_unlock_bh(&ams_delta_lock);

	if (apply)
		ams_delta_latch2_write(AMS_DELTA_LATCH2_MODEM_CODEC,
				mute ? AMS_DELTA_LATCH2_MODEM_CODEC : 0);
	return 0;
}

/* Our codec DAI probably doesn't have its own .ops structure */
static const struct snd_soc_dai_ops ams_delta_dai_ops = {
	.digital_mute = ams_delta_digital_mute,
};

/* Will be used if the codec ever has its own digital_mute function */
static int ams_delta_startup(struct snd_pcm_substream *substream)
{
	return ams_delta_digital_mute(NULL, 0);
}

static void ams_delta_shutdown(struct snd_pcm_substream *substream)
{
	ams_delta_digital_mute(NULL, 1);
}


/*
 * Card initialization
 */

static int ams_delta_cx20442_init(struct snd_soc_pcm_runtime *rtd)
{
	struct snd_soc_dai *codec_dai = rtd->codec_dai;
	struct snd_soc_card *card = rtd->card;
	struct snd_soc_dapm_context *dapm = &card->dapm;
	int ret;
	/* Codec is ready, now add/activate board specific controls */

	/* Store a pointer to the codec structure for tty ldisc use */
	cx20442_codec = rtd->codec;

	/* Set up digital mute if not provided by the codec */
	if (!codec_dai->driver->ops) {
		codec_dai->driver->ops = &ams_delta_dai_ops;
	} else {
		ams_delta_ops.startup = ams_delta_startup;
		ams_delta_ops.shutdown = ams_delta_shutdown;
	}

	/* Add hook switch - can be used to control the codec from userspace
	 * even if line discipline fails */
	ret = snd_soc_jack_new(rtd->codec, "hook_switch",
				SND_JACK_HEADSET, &ams_delta_hook_switch);
	if (ret)
		dev_warn(card->dev,
				"Failed to allocate resources for hook switch, "
				"will continue without one.\n");
	else {
		ret = snd_soc_jack_add_gpios(&ams_delta_hook_switch,
					ARRAY_SIZE(ams_delta_hook_switch_gpios),
					ams_delta_hook_switch_gpios);
		if (ret)
			dev_warn(card->dev,
				"Failed to set up hook switch GPIO line, "
				"will continue with hook switch inactive.\n");
	}

	/* Register optional line discipline for over the modem control */
	ret = tty_register_ldisc(N_V253, &cx81801_ops);
	if (ret) {
		dev_warn(card->dev,
				"Failed to register line discipline, "
				"will continue without any controls.\n");
		return 0;
	}

	/* Set up initial pin constellation */
	snd_soc_dapm_disable_pin(dapm, "Mouthpiece");
	snd_soc_dapm_disable_pin(dapm, "Speaker");
	snd_soc_dapm_disable_pin(dapm, "AGCIN");
	snd_soc_dapm_disable_pin(dapm, "AGCOUT");

	return 0;
}

static int ams_delta_card_remove(struct snd_soc_card *card)
{
	snd_soc_jack_free_gpios(&ams_delta_hook_switch,
			ARRAY_SIZE(ams_delta_hook_switch_gpios),
			ams_delta_hook_switch_gpios);

	return 0;
}

/* DAI glue - connects codec <--> CPU */
static struct snd_soc_dai_link ams_delta_dai_link = {
	.name = "CX20442",
	.stream_name = "CX20442",
	.cpu_dai_name = "omap-mcbsp.1",
	.codec_dai_name = "cx20442-voice",
	.init = ams_delta_cx20442_init,
	.platform_name = "omap-mcbsp.1",
	.codec_name = "cx20442-codec",
	.ops = &ams_delta_ops,
};

/* Audio card driver */
static struct snd_soc_card ams_delta_audio_card = {
	.name = "AMS_DELTA",
	.owner = THIS_MODULE,
	.remove = ams_delta_card_remove,
	.dai_link = &ams_delta_dai_link,
	.num_links = 1,

	.controls = ams_delta_audio_controls,
	.num_controls = ARRAY_SIZE(ams_delta_audio_controls),
	.dapm_widgets = ams_delta_dapm_widgets,
	.num_dapm_widgets = ARRAY_SIZE(ams_delta_dapm_widgets),
	.dapm_routes = ams_delta_audio_map,
	.num_dapm_routes = ARRAY_SIZE(ams_delta_audio_map),
};

/* Module init/exit */
static int ams_delta_probe(struct platform_device *pdev)
{
	struct snd_soc_card *card = &ams_delta_audio_card;
	int ret;

	card->dev = &pdev->dev;

	ret = snd_soc_register_card(card);
	if (ret) {
		dev_err(&pdev->dev, "snd_soc_register_card failed (%d)\n", ret);
		card->dev = NULL;
		return ret;
	}
	return 0;
}

static int ams_delta_remove(struct platform_device *pdev)
{
	struct snd_soc_card *card = platform_get_drvdata(pdev);

	if (tty_unregister_ldisc(N_V253) != 0)
		dev_warn(&pdev->dev,
			"failed to unregister V253 line discipline\n");

	snd_soc_unregister_card(card);
	card->dev = NULL;
	return 0;
}

#define DRV_NAME "ams-delta-audio"

static struct platform_driver ams_delta_driver = {
	.driver = {
		.name = DRV_NAME,
		.owner = THIS_MODULE,
	},
	.probe = ams_delta_probe,
	.remove = ams_delta_remove,
};

module_platform_driver(ams_delta_driver);

MODULE_AUTHOR("Janusz Krzysztofik <jkrzyszt@tis.icnet.pl>");
MODULE_DESCRIPTION("ALSA SoC driver for Amstrad E3 (Delta) videophone");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:" DRV_NAME);
Commit	Line	Data
6d7f68a1 JK	1	/*
	2	* ams-delta.c -- SoC audio for Amstrad E3 (Delta) videophone
	3	*
	4	* Copyright (C) 2009 Janusz Krzysztofik <jkrzyszt@tis.icnet.pl>
	5	*
	6	* Initially based on sound/soc/omap/osk5912.x
	7	* Copyright (C) 2008 Mistral Solutions
	8	*
	9	* This program is free software; you can redistribute it and/or
	10	* modify it under the terms of the GNU General Public License
	11	* version 2 as published by the Free Software Foundation.
	12	*
	13	* This program is distributed in the hope that it will be useful, but
	14	* WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	16	* General Public License for more details.
	17	*
	18	* You should have received a copy of the GNU General Public License
	19	* along with this program; if not, write to the Free Software
	20	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
	21	* 02110-1301 USA
	22	*
	23	*/
	24
	25	#include <linux/gpio.h>
	26	#include <linux/spinlock.h>
	27	#include <linux/tty.h>
da155d5b	28	#include <linux/module.h>
6d7f68a1	29
ce6120cc	30	#include <sound/soc.h>
6d7f68a1 JK	31	#include <sound/jack.h>
	32
	33	#include <asm/mach-types.h>
	34
e27e35ec	35	#include <mach/board-ams-delta.h>
2203747c	36	#include <linux/platform_data/asoc-ti-mcbsp.h>
6d7f68a1 JK	37
6d7f68a1 JK	38	#include "omap-mcbsp.h"
6d7f68a1 JK	39	#include "../codecs/cx20442.h"
6d7f68a1 JK	40
6d7f68a1	41	/* Board specific DAPM widgets */
02624621	42	static const struct snd_soc_dapm_widget ams_delta_dapm_widgets[] = {
6d7f68a1 JK	43	/* Handset */
	44	SND_SOC_DAPM_MIC("Mouthpiece", NULL),
	45	SND_SOC_DAPM_HP("Earpiece", NULL),
	46	/* Handsfree/Speakerphone */
	47	SND_SOC_DAPM_MIC("Microphone", NULL),
	48	SND_SOC_DAPM_SPK("Speaker", NULL),
	49	};
	50
	51	/* How they are connected to codec pins */
	52	static const struct snd_soc_dapm_route ams_delta_audio_map[] = {
	53	{"TELIN", NULL, "Mouthpiece"},
	54	{"Earpiece", NULL, "TELOUT"},
	55
	56	{"MIC", NULL, "Microphone"},
	57	{"Speaker", NULL, "SPKOUT"},
	58	};
	59
	60	/*
	61	* Controls, functional after the modem line discipline is activated.
	62	*/
	63
	64	/* Virtual switch: audio input/output constellations */
	65	static const char *ams_delta_audio_mode[] =
	66	{"Mixed", "Handset", "Handsfree", "Speakerphone"};
	67
	68	/* Selection <-> pin translation */
	69	#define AMS_DELTA_MOUTHPIECE 0
	70	#define AMS_DELTA_EARPIECE 1
	71	#define AMS_DELTA_MICROPHONE 2
	72	#define AMS_DELTA_SPEAKER 3
	73	#define AMS_DELTA_AGC 4
	74
	75	#define AMS_DELTA_MIXED ((1 << AMS_DELTA_EARPIECE) \| \
	76	(1 << AMS_DELTA_MICROPHONE))
	77	#define AMS_DELTA_HANDSET ((1 << AMS_DELTA_MOUTHPIECE) \| \
	78	(1 << AMS_DELTA_EARPIECE))
	79	#define AMS_DELTA_HANDSFREE ((1 << AMS_DELTA_MICROPHONE) \| \
	80	(1 << AMS_DELTA_SPEAKER))
	81	#define AMS_DELTA_SPEAKERPHONE (AMS_DELTA_HANDSFREE \| (1 << AMS_DELTA_AGC))
	82
02624621	83	static const unsigned short ams_delta_audio_mode_pins[] = {
6d7f68a1 JK	84	AMS_DELTA_MIXED,
	85	AMS_DELTA_HANDSET,
	86	AMS_DELTA_HANDSFREE,
	87	AMS_DELTA_SPEAKERPHONE,
	88	};
	89
	90	static unsigned short ams_delta_audio_agc;
	91
74a16720 LPC	92	/*
	93	* Used for passing a codec structure pointer
	94	* from the board initialization code to the tty line discipline.
	95	*/
	96	static struct snd_soc_codec *cx20442_codec;
	97
6d7f68a1 JK	98	static int ams_delta_set_audio_mode(struct snd_kcontrol *kcontrol,
	99	struct snd_ctl_elem_value *ucontrol)
	100	{
74a16720 LPC	101	struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
74a16720 LPC	102	struct snd_soc_dapm_context *dapm = &card->dapm;
6d7f68a1 JK	103	struct soc_enum control = (struct soc_enum )kcontrol->private_value;
	104	unsigned short pins;
	105	int pin, changed = 0;
	106
	107	/* Refuse any mode changes if we are not able to control the codec. */
74a16720	108	if (!cx20442_codec->hw_write)
6d7f68a1 JK	109	return -EUNATCH;
6d7f68a1 JK	110
9a8d38db	111	if (ucontrol->value.enumerated.item[0] >= control->items)
6d7f68a1 JK	112	return -EINVAL;
6d7f68a1 JK	113
03510ca0	114	snd_soc_dapm_mutex_lock(dapm);
6d7f68a1 JK	115
	116	/* Translate selection to bitmap */
	117	pins = ams_delta_audio_mode_pins[ucontrol->value.enumerated.item[0]];
	118
	119	/* Setup pins after corresponding bits if changed */
	120	pin = !!(pins & (1 << AMS_DELTA_MOUTHPIECE));
03510ca0	121
ce6120cc	122	if (pin != snd_soc_dapm_get_pin_status(dapm, "Mouthpiece")) {
6d7f68a1 JK	123	changed = 1;
6d7f68a1 JK	124	if (pin)
03510ca0	125	snd_soc_dapm_enable_pin_unlocked(dapm, "Mouthpiece");
6d7f68a1	126	else
03510ca0	127	snd_soc_dapm_disable_pin_unlocked(dapm, "Mouthpiece");
6d7f68a1 JK	128	}
6d7f68a1 JK	129	pin = !!(pins & (1 << AMS_DELTA_EARPIECE));
ce6120cc	130	if (pin != snd_soc_dapm_get_pin_status(dapm, "Earpiece")) {
6d7f68a1 JK	131	changed = 1;
6d7f68a1 JK	132	if (pin)
03510ca0	133	snd_soc_dapm_enable_pin_unlocked(dapm, "Earpiece");
6d7f68a1	134	else
03510ca0	135	snd_soc_dapm_disable_pin_unlocked(dapm, "Earpiece");
6d7f68a1 JK	136	}
6d7f68a1 JK	137	pin = !!(pins & (1 << AMS_DELTA_MICROPHONE));
ce6120cc	138	if (pin != snd_soc_dapm_get_pin_status(dapm, "Microphone")) {
6d7f68a1 JK	139	changed = 1;
6d7f68a1 JK	140	if (pin)
03510ca0	141	snd_soc_dapm_enable_pin_unlocked(dapm, "Microphone");
6d7f68a1	142	else
03510ca0	143	snd_soc_dapm_disable_pin_unlocked(dapm, "Microphone");
6d7f68a1 JK	144	}
6d7f68a1 JK	145	pin = !!(pins & (1 << AMS_DELTA_SPEAKER));
ce6120cc	146	if (pin != snd_soc_dapm_get_pin_status(dapm, "Speaker")) {
6d7f68a1 JK	147	changed = 1;
6d7f68a1 JK	148	if (pin)
03510ca0	149	snd_soc_dapm_enable_pin_unlocked(dapm, "Speaker");
6d7f68a1	150	else
03510ca0	151	snd_soc_dapm_disable_pin_unlocked(dapm, "Speaker");
6d7f68a1 JK	152	}
	153	pin = !!(pins & (1 << AMS_DELTA_AGC));
	154	if (pin != ams_delta_audio_agc) {
	155	ams_delta_audio_agc = pin;
	156	changed = 1;
	157	if (pin)
03510ca0	158	snd_soc_dapm_enable_pin_unlocked(dapm, "AGCIN");
6d7f68a1	159	else
03510ca0	160	snd_soc_dapm_disable_pin_unlocked(dapm, "AGCIN");
6d7f68a1	161	}
03510ca0	162
6d7f68a1	163	if (changed)
03510ca0	164	snd_soc_dapm_sync_unlocked(dapm);
6d7f68a1	165
03510ca0	166	snd_soc_dapm_mutex_unlock(dapm);
6d7f68a1 JK	167
	168	return changed;
	169	}
	170
	171	static int ams_delta_get_audio_mode(struct snd_kcontrol *kcontrol,
	172	struct snd_ctl_elem_value *ucontrol)
	173	{
74a16720 LPC	174	struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
74a16720 LPC	175	struct snd_soc_dapm_context *dapm = &card->dapm;
6d7f68a1 JK	176	unsigned short pins, mode;
6d7f68a1 JK	177
ce6120cc	178	pins = ((snd_soc_dapm_get_pin_status(dapm, "Mouthpiece") <<
6d7f68a1	179	AMS_DELTA_MOUTHPIECE) \|
ce6120cc	180	(snd_soc_dapm_get_pin_status(dapm, "Earpiece") <<
6d7f68a1 JK	181	AMS_DELTA_EARPIECE));
6d7f68a1 JK	182	if (pins)
ce6120cc	183	pins \|= (snd_soc_dapm_get_pin_status(dapm, "Microphone") <<
6d7f68a1 JK	184	AMS_DELTA_MICROPHONE);
6d7f68a1 JK	185	else
ce6120cc	186	pins = ((snd_soc_dapm_get_pin_status(dapm, "Microphone") <<
6d7f68a1	187	AMS_DELTA_MICROPHONE) \|
ce6120cc	188	(snd_soc_dapm_get_pin_status(dapm, "Speaker") <<
6d7f68a1 JK	189	AMS_DELTA_SPEAKER) \|
	190	(ams_delta_audio_agc << AMS_DELTA_AGC));
	191
	192	for (mode = 0; mode < ARRAY_SIZE(ams_delta_audio_mode); mode++)
	193	if (pins == ams_delta_audio_mode_pins[mode])
	194	break;
	195
	196	if (mode >= ARRAY_SIZE(ams_delta_audio_mode))
	197	return -EINVAL;
	198
	199	ucontrol->value.enumerated.item[0] = mode;
	200
	201	return 0;
	202	}
	203
7cb5e1bb TI	204	static const SOC_ENUM_SINGLE_EXT_DECL(ams_delta_audio_enum,
7cb5e1bb TI	205	ams_delta_audio_mode);
6d7f68a1 JK	206
6d7f68a1 JK	207	static const struct snd_kcontrol_new ams_delta_audio_controls[] = {
7cb5e1bb	208	SOC_ENUM_EXT("Audio Mode", ams_delta_audio_enum,
6d7f68a1 JK	209	ams_delta_get_audio_mode, ams_delta_set_audio_mode),
	210	};
	211
	212	/* Hook switch */
	213	static struct snd_soc_jack ams_delta_hook_switch;
	214	static struct snd_soc_jack_gpio ams_delta_hook_switch_gpios[] = {
	215	{
	216	.gpio = 4,
	217	.name = "hook_switch",
	218	.report = SND_JACK_HEADSET,
	219	.invert = 1,
	220	.debounce_time = 150,
	221	}
	222	};
	223
	224	/* After we are able to control the codec over the modem,
	225	* the hook switch can be used for dynamic DAPM reconfiguration. */
	226	static struct snd_soc_jack_pin ams_delta_hook_switch_pins[] = {
	227	/* Handset */
	228	{
	229	.pin = "Mouthpiece",
	230	.mask = SND_JACK_MICROPHONE,
	231	},
	232	{
	233	.pin = "Earpiece",
	234	.mask = SND_JACK_HEADPHONE,
	235	},
	236	/* Handsfree */
	237	{
	238	.pin = "Microphone",
	239	.mask = SND_JACK_MICROPHONE,
	240	.invert = 1,
	241	},
	242	{
	243	.pin = "Speaker",
	244	.mask = SND_JACK_HEADPHONE,
	245	.invert = 1,
	246	},
	247	};
	248
	249
	250	/*
	251	* Modem line discipline, required for making above controls functional.
	252	* Activated from userspace with ldattach, possibly invoked from udev rule.
	253	*/
	254
	255	/* To actually apply any modem controlled configuration changes to the codec,
25985edc	256	* we must connect codec DAI pins to the modem for a moment. Be careful not
6d7f68a1 JK	257	* to interfere with our digital mute function that shares the same hardware. */
	258	static struct timer_list cx81801_timer;
	259	static bool cx81801_cmd_pending;
	260	static bool ams_delta_muted;
	261	static DEFINE_SPINLOCK(ams_delta_lock);
	262
	263	static void cx81801_timeout(unsigned long data)
	264	{
	265	int muted;
	266
	267	spin_lock(&ams_delta_lock);
	268	cx81801_cmd_pending = 0;
	269	muted = ams_delta_muted;
	270	spin_unlock(&ams_delta_lock);
	271
	272	/* Reconnect the codec DAI back from the modem to the CPU DAI
	273	* only if digital mute still off */
	274	if (!muted)
	275	ams_delta_latch2_write(AMS_DELTA_LATCH2_MODEM_CODEC, 0);
	276	}
	277
	278	/* Line discipline .open() */
	279	static int cx81801_open(struct tty_struct *tty)
	280	{
f0fba2ad LG	281	int ret;
	282
	283	if (!cx20442_codec)
	284	return -ENODEV;
	285
	286	/*
	287	* Pass the codec structure pointer for use by other ldisc callbacks,
	288	* both the card and the codec specific parts.
	289	*/
	290	tty->disc_data = cx20442_codec;
	291
	292	ret = v253_ops.open(tty);
	293
	294	if (ret < 0)
	295	tty->disc_data = NULL;
	296
	297	return ret;
6d7f68a1 JK	298	}
	299
	300	/* Line discipline .close() */
	301	static void cx81801_close(struct tty_struct *tty)
	302	{
	303	struct snd_soc_codec *codec = tty->disc_data;
00200107	304	struct snd_soc_dapm_context *dapm = &codec->component.card->dapm;
6d7f68a1 JK	305
	306	del_timer_sync(&cx81801_timer);
	307
6d7f68a1 JK	308	/* Prevent the hook switch from further changing the DAPM pins */
	309	INIT_LIST_HEAD(&ams_delta_hook_switch.pins);
	310
f0fba2ad LG	311	if (!codec)
	312	return;
	313
	314	v253_ops.close(tty);
	315
6d7f68a1	316	/* Revert back to default audio input/output constellation */
03510ca0 CK	317	snd_soc_dapm_mutex_lock(dapm);
	318
	319	snd_soc_dapm_disable_pin_unlocked(dapm, "Mouthpiece");
	320	snd_soc_dapm_enable_pin_unlocked(dapm, "Earpiece");
	321	snd_soc_dapm_enable_pin_unlocked(dapm, "Microphone");
	322	snd_soc_dapm_disable_pin_unlocked(dapm, "Speaker");
	323	snd_soc_dapm_disable_pin_unlocked(dapm, "AGCIN");
	324
	325	snd_soc_dapm_sync_unlocked(dapm);
	326
e95d73c4	327	snd_soc_dapm_mutex_unlock(dapm);
6d7f68a1 JK	328	}
	329
	330	/* Line discipline .hangup() */
	331	static int cx81801_hangup(struct tty_struct *tty)
	332	{
	333	cx81801_close(tty);
	334	return 0;
	335	}
	336
dbc6221b	337	/* Line discipline .receive_buf() */
6d7f68a1 JK	338	static void cx81801_receive(struct tty_struct *tty,
	339	const unsigned char cp, char fp, int count)
	340	{
	341	struct snd_soc_codec *codec = tty->disc_data;
	342	const unsigned char *c;
	343	int apply, ret;
	344
f0fba2ad LG	345	if (!codec)
	346	return;
	347
	348	if (!codec->hw_write) {
6d7f68a1 JK	349	/* First modem response, complete setup procedure */
	350
	351	/* Initialize timer used for config pulse generation */
	352	setup_timer(&cx81801_timer, cx81801_timeout, 0);
	353
	354	v253_ops.receive_buf(tty, cp, fp, count);
	355
	356	/* Link hook switch to DAPM pins */
	357	ret = snd_soc_jack_add_pins(&ams_delta_hook_switch,
	358	ARRAY_SIZE(ams_delta_hook_switch_pins),
	359	ams_delta_hook_switch_pins);
	360	if (ret)
f0fba2ad	361	dev_warn(codec->dev,
6d7f68a1 JK	362	"Failed to link hook switch to DAPM pins, "
	363	"will continue with hook switch unlinked.\n");
	364
	365	return;
	366	}
	367
	368	v253_ops.receive_buf(tty, cp, fp, count);
	369
	370	for (c = &cp[count - 1]; c >= cp; c--) {
	371	if (*c != '\r')
	372	continue;
	373	/* Complete modem response received, apply config to codec */
	374
	375	spin_lock_bh(&ams_delta_lock);
	376	mod_timer(&cx81801_timer, jiffies + msecs_to_jiffies(150));
	377	apply = !ams_delta_muted && !cx81801_cmd_pending;
	378	cx81801_cmd_pending = 1;
	379	spin_unlock_bh(&ams_delta_lock);
	380
	381	/* Apply config pulse by connecting the codec to the modem
	382	* if not already done */
	383	if (apply)
	384	ams_delta_latch2_write(AMS_DELTA_LATCH2_MODEM_CODEC,
	385	AMS_DELTA_LATCH2_MODEM_CODEC);
	386	break;
	387	}
	388	}
	389
	390	/* Line discipline .write_wakeup() */
	391	static void cx81801_wakeup(struct tty_struct *tty)
	392	{
	393	v253_ops.write_wakeup(tty);
	394	}
	395
	396	static struct tty_ldisc_ops cx81801_ops = {
	397	.magic = TTY_LDISC_MAGIC,
	398	.name = "cx81801",
	399	.owner = THIS_MODULE,
	400	.open = cx81801_open,
	401	.close = cx81801_close,
	402	.hangup = cx81801_hangup,
	403	.receive_buf = cx81801_receive,
	404	.write_wakeup = cx81801_wakeup,
	405	};
	406
	407
	408	/*
25985edc	409	* Even if not very useful, the sound card can still work without any of the
6d7f68a1	410	* above functonality activated. You can still control its audio input/output
25985edc	411	* constellation and speakerphone gain from userspace by issuing AT commands
6d7f68a1 JK	412	* over the modem port.
	413	*/
	414
	415	static int ams_delta_hw_params(struct snd_pcm_substream *substream,
	416	struct snd_pcm_hw_params *params)
	417	{
	418	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	419
	420	/* Set cpu DAI configuration */
f0fba2ad	421	return snd_soc_dai_set_fmt(rtd->cpu_dai,
6d7f68a1 JK	422	SND_SOC_DAIFMT_DSP_A \|
	423	SND_SOC_DAIFMT_NB_NF \|
	424	SND_SOC_DAIFMT_CBM_CFM);
	425	}
	426
	427	static struct snd_soc_ops ams_delta_ops = {
	428	.hw_params = ams_delta_hw_params,
	429	};
	430
	431
6d7f68a1 JK	432	/* Digital mute implemented using modem/CPU multiplexer.
	433	* Shares hardware with codec config pulse generation */
	434	static bool ams_delta_muted = 1;
	435
	436	static int ams_delta_digital_mute(struct snd_soc_dai *dai, int mute)
	437	{
	438	int apply;
	439
	440	if (ams_delta_muted == mute)
	441	return 0;
	442
	443	spin_lock_bh(&ams_delta_lock);
	444	ams_delta_muted = mute;
	445	apply = !cx81801_cmd_pending;
	446	spin_unlock_bh(&ams_delta_lock);
	447
	448	if (apply)
	449	ams_delta_latch2_write(AMS_DELTA_LATCH2_MODEM_CODEC,
	450	mute ? AMS_DELTA_LATCH2_MODEM_CODEC : 0);
	451	return 0;
	452	}
	453
	454	/* Our codec DAI probably doesn't have its own .ops structure */
85e7652d	455	static const struct snd_soc_dai_ops ams_delta_dai_ops = {
6d7f68a1 JK	456	.digital_mute = ams_delta_digital_mute,
	457	};
	458
	459	/* Will be used if the codec ever has its own digital_mute function */
	460	static int ams_delta_startup(struct snd_pcm_substream *substream)
	461	{
	462	return ams_delta_digital_mute(NULL, 0);
	463	}
	464
	465	static void ams_delta_shutdown(struct snd_pcm_substream *substream)
	466	{
	467	ams_delta_digital_mute(NULL, 1);
	468	}
	469
	470
	471	/*
	472	* Card initialization
	473	*/
	474
f0fba2ad	475	static int ams_delta_cx20442_init(struct snd_soc_pcm_runtime *rtd)
6d7f68a1	476	{
f0fba2ad LG	477	struct snd_soc_dai *codec_dai = rtd->codec_dai;
f0fba2ad LG	478	struct snd_soc_card *card = rtd->card;
74a16720	479	struct snd_soc_dapm_context *dapm = &card->dapm;
6d7f68a1 JK	480	int ret;
	481	/* Codec is ready, now add/activate board specific controls */
	482
f0fba2ad	483	/* Store a pointer to the codec structure for tty ldisc use */
74a16720	484	cx20442_codec = rtd->codec;
f0fba2ad	485
6d7f68a1	486	/* Set up digital mute if not provided by the codec */
f0fba2ad LG	487	if (!codec_dai->driver->ops) {
f0fba2ad LG	488	codec_dai->driver->ops = &ams_delta_dai_ops;
6d7f68a1 JK	489	} else {
	490	ams_delta_ops.startup = ams_delta_startup;
	491	ams_delta_ops.shutdown = ams_delta_shutdown;
	492	}
	493
6d7f68a1 JK	494	/* Add hook switch - can be used to control the codec from userspace
6d7f68a1 JK	495	* even if line discipline fails */
f0fba2ad	496	ret = snd_soc_jack_new(rtd->codec, "hook_switch",
6d7f68a1 JK	497	SND_JACK_HEADSET, &ams_delta_hook_switch);
	498	if (ret)
	499	dev_warn(card->dev,
	500	"Failed to allocate resources for hook switch, "
	501	"will continue without one.\n");
	502	else {
	503	ret = snd_soc_jack_add_gpios(&ams_delta_hook_switch,
	504	ARRAY_SIZE(ams_delta_hook_switch_gpios),
	505	ams_delta_hook_switch_gpios);
	506	if (ret)
	507	dev_warn(card->dev,
	508	"Failed to set up hook switch GPIO line, "
	509	"will continue with hook switch inactive.\n");
	510	}
	511
	512	/* Register optional line discipline for over the modem control */
b7b8f9bf	513	ret = tty_register_ldisc(N_V253, &cx81801_ops);
6d7f68a1 JK	514	if (ret) {
	515	dev_warn(card->dev,
	516	"Failed to register line discipline, "
	517	"will continue without any controls.\n");
	518	return 0;
	519	}
	520
6d7f68a1	521	/* Set up initial pin constellation */
ce6120cc	522	snd_soc_dapm_disable_pin(dapm, "Mouthpiece");
ce6120cc LG	523	snd_soc_dapm_disable_pin(dapm, "Speaker");
	524	snd_soc_dapm_disable_pin(dapm, "AGCIN");
	525	snd_soc_dapm_disable_pin(dapm, "AGCOUT");
6d7f68a1	526
6d7f68a1 JK	527	return 0;
	528	}
	529
16088cb6	530	static int ams_delta_card_remove(struct snd_soc_card *card)
e1d4d3c8 SW	531	{
	532	snd_soc_jack_free_gpios(&ams_delta_hook_switch,
	533	ARRAY_SIZE(ams_delta_hook_switch_gpios),
	534	ams_delta_hook_switch_gpios);
	535
	536	return 0;
	537	}
	538
6d7f68a1 JK	539	/* DAI glue - connects codec <--> CPU */
	540	static struct snd_soc_dai_link ams_delta_dai_link = {
	541	.name = "CX20442",
	542	.stream_name = "CX20442",
45656b44	543	.cpu_dai_name = "omap-mcbsp.1",
5394637a	544	.codec_dai_name = "cx20442-voice",
6d7f68a1	545	.init = ams_delta_cx20442_init,
a25f478f	546	.platform_name = "omap-mcbsp.1",
f0fba2ad	547	.codec_name = "cx20442-codec",
6d7f68a1 JK	548	.ops = &ams_delta_ops,
	549	};
	550
	551	/* Audio card driver */
	552	static struct snd_soc_card ams_delta_audio_card = {
	553	.name = "AMS_DELTA",
b425b884	554	.owner = THIS_MODULE,
e1d4d3c8	555	.remove = ams_delta_card_remove,
6d7f68a1 JK	556	.dai_link = &ams_delta_dai_link,
6d7f68a1 JK	557	.num_links = 1,
74a16720 LPC	558
	559	.controls = ams_delta_audio_controls,
	560	.num_controls = ARRAY_SIZE(ams_delta_audio_controls),
	561	.dapm_widgets = ams_delta_dapm_widgets,
	562	.num_dapm_widgets = ARRAY_SIZE(ams_delta_dapm_widgets),
	563	.dapm_routes = ams_delta_audio_map,
	564	.num_dapm_routes = ARRAY_SIZE(ams_delta_audio_map),
6d7f68a1 JK	565	};
6d7f68a1 JK	566
6d7f68a1	567	/* Module init/exit */
7ff60006	568	static int ams_delta_probe(struct platform_device *pdev)
6d7f68a1	569	{
b764de2d	570	struct snd_soc_card *card = &ams_delta_audio_card;
6d7f68a1 JK	571	int ret;
6d7f68a1 JK	572
b764de2d	573	card->dev = &pdev->dev;
6d7f68a1	574
b764de2d JK	575	ret = snd_soc_register_card(card);
	576	if (ret) {
	577	dev_err(&pdev->dev, "snd_soc_register_card failed (%d)\n", ret);
	578	card->dev = NULL;
	579	return ret;
	580	}
6d7f68a1	581	return 0;
6d7f68a1	582	}
6d7f68a1	583
7ff60006	584	static int ams_delta_remove(struct platform_device *pdev)
6d7f68a1	585	{
b764de2d JK	586	struct snd_soc_card *card = platform_get_drvdata(pdev);
b764de2d JK	587
b7b8f9bf	588	if (tty_unregister_ldisc(N_V253) != 0)
b764de2d	589	dev_warn(&pdev->dev,
b7b8f9bf	590	"failed to unregister V253 line discipline\n");
6d7f68a1	591
b764de2d JK	592	snd_soc_unregister_card(card);
	593	card->dev = NULL;
	594	return 0;
6d7f68a1	595	}
b764de2d JK	596
	597	#define DRV_NAME "ams-delta-audio"
	598
	599	static struct platform_driver ams_delta_driver = {
	600	.driver = {
	601	.name = DRV_NAME,
	602	.owner = THIS_MODULE,
	603	},
	604	.probe = ams_delta_probe,
7ff60006	605	.remove = ams_delta_remove,
b764de2d JK	606	};
	607
	608	module_platform_driver(ams_delta_driver);
6d7f68a1 JK	609
	610	MODULE_AUTHOR("Janusz Krzysztofik <jkrzyszt@tis.icnet.pl>");
	611	MODULE_DESCRIPTION("ALSA SoC driver for Amstrad E3 (Delta) videophone");
	612	MODULE_LICENSE("GPL");
b764de2d	613	MODULE_ALIAS("platform:" DRV_NAME);