698 lines
		
	
	
		
			20 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			698 lines
		
	
	
		
			20 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0-or-later
 | |
| /*
 | |
|  * CS4271 ASoC codec driver
 | |
|  *
 | |
|  * Copyright (c) 2010 Alexander Sverdlin <subaparts@yandex.ru>
 | |
|  *
 | |
|  * This driver support CS4271 codec being master or slave, working
 | |
|  * in control port mode, connected either via SPI or I2C.
 | |
|  * The data format accepted is I2S or left-justified.
 | |
|  * DAPM support not implemented.
 | |
|  */
 | |
| 
 | |
| #include <linux/module.h>
 | |
| #include <linux/slab.h>
 | |
| #include <linux/delay.h>
 | |
| #include <linux/gpio/consumer.h>
 | |
| #include <linux/of.h>
 | |
| #include <linux/regulator/consumer.h>
 | |
| #include <sound/pcm.h>
 | |
| #include <sound/soc.h>
 | |
| #include <sound/tlv.h>
 | |
| #include <sound/cs4271.h>
 | |
| #include "cs4271.h"
 | |
| 
 | |
| #define CS4271_PCM_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \
 | |
| 			    SNDRV_PCM_FMTBIT_S24_LE | \
 | |
| 			    SNDRV_PCM_FMTBIT_S32_LE)
 | |
| #define CS4271_PCM_RATES SNDRV_PCM_RATE_8000_192000
 | |
| 
 | |
| /*
 | |
|  * CS4271 registers
 | |
|  */
 | |
| #define CS4271_MODE1	0x01	/* Mode Control 1 */
 | |
| #define CS4271_DACCTL	0x02	/* DAC Control */
 | |
| #define CS4271_DACVOL	0x03	/* DAC Volume & Mixing Control */
 | |
| #define CS4271_VOLA	0x04	/* DAC Channel A Volume Control */
 | |
| #define CS4271_VOLB	0x05	/* DAC Channel B Volume Control */
 | |
| #define CS4271_ADCCTL	0x06	/* ADC Control */
 | |
| #define CS4271_MODE2	0x07	/* Mode Control 2 */
 | |
| #define CS4271_CHIPID	0x08	/* Chip ID */
 | |
| 
 | |
| #define CS4271_FIRSTREG	CS4271_MODE1
 | |
| #define CS4271_LASTREG	CS4271_MODE2
 | |
| #define CS4271_NR_REGS	((CS4271_LASTREG & 0xFF) + 1)
 | |
| 
 | |
| /* Bit masks for the CS4271 registers */
 | |
| #define CS4271_MODE1_MODE_MASK	0xC0
 | |
| #define CS4271_MODE1_MODE_1X	0x00
 | |
| #define CS4271_MODE1_MODE_2X	0x80
 | |
| #define CS4271_MODE1_MODE_4X	0xC0
 | |
| 
 | |
| #define CS4271_MODE1_DIV_MASK	0x30
 | |
| #define CS4271_MODE1_DIV_1	0x00
 | |
| #define CS4271_MODE1_DIV_15	0x10
 | |
| #define CS4271_MODE1_DIV_2	0x20
 | |
| #define CS4271_MODE1_DIV_3	0x30
 | |
| 
 | |
| #define CS4271_MODE1_MASTER	0x08
 | |
| 
 | |
| #define CS4271_MODE1_DAC_DIF_MASK	0x07
 | |
| #define CS4271_MODE1_DAC_DIF_LJ		0x00
 | |
| #define CS4271_MODE1_DAC_DIF_I2S	0x01
 | |
| #define CS4271_MODE1_DAC_DIF_RJ16	0x02
 | |
| #define CS4271_MODE1_DAC_DIF_RJ24	0x03
 | |
| #define CS4271_MODE1_DAC_DIF_RJ20	0x04
 | |
| #define CS4271_MODE1_DAC_DIF_RJ18	0x05
 | |
| 
 | |
| #define CS4271_DACCTL_AMUTE	0x80
 | |
| #define CS4271_DACCTL_IF_SLOW	0x40
 | |
| 
 | |
| #define CS4271_DACCTL_DEM_MASK	0x30
 | |
| #define CS4271_DACCTL_DEM_DIS	0x00
 | |
| #define CS4271_DACCTL_DEM_441	0x10
 | |
| #define CS4271_DACCTL_DEM_48	0x20
 | |
| #define CS4271_DACCTL_DEM_32	0x30
 | |
| 
 | |
| #define CS4271_DACCTL_SVRU	0x08
 | |
