Merge remote-tracking branch 'asoc/topic/max9877' into asoc-next (6037fcad) · Commits · e / devices / android_kernel_fairphone_FP3

sound/soc/codecs/max9877.c

+92 −202

Original line number	Original line	Diff line number	Diff line
	@@ -14,170 +14,21 @@
	#include <linux/module.h>		#include <linux/module.h>
	#include <linux/init.h>		#include <linux/init.h>
	#include <linux/i2c.h>		#include <linux/i2c.h>
			#include <linux/regmap.h>
	#include <sound/soc.h>		#include <sound/soc.h>
	#include <sound/tlv.h>		#include <sound/tlv.h>

	#include "max9877.h"		#include "max9877.h"

	static struct i2c_client *i2c;		static struct regmap *regmap;

	static u8 max9877_regs[5] = { 0x40, 0x00, 0x00, 0x00, 0x49 };		static struct reg_default max9877_regs[] = {
			{ 0, 0x40 },
	static void max9877_write_regs(void)		{ 1, 0x00 },
	{		{ 2, 0x00 },
	unsigned int i;		{ 3, 0x00 },
	u8 data[6];		{ 4, 0x49 },
			};
	data[0] = MAX9877_INPUT_MODE;
	for (i = 0; i < ARRAY_SIZE(max9877_regs); i++)
	data[i + 1] = max9877_regs[i];

	if (i2c_master_send(i2c, data, 6) != 6)
	dev_err(&i2c->dev, "i2c write failed\n");
	}

	static int max9877_get_reg(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
	{
	struct soc_mixer_control *mc =
	(struct soc_mixer_control *)kcontrol->private_value;
	unsigned int reg = mc->reg;
	unsigned int shift = mc->shift;
	unsigned int mask = mc->max;
	unsigned int invert = mc->invert;

	ucontrol->value.integer.value[0] = (max9877_regs[reg] >> shift) & mask;

	if (invert)
	ucontrol->value.integer.value[0] =
	mask - ucontrol->value.integer.value[0];

	return 0;
	}

	static int max9877_set_reg(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
	{
	struct soc_mixer_control *mc =
	(struct soc_mixer_control *)kcontrol->private_value;
	unsigned int reg = mc->reg;
	unsigned int shift = mc->shift;
	unsigned int mask = mc->max;
	unsigned int invert = mc->invert;
	unsigned int val = (ucontrol->value.integer.value[0] & mask);

	if (invert)
	val = mask - val;

	if (((max9877_regs[reg] >> shift) & mask) == val)
	return 0;

	max9877_regs[reg] &= ~(mask << shift);
	max9877_regs[reg] \|= val << shift;
	max9877_write_regs();

	return 1;
	}

	static int max9877_get_2reg(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
	{
	struct soc_mixer_control *mc =
	(struct soc_mixer_control *)kcontrol->private_value;
	unsigned int reg = mc->reg;
	unsigned int reg2 = mc->rreg;
	unsigned int shift = mc->shift;
	unsigned int mask = mc->max;

	ucontrol->value.integer.value[0] = (max9877_regs[reg] >> shift) & mask;
	ucontrol->value.integer.value[1] = (max9877_regs[reg2] >> shift) & mask;

	return 0;
	}

	static int max9877_set_2reg(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
	{
	struct soc_mixer_control *mc =
	(struct soc_mixer_control *)kcontrol->private_value;
	unsigned int reg = mc->reg;
	unsigned int reg2 = mc->rreg;
	unsigned int shift = mc->shift;
	unsigned int mask = mc->max;
	unsigned int val = (ucontrol->value.integer.value[0] & mask);
	unsigned int val2 = (ucontrol->value.integer.value[1] & mask);
	unsigned int change = 0;

	if (((max9877_regs[reg] >> shift) & mask) != val)
	change = 1;

	if (((max9877_regs[reg2] >> shift) & mask) != val2)
	change = 1;

	if (change) {
	max9877_regs[reg] &= ~(mask << shift);
	max9877_regs[reg] \|= val << shift;
	max9877_regs[reg2] &= ~(mask << shift);
	max9877_regs[reg2] \|= val2 << shift;
	max9877_write_regs();
	}

	return change;
	}

	static int max9877_get_out_mode(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
	{
	u8 value = max9877_regs[MAX9877_OUTPUT_MODE] & MAX9877_OUTMODE_MASK;

	if (value)
	value -= 1;

	ucontrol->value.integer.value[0] = value;
	return 0;
	}

	static int max9877_set_out_mode(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
	{
	u8 value = ucontrol->value.integer.value[0];

	value += 1;

	if ((max9877_regs[MAX9877_OUTPUT_MODE] & MAX9877_OUTMODE_MASK) == value)
	return 0;

	max9877_regs[MAX9877_OUTPUT_MODE] &= ~MAX9877_OUTMODE_MASK;
	max9877_regs[MAX9877_OUTPUT_MODE] \|= value;
	max9877_write_regs();
	return 1;
	}

	static int max9877_get_osc_mode(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
	{
	u8 value = (max9877_regs[MAX9877_OUTPUT_MODE] & MAX9877_OSC_MASK);

	value = value >> MAX9877_OSC_OFFSET;

	ucontrol->value.integer.value[0] = value;
	return 0;
	}

	static int max9877_set_osc_mode(struct snd_kcontrol *kcontrol,
	struct snd_ctl_elem_value *ucontrol)
	{
	u8 value = ucontrol->value.integer.value[0];

	value = value << MAX9877_OSC_OFFSET;
	if ((max9877_regs[MAX9877_OUTPUT_MODE] & MAX9877_OSC_MASK) == value)
	return 0;

	max9877_regs[MAX9877_OUTPUT_MODE] &= ~MAX9877_OSC_MASK;
	max9877_regs[MAX9877_OUTPUT_MODE] \|= value;
	max9877_write_regs();
	return 1;
	}

	static const unsigned int max9877_pgain_tlv[] = {		static const unsigned int max9877_pgain_tlv[] = {
	TLV_DB_RANGE_HEAD(2),		TLV_DB_RANGE_HEAD(2),
	@@ -212,65 +63,104 @@ static const char *max9877_osc_mode[] = {
	};		};

	static const struct soc_enum max9877_enum[] = {		static const struct soc_enum max9877_enum[] = {
	SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(max9877_out_mode), max9877_out_mode),		SOC_ENUM_SINGLE(MAX9877_OUTPUT_MODE, 0, ARRAY_SIZE(max9877_out_mode),
	SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(max9877_osc_mode), max9877_osc_mode),		max9877_out_mode),
			SOC_ENUM_SINGLE(MAX9877_OUTPUT_MODE, MAX9877_OSC_OFFSET,
			ARRAY_SIZE(max9877_osc_mode), max9877_osc_mode),
	};		};

	static const struct snd_kcontrol_new max9877_controls[] = {		static const struct snd_kcontrol_new max9877_controls[] = {
	SOC_SINGLE_EXT_TLV("MAX9877 PGAINA Playback Volume",		SOC_SINGLE_TLV("MAX9877 PGAINA Playback Volume",
	MAX9877_INPUT_MODE, 0, 2, 0,		MAX9877_INPUT_MODE, 0, 2, 0, max9877_pgain_tlv),
	max9877_get_reg, max9877_set_reg, max9877_pgain_tlv),		SOC_SINGLE_TLV("MAX9877 PGAINB Playback Volume",
	SOC_SINGLE_EXT_TLV("MAX9877 PGAINB Playback Volume",		MAX9877_INPUT_MODE, 2, 2, 0, max9877_pgain_tlv),
	MAX9877_INPUT_MODE, 2, 2, 0,		SOC_SINGLE_TLV("MAX9877 Amp Speaker Playback Volume",
	max9877_get_reg, max9877_set_reg, max9877_pgain_tlv),		MAX9877_SPK_VOLUME, 0, 31, 0, max9877_output_tlv),
	SOC_SINGLE_EXT_TLV("MAX9877 Amp Speaker Playback Volume",		SOC_DOUBLE_R_TLV("MAX9877 Amp HP Playback Volume",
	MAX9877_SPK_VOLUME, 0, 31, 0,
	max9877_get_reg, max9877_set_reg, max9877_output_tlv),
	SOC_DOUBLE_R_EXT_TLV("MAX9877 Amp HP Playback Volume",
	MAX9877_HPL_VOLUME, MAX9877_HPR_VOLUME, 0, 31, 0,		MAX9877_HPL_VOLUME, MAX9877_HPR_VOLUME, 0, 31, 0,
	max9877_get_2reg, max9877_set_2reg, max9877_output_tlv),		max9877_output_tlv),
	SOC_SINGLE_EXT("MAX9877 INB Stereo Switch",		SOC_SINGLE("MAX9877 INB Stereo Switch",
	MAX9877_INPUT_MODE, 4, 1, 1,		MAX9877_INPUT_MODE, 4, 1, 1),
	max9877_get_reg, max9877_set_reg),		SOC_SINGLE("MAX9877 INA Stereo Switch",
	SOC_SINGLE_EXT("MAX9877 INA Stereo Switch",		MAX9877_INPUT_MODE, 5, 1, 1),
	MAX9877_INPUT_MODE, 5, 1, 1,		SOC_SINGLE("MAX9877 Zero-crossing detection Switch",
	max9877_get_reg, max9877_set_reg),		MAX9877_INPUT_MODE, 6, 1, 0),
	SOC_SINGLE_EXT("MAX9877 Zero-crossing detection Switch",		SOC_SINGLE("MAX9877 Bypass Mode Switch",
	MAX9877_INPUT_MODE, 6, 1, 0,		MAX9877_OUTPUT_MODE, 6, 1, 0),
	max9877_get_reg, max9877_set_reg),		SOC_ENUM("MAX9877 Output Mode", max9877_enum[0]),
	SOC_SINGLE_EXT("MAX9877 Bypass Mode Switch",		SOC_ENUM("MAX9877 Oscillator Mode", max9877_enum[1]),
	MAX9877_OUTPUT_MODE, 6, 1, 0,
	max9877_get_reg, max9877_set_reg),
	SOC_SINGLE_EXT("MAX9877 Shutdown Mode Switch",
	MAX9877_OUTPUT_MODE, 7, 1, 1,
	max9877_get_reg, max9877_set_reg),
	SOC_ENUM_EXT("MAX9877 Output Mode", max9877_enum[0],
	max9877_get_out_mode, max9877_set_out_mode),
	SOC_ENUM_EXT("MAX9877 Oscillator Mode", max9877_enum[1],
	max9877_get_osc_mode, max9877_set_osc_mode),
	};		};

	/* This function is called from ASoC machine driver */		static const struct snd_soc_dapm_widget max9877_dapm_widgets[] = {
	int max9877_add_controls(struct snd_soc_codec *codec)		SND_SOC_DAPM_INPUT("INA1"),
	{		SND_SOC_DAPM_INPUT("INA2"),
	return snd_soc_add_codec_controls(codec, max9877_controls,		SND_SOC_DAPM_INPUT("INB1"),
	ARRAY_SIZE(max9877_controls));		SND_SOC_DAPM_INPUT("INB2"),
	}		SND_SOC_DAPM_INPUT("RXIN+"),
	EXPORT_SYMBOL_GPL(max9877_add_controls);		SND_SOC_DAPM_INPUT("RXIN-"),

			SND_SOC_DAPM_PGA("SHDN", MAX9877_OUTPUT_MODE, 7, 1, NULL, 0),

			SND_SOC_DAPM_OUTPUT("OUT+"),
			SND_SOC_DAPM_OUTPUT("OUT-"),
			SND_SOC_DAPM_OUTPUT("HPL"),
			SND_SOC_DAPM_OUTPUT("HPR"),
			};

			static const struct snd_soc_dapm_route max9877_dapm_routes[] = {
			{ "SHDN", NULL, "INA1" },
			{ "SHDN", NULL, "INA2" },
			{ "SHDN", NULL, "INB1" },
			{ "SHDN", NULL, "INB2" },

			{ "OUT+", NULL, "RXIN+" },
			{ "OUT+", NULL, "SHDN" },

			{ "OUT-", NULL, "SHDN" },
			{ "OUT-", NULL, "RXIN-" },

			{ "HPL", NULL, "SHDN" },
			{ "HPR", NULL, "SHDN" },
			};

			static const struct snd_soc_codec_driver max9877_codec = {
			.controls = max9877_controls,
			.num_controls = ARRAY_SIZE(max9877_controls),

			.dapm_widgets = max9877_dapm_widgets,
			.num_dapm_widgets = ARRAY_SIZE(max9877_dapm_widgets),
			.dapm_routes = max9877_dapm_routes,
			.num_dapm_routes = ARRAY_SIZE(max9877_dapm_routes),
			};

			static const struct regmap_config max9877_regmap = {
			.reg_bits = 8,
			.val_bits = 8,

			.reg_defaults = max9877_regs,
			.num_reg_defaults = ARRAY_SIZE(max9877_regs),
			.cache_type = REGCACHE_RBTREE,
			};

	static int max9877_i2c_probe(struct i2c_client *client,		static int max9877_i2c_probe(struct i2c_client *client,
	const struct i2c_device_id *id)		const struct i2c_device_id *id)
	{		{
	i2c = client;		int i;

	max9877_write_regs();		regmap = devm_regmap_init_i2c(client, &max9877_regmap);
			if (IS_ERR(regmap))
			return PTR_ERR(regmap);

	return 0;		/* Ensure the device is in reset state */
			for (i = 0; i < ARRAY_SIZE(max9877_regs); i++)
			regmap_write(regmap, max9877_regs[i].reg, max9877_regs[i].def);

			return snd_soc_register_codec(&client->dev, &max9877_codec, NULL, 0);
	}		}

	static int max9877_i2c_remove(struct i2c_client *client)		static int max9877_i2c_remove(struct i2c_client *client)
	{		{
	i2c = NULL;		snd_soc_unregister_codec(&client->dev);

	return 0;		return 0;
	}		}