[GitHub/mt8127/android_kernel_alcatel_ttab.git] / sound / soc / codecs / lm4857.c

/*
 * LM4857 AMP driver
 *
 * Copyright 2007 Wolfson Microelectronics PLC.
 * Author: Graeme Gregory
 *         graeme.gregory@wolfsonmicro.com or linux@wolfsonmicro.com
 * Copyright 2011 Lars-Peter Clausen <lars@metafoo.de>
 *
 *  This program is free software; you can redistribute  it and/or modify it
 *  under  the terms of  the GNU General  Public License as published by the
 *  Free Software Foundation;  either version 2 of the  License, or (at your
 *  option) any later version.
 *
 */

#include <linux/init.h>
#include <linux/module.h>
#include <linux/i2c.h>
#include <linux/slab.h>

#include <sound/core.h>
#include <sound/soc.h>
#include <sound/tlv.h>

struct lm4857 {
	struct i2c_client *i2c;
	uint8_t mode;
};

static const uint8_t lm4857_default_regs[] = {
	0x00, 0x00, 0x00, 0x00,
};

/* The register offsets in the cache array */
#define LM4857_MVOL 0
#define LM4857_LVOL 1
#define LM4857_RVOL 2
#define LM4857_CTRL 3

/* the shifts required to set these bits */
#define LM4857_3D 5
#define LM4857_WAKEUP 5
#define LM4857_EPGAIN 4

static int lm4857_write(struct snd_soc_codec *codec, unsigned int reg,
		unsigned int value)
{
	uint8_t data;
	int ret;

	ret = snd_soc_cache_write(codec, reg, value);
	if (ret < 0)
		return ret;

	data = (reg << 6) | value;
	ret = i2c_master_send(codec->control_data, &data, 1);
	if (ret != 1) {
		dev_err(codec->dev, "Failed to write register: %d\n", ret);
		return ret;
	}

	return 0;
}

static unsigned int lm4857_read(struct snd_soc_codec *codec,
		unsigned int reg)
{
	unsigned int val;
	int ret;

	ret = snd_soc_cache_read(codec, reg, &val);
	if (ret)
		return -1;

	return val;
}