| #define CS4271_DACCTL_SRD	0x04
 | |
| #define CS4271_DACCTL_INVA	0x02
 | |
| #define CS4271_DACCTL_INVB	0x01
 | |
| 
 | |
| #define CS4271_DACVOL_BEQUA	0x40
 | |
| #define CS4271_DACVOL_SOFT	0x20
 | |
| #define CS4271_DACVOL_ZEROC	0x10
 | |
| 
 | |
| #define CS4271_DACVOL_ATAPI_MASK	0x0F
 | |
| #define CS4271_DACVOL_ATAPI_M_M		0x00
 | |
| #define CS4271_DACVOL_ATAPI_M_BR	0x01
 | |
| #define CS4271_DACVOL_ATAPI_M_BL	0x02
 | |
| #define CS4271_DACVOL_ATAPI_M_BLR2	0x03
 | |
| #define CS4271_DACVOL_ATAPI_AR_M	0x04
 | |
| #define CS4271_DACVOL_ATAPI_AR_BR	0x05
 | |
| #define CS4271_DACVOL_ATAPI_AR_BL	0x06
 | |
| #define CS4271_DACVOL_ATAPI_AR_BLR2	0x07
 | |
| #define CS4271_DACVOL_ATAPI_AL_M	0x08
 | |
| #define CS4271_DACVOL_ATAPI_AL_BR	0x09
 | |
| #define CS4271_DACVOL_ATAPI_AL_BL	0x0A
 | |
| #define CS4271_DACVOL_ATAPI_AL_BLR2	0x0B
 | |
| #define CS4271_DACVOL_ATAPI_ALR2_M	0x0C
 | |
| #define CS4271_DACVOL_ATAPI_ALR2_BR	0x0D
 | |
| #define CS4271_DACVOL_ATAPI_ALR2_BL	0x0E
 | |
| #define CS4271_DACVOL_ATAPI_ALR2_BLR2	0x0F
 | |
| 
 | |
| #define CS4271_VOLA_MUTE	0x80
 | |
| #define CS4271_VOLA_VOL_MASK	0x7F
 | |
| #define CS4271_VOLB_MUTE	0x80
 | |
| #define CS4271_VOLB_VOL_MASK	0x7F
 | |
| 
 | |
| #define CS4271_ADCCTL_DITHER16	0x20
 | |
| 
 | |
| #define CS4271_ADCCTL_ADC_DIF_MASK	0x10
 | |
| #define CS4271_ADCCTL_ADC_DIF_LJ	0x00
 | |
| #define CS4271_ADCCTL_ADC_DIF_I2S	0x10
 | |
| 
 | |
| #define CS4271_ADCCTL_MUTEA	0x08
 | |
| #define CS4271_ADCCTL_MUTEB	0x04
 | |
| #define CS4271_ADCCTL_HPFDA	0x02
 | |
| #define CS4271_ADCCTL_HPFDB	0x01
 | |
| 
 | |
| #define CS4271_MODE2_LOOP	0x10
 | |
| #define CS4271_MODE2_MUTECAEQUB	0x08
 | |
| #define CS4271_MODE2_FREEZE	0x04
 | |
| #define CS4271_MODE2_CPEN	0x02
 | |
| #define CS4271_MODE2_PDN	0x01
 | |
| 
 | |
| #define CS4271_CHIPID_PART_MASK	0xF0
 | |
| #define CS4271_CHIPID_REV_MASK	0x0F
 | |
| 
 | |
| /*
 | |
|  * Default CS4271 power-up configuration
 | |
|  * Array contains non-existing in hw register at address 0
 | |
|  * Array do not include Chip ID, as codec driver does not use
 | |
|  * registers read operations at all
 | |
|  */
 | |
| static const struct reg_default cs4271_reg_defaults[] = {
 | |
| 	{ CS4271_MODE1,		0, },
 | |
| 	{ CS4271_DACCTL,	CS4271_DACCTL_AMUTE, },
 | |
| 	{ CS4271_DACVOL,	CS4271_DACVOL_SOFT | CS4271_DACVOL_ATAPI_AL_BR, },
 | |
| 	{ CS4271_VOLA,		0, },
 | |
| 	{ CS4271_VOLB,		0, },
 | |
| 	{ CS4271_ADCCTL,	0, },
 | |
| 	{ CS4271_MODE2,		0, },
 | |
| };
 | |
| 
 | |
| static bool cs4271_volatile_reg(struct device *dev, unsigned int reg)
 | |
| {
 | |
| 	return reg == CS4271_CHIPID;
 | |
| }
 | |
| 
 | |
| static const char * const supply_names[] = {
 | |
| 	"vd", "vl", "va"
 | |
| };
 | |
| 
 | |
| struct cs4271_private {
 | |
| 	unsigned int			mclk;
 | |
| 	bool				master;
 | |
| 	bool				deemph;
 | |
| 	struct regmap			*regmap;
 | |
| 	/* Current sample rate for de-emphasis control */
 | |
| 	int				rate;
 | |
| 	/* GPIO driving Reset pin, if any */
 | |
| 	struct gpio_desc		*reset;
 | |
| 	/* enable soft reset workaround */
 | |
| 	bool				enable_soft_reset;
 | |
| 	struct regulator_bulk_data      supplies[ARRAY_SIZE(supply_names)];
 | |
| };
 | |
| 
 | |
| static const struct snd_soc_dapm_widget cs4271_dapm_widgets[] = {
 | |
| SND_SOC_DAPM_INPUT("AINA"),
 | |
| SND_SOC_DAPM_INPUT("AINB"),
 | |
| 
 | |
| SND_SOC_DAPM_OUTPUT("AOUTA+"),
 | |
| SND_SOC_DAPM_OUTPUT("AOUTA-"),
 | |
| SND_SOC_DAPM_OUTPUT("AOUTB+"),
 | |
| SND_SOC_DAPM_OUTPUT("AOUTB-"),
 | |
| };
 | |
| 
 | |