static int lm4857_get_mode(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
{
	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
	struct lm4857 *lm4857 = snd_soc_codec_get_drvdata(codec);

	ucontrol->value.integer.value[0] = lm4857->mode;

	return 0;
}

static int lm4857_set_mode(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
{
	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
	struct lm4857 *lm4857 = snd_soc_codec_get_drvdata(codec);
	uint8_t value = ucontrol->value.integer.value[0];

	lm4857->mode = value;

	if (codec->dapm.bias_level == SND_SOC_BIAS_ON)
		snd_soc_update_bits(codec, LM4857_CTRL, 0x0F, value + 6);

	return 1;
}

static int lm4857_set_bias_level(struct snd_soc_codec *codec,
				 enum snd_soc_bias_level level)
{
	struct lm4857 *lm4857 = snd_soc_codec_get_drvdata(codec);

	switch (level) {
	case SND_SOC_BIAS_ON:
		snd_soc_update_bits(codec, LM4857_CTRL, 0x0F, lm4857->mode + 6);
		break;
	case SND_SOC_BIAS_STANDBY:
		snd_soc_update_bits(codec, LM4857_CTRL, 0x0F, 0);
		break;
	default:
		break;
	}

	codec->dapm.bias_level = level;

	return 0;
}

static const char *lm4857_mode[] = {
	"Earpiece",
	"Loudspeaker",
	"Loudspeaker + Headphone",
	"Headphone",
};

static const struct soc_enum lm4857_mode_enum =
	SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(lm4857_mode), lm4857_mode);

static const struct snd_soc_dapm_widget lm4857_dapm_widgets[] = {
	SND_SOC_DAPM_INPUT("IN"),

	SND_SOC_DAPM_OUTPUT("LS"),
	SND_SOC_DAPM_OUTPUT("HP"),
	SND_SOC_DAPM_OUTPUT("EP"),
};

static const DECLARE_TLV_DB_SCALE(stereo_tlv, -4050, 150, 0);
static const DECLARE_TLV_DB_SCALE(mono_tlv, -3450, 150, 0);

static const struct snd_kcontrol_new lm4857_controls[] = {
	SOC_SINGLE_TLV("Left Playback Volume", LM4857_LVOL, 0, 31, 0,
		stereo_tlv),
	SOC_SINGLE_TLV("Right Playback Volume", LM4857_RVOL, 0, 31, 0,
		stereo_tlv),
	SOC_SINGLE_TLV("Mono Playback Volume", LM4857_MVOL, 0, 31, 0,
		mono_tlv),
	SOC_SINGLE("Spk 3D Playback Switch", LM4857_LVOL, LM4857_3D, 1, 0),
	SOC_SINGLE("HP 3D Playback Switch", LM4857_RVOL, LM4857_3D, 1, 0),
	SOC_SINGLE("Fast Wakeup Playback Switch", LM4857_CTRL,
		LM4857_WAKEUP, 1, 0),
	SOC_SINGLE("Earpiece 6dB Playback Switch", LM4857_CTRL,
		LM4857_EPGAIN, 1, 0),

	SOC_ENUM_EXT("Mode", lm4857_mode_enum,
		lm4857_get_mode, lm4857_set_mode),
};

/* There is a demux between the input signal and the output signals.
 * Currently there is no easy way to model it in ASoC and since it does not make
 * much of a difference in practice simply connect the input direclty to the
 * outputs. */
static const struct snd_soc_dapm_route lm4857_routes[] = {
	{"LS", NULL, "IN"},
	{"HP", NULL, "IN"},
	{"EP", NULL, "IN"},
};

static int lm4857_probe(struct snd_soc_codec *codec)
{
	struct lm4857 *lm4857 = snd_soc_codec_get_drvdata(codec);
	struct snd_soc_dapm_context *dapm = &codec->dapm;
	int ret;

	codec->control_data = lm4857->i2c;

	ret = snd_soc_add_controls(codec, lm4857_controls,
			ARRAY_SIZE(lm4857_controls));
	if (ret)
		return ret;

	ret = snd_soc_dapm_new_controls(dapm, lm4857_dapm_widgets,
			ARRAY_SIZE(lm4857_dapm_widgets));
	if (ret)
		return ret;

	ret = snd_soc_dapm_add_routes(dapm, lm4857_routes,
			ARRAY_SIZE(lm4857_routes));
	if (ret)
		return ret;

	snd_soc_dapm_new_widgets(dapm);

	return 0;
}

static struct snd_soc_codec_driver soc_codec_dev_lm4857 = {
	.write = lm4857_write,
	.read = lm4857_read,
	.probe = lm4857_probe,
	.reg_cache_size = ARRAY_SIZE(lm4857_default_regs),
	.reg_word_size = sizeof(uint8_t),
	.reg_cache_default = lm4857_default_regs,
	.set_bias_level = lm4857_set_bias_level,
};

static int __devinit lm4857_i2c_probe(struct i2c_client *i2c,
	const struct i2c_device_id *id)
{
	struct lm4857 *lm4857;
	int ret;

	lm4857 = kzalloc(sizeof(*lm4857), GFP_KERNEL);
	if (!lm4857)
		return -ENOMEM;

	i2c_set_clientdata(i2c, lm4857);

	lm4857->i2c = i2c;

	ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_lm4857, NULL, 0);

	if (ret) {
		kfree(lm4857);
		return ret;
	}

	return 0;
}

static int __devexit lm4857_i2c_remove(struct i2c_client *i2c)
{
	struct lm4857 *lm4857 = i2c_get_clientdata(i2c);

	snd_soc_unregister_codec(&i2c->dev);
	kfree(lm4857);

	return 0;
}

static const struct i2c_device_id lm4857_i2c_id[] = {
	{ "lm4857", 0 },
	{ }
};
MODULE_DEVICE_TABLE(i2c, lm4857_i2c_id);

static struct i2c_driver lm4857_i2c_driver = {
	.driver = {
		.name = "lm4857",
		.owner = THIS_MODULE,
	},
	.probe = lm4857_i2c_probe,
	.remove = __devexit_p(lm4857_i2c_remove),
	.id_table = lm4857_i2c_id,
};

static int __init lm4857_init(void)
{
	return i2c_add_driver(&lm4857_i2c_driver);
}
module_init(lm4857_init);

static void __exit lm4857_exit(void)
{
	i2c_del_driver(&lm4857_i2c_driver);
}
module_exit(lm4857_exit);

MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
MODULE_DESCRIPTION("LM4857 amplifier driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
9b0a25f0 LPC	1	/*
	2	* LM4857 AMP driver
	3	*
	4	* Copyright 2007 Wolfson Microelectronics PLC.
	5	* Author: Graeme Gregory
	6	* graeme.gregory@wolfsonmicro.com or linux@wolfsonmicro.com
	7	* Copyright 2011 Lars-Peter Clausen <lars@metafoo.de>
	8	*
	9	* This program is free software; you can redistribute it and/or modify it
	10	* under the terms of the GNU General Public License as published by the
	11	* Free Software Foundation; either version 2 of the License, or (at your
	12	* option) any later version.
	13	*
	14	*/
	15
	16	#include <linux/init.h>
	17	#include <linux/module.h>
	18	#include <linux/i2c.h>
	19	#include <linux/slab.h>
	20
	21	#include <sound/core.h>
	22	#include <sound/soc.h>
	23	#include <sound/tlv.h>
	24
	25	struct lm4857 {
	26	struct i2c_client *i2c;
	27	uint8_t mode;
	28	};
	29
	30	static const uint8_t lm4857_default_regs[] = {
	31	0x00, 0x00, 0x00, 0x00,
	32	};
	33
	34	/* The register offsets in the cache array */
	35	#define LM4857_MVOL 0
	36	#define LM4857_LVOL 1
	37	#define LM4857_RVOL 2
	38	#define LM4857_CTRL 3
	39
	40	/* the shifts required to set these bits */
	41	#define LM4857_3D 5
	42	#define LM4857_WAKEUP 5
	43	#define LM4857_EPGAIN 4
	44
	45	static int lm4857_write(struct snd_soc_codec *codec, unsigned int reg,
	46	unsigned int value)
	47	{
	48	uint8_t data;
	49	int ret;
	50
	51	ret = snd_soc_cache_write(codec, reg, value);
	52	if (ret < 0)
	53	return ret;
	54
	55	data = (reg << 6) \| value;
	56	ret = i2c_master_send(codec->control_data, &data, 1);
	57	if (ret != 1) {
	58	dev_err(codec->dev, "Failed to write register: %d\n", ret);
	59	return ret;
	60	}
	61
	62	return 0;
	63	}
	64
65	static unsigned int lm4857_read(struct snd_soc_codec *codec,
66	unsigned int reg)
67	{
68	unsigned int val;
69	int ret;
70
71	ret = snd_soc_cache_read(codec, reg, &val);
72	if (ret)
73	return -1;
74
75	return val;
76	}
77
78	static int lm4857_get_mode(struct snd_kcontrol *kcontrol,
79	struct snd_ctl_elem_value *ucontrol)
80	{
81	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
82	struct lm4857 *lm4857 = snd_soc_codec_get_drvdata(codec);
83
84	ucontrol->value.integer.value[0] = lm4857->mode;
85
86	return 0;
87	}
88
89	static int lm4857_set_mode(struct snd_kcontrol *kcontrol,
90	struct snd_ctl_elem_value *ucontrol)
91	{
92	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
93	struct lm4857 *lm4857 = snd_soc_codec_get_drvdata(codec);
94	uint8_t value = ucontrol->value.integer.value[0];
95
96	lm4857->mode = value;
97
98	if (codec->dapm.bias_level == SND_SOC_BIAS_ON)
99	snd_soc_update_bits(codec, LM4857_CTRL, 0x0F, value + 6);
100
101	return 1;
102	}
103
104	static int lm4857_set_bias_level(struct snd_soc_codec *codec,
105	enum snd_soc_bias_level level)
106	{
107	struct lm4857 *lm4857 = snd_soc_codec_get_drvdata(codec);
108
109	switch (level) {
110	case SND_SOC_BIAS_ON:
111	snd_soc_update_bits(codec, LM4857_CTRL, 0x0F, lm4857->mode + 6);
112	break;
113	case SND_SOC_BIAS_STANDBY:
114	snd_soc_update_bits(codec, LM4857_CTRL, 0x0F, 0);
115	break;
116	default:
117	break;
118	}
119
120	codec->dapm.bias_level = level;
121
122	return 0;
123	}
124
125	static const char *lm4857_mode[] = {
126	"Earpiece",
127	"Loudspeaker",
128	"Loudspeaker + Headphone",
129	"Headphone",
130	};
131
132	static const struct soc_enum lm4857_mode_enum =
133	SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(lm4857_mode), lm4857_mode);
134
135	static const struct snd_soc_dapm_widget lm4857_dapm_widgets[] = {
136	SND_SOC_DAPM_INPUT("IN"),
137
138	SND_SOC_DAPM_OUTPUT("LS"),
139	SND_SOC_DAPM_OUTPUT("HP"),
140	SND_SOC_DAPM_OUTPUT("EP"),
141	};
142
143	static const DECLARE_TLV_DB_SCALE(stereo_tlv, -4050, 150, 0);
144	static const DECLARE_TLV_DB_SCALE(mono_tlv, -3450, 150, 0);
145
146	static const struct snd_kcontrol_new lm4857_controls[] = {
147	SOC_SINGLE_TLV("Left Playback Volume", LM4857_LVOL, 0, 31, 0,
148	stereo_tlv),
149	SOC_SINGLE_TLV("Right Playback Volume", LM4857_RVOL, 0, 31, 0,
150	stereo_tlv),
151	SOC_SINGLE_TLV("Mono Playback Volume", LM4857_MVOL, 0, 31, 0,
152	mono_tlv),
153	SOC_SINGLE("Spk 3D Playback Switch", LM4857_LVOL, LM4857_3D, 1, 0),
154	SOC_SINGLE("HP 3D Playback Switch", LM4857_RVOL, LM4857_3D, 1, 0),
155	SOC_SINGLE("Fast Wakeup Playback Switch", LM4857_CTRL,
156	LM4857_WAKEUP, 1, 0),
157	SOC_SINGLE("Earpiece 6dB Playback Switch", LM4857_CTRL,
158	LM4857_EPGAIN, 1, 0),
159
160	SOC_ENUM_EXT("Mode", lm4857_mode_enum,
161	lm4857_get_mode, lm4857_set_mode),
162	};
163
25985edc	164	/* There is a demux between the input signal and the output signals.
9b0a25f0 LPC	165	* Currently there is no easy way to model it in ASoC and since it does not make
	166	* much of a difference in practice simply connect the input direclty to the
	167	* outputs. */
	168	static const struct snd_soc_dapm_route lm4857_routes[] = {
	169	{"LS", NULL, "IN"},
	170	{"HP", NULL, "IN"},
	171	{"EP", NULL, "IN"},
	172	};
	173
	174	static int lm4857_probe(struct snd_soc_codec *codec)
	175	{
	176	struct lm4857 *lm4857 = snd_soc_codec_get_drvdata(codec);
	177	struct snd_soc_dapm_context *dapm = &codec->dapm;
	178	int ret;
	179
	180	codec->control_data = lm4857->i2c;
	181
	182	ret = snd_soc_add_controls(codec, lm4857_controls,
	183	ARRAY_SIZE(lm4857_controls));
	184	if (ret)
	185	return ret;
	186
	187	ret = snd_soc_dapm_new_controls(dapm, lm4857_dapm_widgets,
	188	ARRAY_SIZE(lm4857_dapm_widgets));
	189	if (ret)
	190	return ret;
	191
	192	ret = snd_soc_dapm_add_routes(dapm, lm4857_routes,
	193	ARRAY_SIZE(lm4857_routes));
	194	if (ret)
	195	return ret;
	196
	197	snd_soc_dapm_new_widgets(dapm);
	198
	199	return 0;
	200	}
	201
	202	static struct snd_soc_codec_driver soc_codec_dev_lm4857 = {
	203	.write = lm4857_write,
	204	.read = lm4857_read,
	205	.probe = lm4857_probe,
	206	.reg_cache_size = ARRAY_SIZE(lm4857_default_regs),
	207	.reg_word_size = sizeof(uint8_t),
	208	.reg_cache_default = lm4857_default_regs,
	209	.set_bias_level = lm4857_set_bias_level,
	210	};
	211
	212	static int __devinit lm4857_i2c_probe(struct i2c_client *i2c,
	213	const struct i2c_device_id *id)
	214	{
	215	struct lm4857 *lm4857;
	216	int ret;
	217
	218	lm4857 = kzalloc(sizeof(*lm4857), GFP_KERNEL);
	219	if (!lm4857)
	220	return -ENOMEM;
	221
	222	i2c_set_clientdata(i2c, lm4857);
	223
	224	lm4857->i2c = i2c;
	225
	226	ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_lm4857, NULL, 0);
	227
	228	if (ret) {
229	kfree(lm4857);
230	return ret;
231	}
232
233	return 0;
234	}
235
236	static int __devexit lm4857_i2c_remove(struct i2c_client *i2c)
237	{
238	struct lm4857 *lm4857 = i2c_get_clientdata(i2c);
239
240	snd_soc_unregister_codec(&i2c->dev);
241	kfree(lm4857);
242
243	return 0;
244	}
245
246	static const struct i2c_device_id lm4857_i2c_id[] = {
247	{ "lm4857", 0 },
248	{ }
249	};
250	MODULE_DEVICE_TABLE(i2c, lm4857_i2c_id);
251
252	static struct i2c_driver lm4857_i2c_driver = {
253	.driver = {
254	.name = "lm4857",
255	.owner = THIS_MODULE,
256	},
257	.probe = lm4857_i2c_probe,
258	.remove = __devexit_p(lm4857_i2c_remove),
259	.id_table = lm4857_i2c_id,
260	};
261
262	static int __init lm4857_init(void)
263	{
264	return i2c_add_driver(&lm4857_i2c_driver);
265	}
266	module_init(lm4857_init);
267
268	static void __exit lm4857_exit(void)
269	{
270	i2c_del_driver(&lm4857_i2c_driver);
271	}
272	module_exit(lm4857_exit);
273
274	MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
275	MODULE_DESCRIPTION("LM4857 amplifier driver");
276	MODULE_LICENSE("GPL");