| static const struct snd_soc_dapm_route cs4271_dapm_routes[] = {
 | |
| 	{ "Capture", NULL, "AINA" },
 | |
| 	{ "Capture", NULL, "AINB" },
 | |
| 
 | |
| 	{ "AOUTA+", NULL, "Playback" },
 | |
| 	{ "AOUTA-", NULL, "Playback" },
 | |
| 	{ "AOUTB+", NULL, "Playback" },
 | |
| 	{ "AOUTB-", NULL, "Playback" },
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * @freq is the desired MCLK rate
 | |
|  * MCLK rate should (c) be the sample rate, multiplied by one of the
 | |
|  * ratios listed in cs4271_mclk_fs_ratios table
 | |
|  */
 | |
| static int cs4271_set_dai_sysclk(struct snd_soc_dai *codec_dai,
 | |
| 				 int clk_id, unsigned int freq, int dir)
 | |
| {
 | |
| 	struct snd_soc_component *component = codec_dai->component;
 | |
| 	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
 | |
| 
 | |
| 	cs4271->mclk = freq;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int cs4271_set_dai_fmt(struct snd_soc_dai *codec_dai,
 | |
| 			      unsigned int format)
 | |
| {
 | |
| 	struct snd_soc_component *component = codec_dai->component;
 | |
| 	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
 | |
| 	unsigned int val = 0;
 | |
| 	int ret;
 | |
| 
 | |
| 	switch (format & SND_SOC_DAIFMT_MASTER_MASK) {
 | |
| 	case SND_SOC_DAIFMT_CBS_CFS:
 | |
| 		cs4271->master = false;
 | |
| 		break;
 | |
| 	case SND_SOC_DAIFMT_CBM_CFM:
 | |
| 		cs4271->master = true;
 | |
| 		val |= CS4271_MODE1_MASTER;
 | |
| 		break;
 | |
| 	default:
 | |
| 		dev_err(component->dev, "Invalid DAI format\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	switch (format & SND_SOC_DAIFMT_FORMAT_MASK) {
 | |
| 	case SND_SOC_DAIFMT_LEFT_J:
 | |
| 		val |= CS4271_MODE1_DAC_DIF_LJ;
 | |
| 		ret = regmap_update_bits(cs4271->regmap, CS4271_ADCCTL,
 | |
| 			CS4271_ADCCTL_ADC_DIF_MASK, CS4271_ADCCTL_ADC_DIF_LJ);
 | |
| 		if (ret < 0)
 | |
| 			return ret;
 | |
| 		break;
 | |
| 	case SND_SOC_DAIFMT_I2S:
 | |
| 		val |= CS4271_MODE1_DAC_DIF_I2S;
 | |
| 		ret = regmap_update_bits(cs4271->regmap, CS4271_ADCCTL,
 | |
| 			CS4271_ADCCTL_ADC_DIF_MASK, CS4271_ADCCTL_ADC_DIF_I2S);
 | |
| 		if (ret < 0)
 | |
| 			return ret;
 | |
| 		break;
 | |
| 	default:
 | |
| 		dev_err(component->dev, "Invalid DAI format\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE1,
 | |
| 		CS4271_MODE1_DAC_DIF_MASK | CS4271_MODE1_MASTER, val);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int cs4271_deemph[] = {0, 44100, 48000, 32000};
 | |
| 
 | |
| static int cs4271_set_deemph(struct snd_soc_component *component)
 | |
| {
 | |
| 	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
 | |
| 	int i, ret;
 | |
| 	int val = CS4271_DACCTL_DEM_DIS;
 | |
| 
 | |
| 	if (cs4271->deemph) {
 | |
| 		/* Find closest de-emphasis freq */
 | |
| 		val = 1;
 | |
| 		for (i = 2; i < ARRAY_SIZE(cs4271_deemph); i++)
 | |
| 			if (abs(cs4271_deemph[i] - cs4271->rate) <
 | |
| 			    abs(cs4271_deemph[val] - cs4271->rate))
 | |
| 				val = i;
 | |
| 		val <<= 4;
 | |
| 	}
 | |
| 
 | |
| 	ret = regmap_update_bits(cs4271->regmap, CS4271_DACCTL,
 | |
| 		CS4271_DACCTL_DEM_MASK, val);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int cs4271_get_deemph(struct snd_kcontrol *kcontrol,
 | |
| 			     struct snd_ctl_elem_value *ucontrol)
 | |
| {
 | |
| 	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 | |
| 	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
 | |
| 
 | |
| 	ucontrol->value.integer.value[0] = cs4271->deemph;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int cs4271_put_deemph(struct snd_kcontrol *kcontrol,
 | |
| 			     struct snd_ctl_elem_value *ucontrol)
 | |
| {
 | |
| 	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 | |
| 	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
 | |
| 
 | |
| 	cs4271->deemph = ucontrol->value.integer.value[0];
 | |
| 	return cs4271_set_deemph(component);
 | |
| }
 | |
| 
 | |
| struct cs4271_clk_cfg {
 | |
| 	bool		master;		/* codec mode */
 | |
| 	u8		speed_mode;	/* codec speed mode: 1x, 2x, 4x */
 | |
| 	unsigned short	ratio;		/* MCLK / sample rate */
 | |
| 	u8		ratio_mask;	/* ratio bit mask for Master mode */
 | |
| };
 | |
| 
 | |
| static struct cs4271_clk_cfg cs4271_clk_tab[] = {
 | |
| 	{1, CS4271_MODE1_MODE_1X, 256,  CS4271_MODE1_DIV_1},
 | |
| 	{1, CS4271_MODE1_MODE_1X, 384,  CS4271_MODE1_DIV_15},
 | |
| 	{1, CS4271_MODE1_MODE_1X, 512,  CS4271_MODE1_DIV_2},
 | |
| 	{1, CS4271_MODE1_MODE_1X, 768,  CS4271_MODE1_DIV_3},
 | |
| 	{1, CS4271_MODE1_MODE_2X, 128,  CS4271_MODE1_DIV_1},
 | |
| 	{1, CS4271_MODE1_MODE_2X, 192,  CS4271_MODE1_DIV_15},
 | |
| 	{1, CS4271_MODE1_MODE_2X, 256,  CS4271_MODE1_DIV_2},
 | |
| 	{1, CS4271_MODE1_MODE_2X, 384,  CS4271_MODE1_DIV_3},
 | |
| 	{1, CS4271_MODE1_MODE_4X, 64,   CS4271_MODE1_DIV_1},
 | |
| 	{1, CS4271_MODE1_MODE_4X, 96,   CS4271_MODE1_DIV_15},
 | |
| 	{1, CS4271_MODE1_MODE_4X, 128,  CS4271_MODE1_DIV_2},
 | |
| 	{1, CS4271_MODE1_MODE_4X, 192,  CS4271_MODE1_DIV_3},
 | |
| 	{0, CS4271_MODE1_MODE_1X, 256,  CS4271_MODE1_DIV_1},
 | |
| 	{0, CS4271_MODE1_MODE_1X, 384,  CS4271_MODE1_DIV_1},
 | |
| 	{0, CS4271_MODE1_MODE_1X, 512,  CS4271_MODE1_DIV_1},
 | |
| 	{0, CS4271_MODE1_MODE_1X, 768,  CS4271_MODE1_DIV_2},
 | |
| 	{0, CS4271_MODE1_MODE_1X, 1024, CS4271_MODE1_DIV_2},
 | |
| 	{0, CS4271_MODE1_MODE_2X, 128,  CS4271_MODE1_DIV_1},
 | |
| 	{0, CS4271_MODE1_MODE_2X, 192,  CS4271_MODE1_DIV_1},
 | |
| 	{0, CS4271_MODE1_MODE_2X, 256,  CS4271_MODE1_DIV_1},
 | |
| 	{0, CS4271_MODE1_MODE_2X, 384,  CS4271_MODE1_DIV_2},
 | |
| 	{0, CS4271_MODE1_MODE_2X, 512,  CS4271_MODE1_DIV_2},
 | |
| 	{0, CS4271_MODE1_MODE_4X, 64,   CS4271_MODE1_DIV_1},
 | |
| 	{0, CS4271_MODE1_MODE_4X, 96,   CS4271_MODE1_DIV_1},
 | |
| 	{0, CS4271_MODE1_MODE_4X, 128,  CS4271_MODE1_DIV_1},
 | |
| 	{0, CS4271_MODE1_MODE_4X, 192,  CS4271_MODE1_DIV_2},
 | |
| 	{0, CS4271_MODE1_MODE_4X, 256,  CS4271_MODE1_DIV_2},
 | |
| };
 | |
| 
 | |
| #define CS4271_NR_RATIOS ARRAY_SIZE(cs4271_clk_tab)
 | |
| 
 | |
| static int cs4271_hw_params(struct snd_pcm_substream *substream,
 | |
| 			    struct snd_pcm_hw_params *params,
 | |
| 			    struct snd_soc_dai *dai)
 | |
| {
 | |
| 	struct snd_soc_component *component = dai->component;
 | |
| 	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
 | |
| 	int i, ret;
 | |
| 	unsigned int ratio, val;
 | |
| 
 | |
| 	if (cs4271->enable_soft_reset) {
 | |
| 		/*
 | |
| 		 * Put the codec in soft reset and back again in case it's not
 | |
| 		 * currently streaming data. This way of bringing the codec in
 | |
| 		 * sync to the current clocks is not explicitly documented in
 | |
| 		 * the data sheet, but it seems to work fine, and in contrast
 | |
| 		 * to a read hardware reset, we don't have to sync back all
 | |
| 		 * registers every time.
 | |
| 		 */
 | |
| 
 | |
| 		if ((substream->stream == SNDRV_PCM_STREAM_PLAYBACK &&
 | |
| 		     !snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_CAPTURE)) ||
 | |
| 		    (substream->stream == SNDRV_PCM_STREAM_CAPTURE &&
 | |
| 		     !snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_PLAYBACK))) {
 | |
| 			ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
 | |
| 						 CS4271_MODE2_PDN,
 | |
| 						 CS4271_MODE2_PDN);
 | |
| 			if (ret < 0)
 | |
| 				return ret;
 | |
| 
 | |
| 			ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
 | |
| 						 CS4271_MODE2_PDN, 0);
 | |
| 			if (ret < 0)
 | |
| 				return ret;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	cs4271->rate = params_rate(params);
 | |
| 
 | |
| 	/* Configure DAC */
 | |
| 	if (cs4271->rate < 50000)
 | |
| 		val = CS4271_MODE1_MODE_1X;
 | |
| 	else if (cs4271->rate < 100000)
 | |
| 		val = CS4271_MODE1_MODE_2X;
 | |
| 	else
 | |
| 		val = CS4271_MODE1_MODE_4X;
 | |
| 
 | |
| 	ratio = cs4271->mclk / cs4271->rate;
 | |
| 	for (i = 0; i < CS4271_NR_RATIOS; i++)
 | |
| 		if ((cs4271_clk_tab[i].master == cs4271->master) &&
 | |
| 		    (cs4271_clk_tab[i].speed_mode == val) &&
 | |
| 		    (cs4271_clk_tab[i].ratio == ratio))
 | |
| 			break;
 | |
| 
 | |
| 	if (i == CS4271_NR_RATIOS) {
 | |
| 		dev_err(component->dev, "Invalid sample rate\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	val |= cs4271_clk_tab[i].ratio_mask;
 | |
| 
 | |
| 	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE1,
 | |
| 		CS4271_MODE1_MODE_MASK | CS4271_MODE1_DIV_MASK, val);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	return cs4271_set_deemph(component);
 | |
| }
 | |
| 
 | |
| static int cs4271_mute_stream(struct snd_soc_dai *dai, int mute, int stream)
 | |
| {
 | |
| 	struct snd_soc_component *component = dai->component;
 | |
| 	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
 | |
| 	int ret;
 | |
| 	int val_a = 0;
 | |
| 	int val_b = 0;
 | |
| 
 | |
| 	if (stream != SNDRV_PCM_STREAM_PLAYBACK)
 | |
| 		return 0;
 | |
| 
 | |
| 	if (mute) {
 | |
| 		val_a = CS4271_VOLA_MUTE;
 | |
| 		val_b = CS4271_VOLB_MUTE;
 | |
| 	}
 | |
| 
 | |
| 	ret = regmap_update_bits(cs4271->regmap, CS4271_VOLA,
 | |
| 				 CS4271_VOLA_MUTE, val_a);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	ret = regmap_update_bits(cs4271->regmap, CS4271_VOLB,
 | |
| 				 CS4271_VOLB_MUTE, val_b);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /* CS4271 controls */
 | |
| static DECLARE_TLV_DB_SCALE(cs4271_dac_tlv, -12700, 100, 0);
 | |
| 
 | |
| static const struct snd_kcontrol_new cs4271_snd_controls[] = {
 | |
| 	SOC_DOUBLE_R_TLV("Master Playback Volume", CS4271_VOLA, CS4271_VOLB,
 | |
| 		0, 0x7F, 1, cs4271_dac_tlv),
 | |
| 	SOC_SINGLE("Digital Loopback Switch", CS4271_MODE2, 4, 1, 0),
 | |
| 	SOC_SINGLE("Soft Ramp Switch", CS4271_DACVOL, 5, 1, 0),
 | |
| 	SOC_SINGLE("Zero Cross Switch", CS4271_DACVOL, 4, 1, 0),
 | |
| 	SOC_SINGLE_BOOL_EXT("De-emphasis Switch", 0,
 | |
| 		cs4271_get_deemph, cs4271_put_deemph),
 | |
| 	SOC_SINGLE("Auto-Mute Switch", CS4271_DACCTL, 7, 1, 0),
 | |
| 	SOC_SINGLE("Slow Roll Off Filter Switch", CS4271_DACCTL, 6, 1, 0),
 | |
| 	SOC_SINGLE("Soft Volume Ramp-Up Switch", CS4271_DACCTL, 3, 1, 0),
 | |
| 	SOC_SINGLE("Soft Ramp-Down Switch", CS4271_DACCTL, 2, 1, 0),
 | |
| 	SOC_SINGLE("Left Channel Inversion Switch", CS4271_DACCTL, 1, 1, 0),
 | |
| 	SOC_SINGLE("Right Channel Inversion Switch", CS4271_DACCTL, 0, 1, 0),
 | |
| 	SOC_DOUBLE("Master Capture Switch", CS4271_ADCCTL, 3, 2, 1, 1),
 | |
| 	SOC_SINGLE("Dither 16-Bit Data Switch", CS4271_ADCCTL, 5, 1, 0),
 | |
| 	SOC_DOUBLE("High Pass Filter Switch", CS4271_ADCCTL, 1, 0, 1, 1),
 | |
| 	SOC_DOUBLE_R("Master Playback Switch", CS4271_VOLA, CS4271_VOLB,
 | |
| 		7, 1, 1),
 | |
| };
 | |
| 
 | |
| static const struct snd_soc_dai_ops cs4271_dai_ops = {
 | |
| 	.hw_params	= cs4271_hw_params,
 | |
| 	.set_sysclk	= cs4271_set_dai_sysclk,
 | |
| 	.set_fmt	= cs4271_set_dai_fmt,
 | |
| 	.mute_stream	= cs4271_mute_stream,
 | |
| };
 | |
| 
 | |
| static struct snd_soc_dai_driver cs4271_dai = {
 | |
| 	.name = "cs4271-hifi",
 | |
| 	.playback = {
 | |
| 		.stream_name	= "Playback",
 | |
| 		.channels_min	= 2,
 | |
| 		.channels_max	= 2,
 | |
| 		.rates		= CS4271_PCM_RATES,
 | |
| 		.formats	= CS4271_PCM_FORMATS,
 | |
| 	},
 | |
| 	.capture = {
 | |
| 		.stream_name	= "Capture",
 | |
| 		.channels_min	= 2,
 | |
| 		.channels_max	= 2,
 | |
| 		.rates		= CS4271_PCM_RATES,
 | |
| 		.formats	= CS4271_PCM_FORMATS,
 | |
| 	},
 | |
| 	.ops = &cs4271_dai_ops,
 | |
| 	.symmetric_rate = 1,
 | |
| };
 | |
| 
 | |
| static int cs4271_reset(struct snd_soc_component *component)
 | |
| {
 | |
| 	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
 | |
| 
 | |
| 	gpiod_direction_output(cs4271->reset, 1);
 | |
| 	mdelay(1);
 | |
| 	gpiod_set_value(cs4271->reset, 0);
 | |
| 	mdelay(1);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| #ifdef CONFIG_PM
 | |
| static int cs4271_soc_suspend(struct snd_soc_component *component)
 | |
| {
 | |
| 	int ret;
 | |
| 	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
 | |
| 
 | |
| 	/* Set power-down bit */
 | |
| 	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
 | |
| 				 CS4271_MODE2_PDN, CS4271_MODE2_PDN);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	regcache_mark_dirty(cs4271->regmap);
 | |
| 	regulator_bulk_disable(ARRAY_SIZE(cs4271->supplies), cs4271->supplies);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int cs4271_soc_resume(struct snd_soc_component *component)
 | |
| {
 | |
| 	int ret;
 | |
| 	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
 | |
| 
 | |
| 	ret = regulator_bulk_enable(ARRAY_SIZE(cs4271->supplies),
 | |
| 				    cs4271->supplies);
 | |
| 	if (ret < 0) {
 | |
| 		dev_err(component->dev, "Failed to enable regulators: %d\n", ret);
 | |
| 		return ret;
 | |
| 	}
 | |
| 
 | |
| 	/* Do a proper reset after power up */
 | |
| 	cs4271_reset(component);
 | |
| 
 | |
| 	/* Restore codec state */
 | |
| 	ret = regcache_sync(cs4271->regmap);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	/* then disable the power-down bit */
 | |
| 	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
 | |
| 				 CS4271_MODE2_PDN, 0);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| #else
 | |
| #define cs4271_soc_suspend	NULL
 | |
| #define cs4271_soc_resume	NULL
 | |
| #endif /* CONFIG_PM */
 | |
| 
 | |
| #ifdef CONFIG_OF
 | |
| const struct of_device_id cs4271_dt_ids[] = {
 | |
| 	{ .compatible = "cirrus,cs4271", },
 | |
| 	{ }
 | |
| };
 | |
| MODULE_DEVICE_TABLE(of, cs4271_dt_ids);
 | |
| EXPORT_SYMBOL_GPL(cs4271_dt_ids);
 | |
| #endif
 | |
| 
 | |
| static int cs4271_component_probe(struct snd_soc_component *component)
 | |
| {
 | |
| 	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
 | |
| 	struct cs4271_platform_data *cs4271plat = component->dev->platform_data;
 | |
| 	int ret;
 | |
| 	bool amutec_eq_bmutec;
 | |
| 
 | |
| 	amutec_eq_bmutec = of_property_read_bool(component->dev->of_node,
 | |
| 						 "cirrus,amutec-eq-bmutec");
 | |
| 	cs4271->enable_soft_reset = of_property_read_bool(component->dev->of_node,
 | |
| 							  "cirrus,enable-soft-reset");
 | |
| 
 | |
| 	ret = regulator_bulk_enable(ARRAY_SIZE(cs4271->supplies),
 | |
| 				    cs4271->supplies);
 | |
| 	if (ret < 0) {
 | |
| 		dev_err(component->dev, "Failed to enable regulators: %d\n", ret);
 | |
| 		return ret;
 | |
| 	}
 | |
| 
 | |
| 	if (cs4271plat) {
 | |
| 		amutec_eq_bmutec = cs4271plat->amutec_eq_bmutec;
 | |
| 		cs4271->enable_soft_reset = cs4271plat->enable_soft_reset;
 | |
| 	}
 | |
| 
 | |
| 	/* Reset codec */
 | |
| 	cs4271_reset(component);
 | |
| 
 | |
| 	ret = regcache_sync(cs4271->regmap);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
 | |
| 				 CS4271_MODE2_PDN | CS4271_MODE2_CPEN,
 | |
| 				 CS4271_MODE2_PDN | CS4271_MODE2_CPEN);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
 | |
| 				 CS4271_MODE2_PDN, 0);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 	/* Power-up sequence requires 85 uS */
 | |
| 	udelay(85);
 | |
| 
 | |
| 	if (amutec_eq_bmutec)
 | |
| 		regmap_update_bits(cs4271->regmap, CS4271_MODE2,
 | |
| 				   CS4271_MODE2_MUTECAEQUB,
 | |
| 				   CS4271_MODE2_MUTECAEQUB);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void cs4271_component_remove(struct snd_soc_component *component)
 | |
| {
 | |
| 	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
 | |
| 
 | |
| 	/* Set codec to the reset state */
 | |
| 	gpiod_set_value(cs4271->reset, 1);
 | |
| 
 | |
| 	regcache_mark_dirty(cs4271->regmap);
 | |
| 	regulator_bulk_disable(ARRAY_SIZE(cs4271->supplies), cs4271->supplies);
 | |
| };
 | |
| 
 | |
| static const struct snd_soc_component_driver soc_component_dev_cs4271 = {
 | |
| 	.probe			= cs4271_component_probe,
 | |
| 	.remove			= cs4271_component_remove,
 | |
| 	.suspend		= cs4271_soc_suspend,
 | |
| 	.resume			= cs4271_soc_resume,
 | |
| 	.controls		= cs4271_snd_controls,
 | |
| 	.num_controls		= ARRAY_SIZE(cs4271_snd_controls),
 | |
| 	.dapm_widgets		= cs4271_dapm_widgets,
 | |
| 	.num_dapm_widgets	= ARRAY_SIZE(cs4271_dapm_widgets),
 | |
| 	.dapm_routes		= cs4271_dapm_routes,
 | |
| 	.num_dapm_routes	= ARRAY_SIZE(cs4271_dapm_routes),
 | |
| 	.idle_bias_on		= 1,
 | |
| 	.use_pmdown_time	= 1,
 | |
| 	.endianness		= 1,
 | |
| };
 | |
| 
 | |
| static int cs4271_common_probe(struct device *dev,
 | |
| 			       struct cs4271_private **c)
 | |
| {
 | |
| 	struct cs4271_private *cs4271;
 | |
| 	int i, ret;
 | |
| 
 | |
| 	cs4271 = devm_kzalloc(dev, sizeof(*cs4271), GFP_KERNEL);
 | |
| 	if (!cs4271)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	cs4271->reset = devm_gpiod_get_optional(dev, "reset", GPIOD_ASIS);
 | |
| 	if (IS_ERR(cs4271->reset))
 | |
| 		return dev_err_probe(dev, PTR_ERR(cs4271->reset),
 | |
| 				     "error retrieving RESET GPIO\n");
 | |
| 	gpiod_set_consumer_name(cs4271->reset, "CS4271 Reset");
 | |
| 
 | |
| 	for (i = 0; i < ARRAY_SIZE(supply_names); i++)
 | |
| 		cs4271->supplies[i].supply = supply_names[i];
 | |
| 
 | |
| 	ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(cs4271->supplies),
 | |
| 					cs4271->supplies);
 | |
| 
 | |
| 	if (ret < 0) {
 | |
| 		dev_err(dev, "Failed to get regulators: %d\n", ret);
 | |
| 		return ret;
 | |
| 	}
 | |
| 
 | |
| 	*c = cs4271;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| const struct regmap_config cs4271_regmap_config = {
 | |
| 	.max_register = CS4271_LASTREG,
 | |
| 
 | |
| 	.reg_defaults = cs4271_reg_defaults,
 | |
| 	.num_reg_defaults = ARRAY_SIZE(cs4271_reg_defaults),
 | |
| 	.cache_type = REGCACHE_FLAT,
 | |
| 	.val_bits = 8,
 | |
| 	.volatile_reg = cs4271_volatile_reg,
 | |
| };
 | |
| EXPORT_SYMBOL_GPL(cs4271_regmap_config);
 | |
| 
 | |
| int cs4271_probe(struct device *dev, struct regmap *regmap)
 | |
| {
 | |
| 	struct cs4271_private *cs4271;
 | |
| 	int ret;
 | |
| 
 | |
| 	if (IS_ERR(regmap))
 | |
| 		return PTR_ERR(regmap);
 | |
| 
 | |
| 	ret = cs4271_common_probe(dev, &cs4271);
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	dev_set_drvdata(dev, cs4271);
 | |
| 	cs4271->regmap = regmap;
 | |
| 
 | |
| 	return devm_snd_soc_register_component(dev, &soc_component_dev_cs4271,
 | |
| 					       &cs4271_dai, 1);
 | |
| }
 | |
| EXPORT_SYMBOL_GPL(cs4271_probe);
 | |
| 
 | |
| MODULE_AUTHOR("Alexander Sverdlin <subaparts@yandex.ru>");
 | |
| MODULE_DESCRIPTION("Cirrus Logic CS4271 ALSA SoC Codec Driver");
 | |
| MODULE_LICENSE("GPL");
 |