Linux Audio

Check our new training course

Loading...
v6.13.7
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * CS4271 ASoC codec driver
  4 *
  5 * Copyright (c) 2010 Alexander Sverdlin <subaparts@yandex.ru>
  6 *
  7 * This driver support CS4271 codec being master or slave, working
  8 * in control port mode, connected either via SPI or I2C.
  9 * The data format accepted is I2S or left-justified.
 10 * DAPM support not implemented.
 11 */
 12
 13#include <linux/module.h>
 14#include <linux/slab.h>
 15#include <linux/delay.h>
 16#include <linux/gpio/consumer.h>
 17#include <linux/of.h>
 
 
 18#include <linux/regulator/consumer.h>
 19#include <sound/pcm.h>
 20#include <sound/soc.h>
 21#include <sound/tlv.h>
 22#include <sound/cs4271.h>
 23#include "cs4271.h"
 24
 25#define CS4271_PCM_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \
 26			    SNDRV_PCM_FMTBIT_S24_LE | \
 27			    SNDRV_PCM_FMTBIT_S32_LE)
 28#define CS4271_PCM_RATES SNDRV_PCM_RATE_8000_192000
 29
 30/*
 31 * CS4271 registers
 32 */
 33#define CS4271_MODE1	0x01	/* Mode Control 1 */
 34#define CS4271_DACCTL	0x02	/* DAC Control */
 35#define CS4271_DACVOL	0x03	/* DAC Volume & Mixing Control */
 36#define CS4271_VOLA	0x04	/* DAC Channel A Volume Control */
 37#define CS4271_VOLB	0x05	/* DAC Channel B Volume Control */
 38#define CS4271_ADCCTL	0x06	/* ADC Control */
 39#define CS4271_MODE2	0x07	/* Mode Control 2 */
 40#define CS4271_CHIPID	0x08	/* Chip ID */
 41
 42#define CS4271_FIRSTREG	CS4271_MODE1
 43#define CS4271_LASTREG	CS4271_MODE2
 44#define CS4271_NR_REGS	((CS4271_LASTREG & 0xFF) + 1)
 45
 46/* Bit masks for the CS4271 registers */
 47#define CS4271_MODE1_MODE_MASK	0xC0
 48#define CS4271_MODE1_MODE_1X	0x00
 49#define CS4271_MODE1_MODE_2X	0x80
 50#define CS4271_MODE1_MODE_4X	0xC0
 51
 52#define CS4271_MODE1_DIV_MASK	0x30
 53#define CS4271_MODE1_DIV_1	0x00
 54#define CS4271_MODE1_DIV_15	0x10
 55#define CS4271_MODE1_DIV_2	0x20
 56#define CS4271_MODE1_DIV_3	0x30
 57
 58#define CS4271_MODE1_MASTER	0x08
 59
 60#define CS4271_MODE1_DAC_DIF_MASK	0x07
 61#define CS4271_MODE1_DAC_DIF_LJ		0x00
 62#define CS4271_MODE1_DAC_DIF_I2S	0x01
 63#define CS4271_MODE1_DAC_DIF_RJ16	0x02
 64#define CS4271_MODE1_DAC_DIF_RJ24	0x03
 65#define CS4271_MODE1_DAC_DIF_RJ20	0x04
 66#define CS4271_MODE1_DAC_DIF_RJ18	0x05
 67
 68#define CS4271_DACCTL_AMUTE	0x80
 69#define CS4271_DACCTL_IF_SLOW	0x40
 70
 71#define CS4271_DACCTL_DEM_MASK	0x30
 72#define CS4271_DACCTL_DEM_DIS	0x00
 73#define CS4271_DACCTL_DEM_441	0x10
 74#define CS4271_DACCTL_DEM_48	0x20
 75#define CS4271_DACCTL_DEM_32	0x30
 76
 77#define CS4271_DACCTL_SVRU	0x08
 78#define CS4271_DACCTL_SRD	0x04
 79#define CS4271_DACCTL_INVA	0x02
 80#define CS4271_DACCTL_INVB	0x01
 81
 82#define CS4271_DACVOL_BEQUA	0x40
 83#define CS4271_DACVOL_SOFT	0x20
 84#define CS4271_DACVOL_ZEROC	0x10
 85
 86#define CS4271_DACVOL_ATAPI_MASK	0x0F
 87#define CS4271_DACVOL_ATAPI_M_M		0x00
 88#define CS4271_DACVOL_ATAPI_M_BR	0x01
 89#define CS4271_DACVOL_ATAPI_M_BL	0x02
 90#define CS4271_DACVOL_ATAPI_M_BLR2	0x03
 91#define CS4271_DACVOL_ATAPI_AR_M	0x04
 92#define CS4271_DACVOL_ATAPI_AR_BR	0x05
 93#define CS4271_DACVOL_ATAPI_AR_BL	0x06
 94#define CS4271_DACVOL_ATAPI_AR_BLR2	0x07
 95#define CS4271_DACVOL_ATAPI_AL_M	0x08
 96#define CS4271_DACVOL_ATAPI_AL_BR	0x09
 97#define CS4271_DACVOL_ATAPI_AL_BL	0x0A
 98#define CS4271_DACVOL_ATAPI_AL_BLR2	0x0B
 99#define CS4271_DACVOL_ATAPI_ALR2_M	0x0C
100#define CS4271_DACVOL_ATAPI_ALR2_BR	0x0D
101#define CS4271_DACVOL_ATAPI_ALR2_BL	0x0E
102#define CS4271_DACVOL_ATAPI_ALR2_BLR2	0x0F
103
104#define CS4271_VOLA_MUTE	0x80
105#define CS4271_VOLA_VOL_MASK	0x7F
106#define CS4271_VOLB_MUTE	0x80
107#define CS4271_VOLB_VOL_MASK	0x7F
108
109#define CS4271_ADCCTL_DITHER16	0x20
110
111#define CS4271_ADCCTL_ADC_DIF_MASK	0x10
112#define CS4271_ADCCTL_ADC_DIF_LJ	0x00
113#define CS4271_ADCCTL_ADC_DIF_I2S	0x10
114
115#define CS4271_ADCCTL_MUTEA	0x08
116#define CS4271_ADCCTL_MUTEB	0x04
117#define CS4271_ADCCTL_HPFDA	0x02
118#define CS4271_ADCCTL_HPFDB	0x01
119
120#define CS4271_MODE2_LOOP	0x10
121#define CS4271_MODE2_MUTECAEQUB	0x08
122#define CS4271_MODE2_FREEZE	0x04
123#define CS4271_MODE2_CPEN	0x02
124#define CS4271_MODE2_PDN	0x01
125
126#define CS4271_CHIPID_PART_MASK	0xF0
127#define CS4271_CHIPID_REV_MASK	0x0F
128
129/*
130 * Default CS4271 power-up configuration
131 * Array contains non-existing in hw register at address 0
132 * Array do not include Chip ID, as codec driver does not use
133 * registers read operations at all
134 */
135static const struct reg_default cs4271_reg_defaults[] = {
136	{ CS4271_MODE1,		0, },
137	{ CS4271_DACCTL,	CS4271_DACCTL_AMUTE, },
138	{ CS4271_DACVOL,	CS4271_DACVOL_SOFT | CS4271_DACVOL_ATAPI_AL_BR, },
139	{ CS4271_VOLA,		0, },
140	{ CS4271_VOLB,		0, },
141	{ CS4271_ADCCTL,	0, },
142	{ CS4271_MODE2,		0, },
143};
144
145static bool cs4271_volatile_reg(struct device *dev, unsigned int reg)
146{
147	return reg == CS4271_CHIPID;
148}
149
150static const char * const supply_names[] = {
151	"vd", "vl", "va"
152};
153
154struct cs4271_private {
155	unsigned int			mclk;
156	bool				master;
157	bool				deemph;
158	struct regmap			*regmap;
159	/* Current sample rate for de-emphasis control */
160	int				rate;
161	/* GPIO driving Reset pin, if any */
162	struct gpio_desc		*reset;
 
 
163	/* enable soft reset workaround */
164	bool				enable_soft_reset;
165	struct regulator_bulk_data      supplies[ARRAY_SIZE(supply_names)];
166};
167
168static const struct snd_soc_dapm_widget cs4271_dapm_widgets[] = {
169SND_SOC_DAPM_INPUT("AINA"),
170SND_SOC_DAPM_INPUT("AINB"),
171
172SND_SOC_DAPM_OUTPUT("AOUTA+"),
173SND_SOC_DAPM_OUTPUT("AOUTA-"),
174SND_SOC_DAPM_OUTPUT("AOUTB+"),
175SND_SOC_DAPM_OUTPUT("AOUTB-"),
176};
177
178static const struct snd_soc_dapm_route cs4271_dapm_routes[] = {
179	{ "Capture", NULL, "AINA" },
180	{ "Capture", NULL, "AINB" },
181
182	{ "AOUTA+", NULL, "Playback" },
183	{ "AOUTA-", NULL, "Playback" },
184	{ "AOUTB+", NULL, "Playback" },
185	{ "AOUTB-", NULL, "Playback" },
186};
187
188/*
189 * @freq is the desired MCLK rate
190 * MCLK rate should (c) be the sample rate, multiplied by one of the
191 * ratios listed in cs4271_mclk_fs_ratios table
192 */
193static int cs4271_set_dai_sysclk(struct snd_soc_dai *codec_dai,
194				 int clk_id, unsigned int freq, int dir)
195{
196	struct snd_soc_component *component = codec_dai->component;
197	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
198
199	cs4271->mclk = freq;
200	return 0;
201}
202
203static int cs4271_set_dai_fmt(struct snd_soc_dai *codec_dai,
204			      unsigned int format)
205{
206	struct snd_soc_component *component = codec_dai->component;
207	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
208	unsigned int val = 0;
209	int ret;
210
211	switch (format & SND_SOC_DAIFMT_MASTER_MASK) {
212	case SND_SOC_DAIFMT_CBS_CFS:
213		cs4271->master = false;
214		break;
215	case SND_SOC_DAIFMT_CBM_CFM:
216		cs4271->master = true;
217		val |= CS4271_MODE1_MASTER;
218		break;
219	default:
220		dev_err(component->dev, "Invalid DAI format\n");
221		return -EINVAL;
222	}
223
224	switch (format & SND_SOC_DAIFMT_FORMAT_MASK) {
225	case SND_SOC_DAIFMT_LEFT_J:
226		val |= CS4271_MODE1_DAC_DIF_LJ;
227		ret = regmap_update_bits(cs4271->regmap, CS4271_ADCCTL,
228			CS4271_ADCCTL_ADC_DIF_MASK, CS4271_ADCCTL_ADC_DIF_LJ);
229		if (ret < 0)
230			return ret;
231		break;
232	case SND_SOC_DAIFMT_I2S:
233		val |= CS4271_MODE1_DAC_DIF_I2S;
234		ret = regmap_update_bits(cs4271->regmap, CS4271_ADCCTL,
235			CS4271_ADCCTL_ADC_DIF_MASK, CS4271_ADCCTL_ADC_DIF_I2S);
236		if (ret < 0)
237			return ret;
238		break;
239	default:
240		dev_err(component->dev, "Invalid DAI format\n");
241		return -EINVAL;
242	}
243
244	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE1,
245		CS4271_MODE1_DAC_DIF_MASK | CS4271_MODE1_MASTER, val);
246	if (ret < 0)
247		return ret;
248	return 0;
249}
250
251static int cs4271_deemph[] = {0, 44100, 48000, 32000};
252
253static int cs4271_set_deemph(struct snd_soc_component *component)
254{
255	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
256	int i, ret;
257	int val = CS4271_DACCTL_DEM_DIS;
258
259	if (cs4271->deemph) {
260		/* Find closest de-emphasis freq */
261		val = 1;
262		for (i = 2; i < ARRAY_SIZE(cs4271_deemph); i++)
263			if (abs(cs4271_deemph[i] - cs4271->rate) <
264			    abs(cs4271_deemph[val] - cs4271->rate))
265				val = i;
266		val <<= 4;
267	}
268
269	ret = regmap_update_bits(cs4271->regmap, CS4271_DACCTL,
270		CS4271_DACCTL_DEM_MASK, val);
271	if (ret < 0)
272		return ret;
273	return 0;
274}
275
276static int cs4271_get_deemph(struct snd_kcontrol *kcontrol,
277			     struct snd_ctl_elem_value *ucontrol)
278{
279	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
280	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
281
282	ucontrol->value.integer.value[0] = cs4271->deemph;
283	return 0;
284}
285
286static int cs4271_put_deemph(struct snd_kcontrol *kcontrol,
287			     struct snd_ctl_elem_value *ucontrol)
288{
289	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
290	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
291
292	cs4271->deemph = ucontrol->value.integer.value[0];
293	return cs4271_set_deemph(component);
294}
295
296struct cs4271_clk_cfg {
297	bool		master;		/* codec mode */
298	u8		speed_mode;	/* codec speed mode: 1x, 2x, 4x */
299	unsigned short	ratio;		/* MCLK / sample rate */
300	u8		ratio_mask;	/* ratio bit mask for Master mode */
301};
302
303static struct cs4271_clk_cfg cs4271_clk_tab[] = {
304	{1, CS4271_MODE1_MODE_1X, 256,  CS4271_MODE1_DIV_1},
305	{1, CS4271_MODE1_MODE_1X, 384,  CS4271_MODE1_DIV_15},
306	{1, CS4271_MODE1_MODE_1X, 512,  CS4271_MODE1_DIV_2},
307	{1, CS4271_MODE1_MODE_1X, 768,  CS4271_MODE1_DIV_3},
308	{1, CS4271_MODE1_MODE_2X, 128,  CS4271_MODE1_DIV_1},
309	{1, CS4271_MODE1_MODE_2X, 192,  CS4271_MODE1_DIV_15},
310	{1, CS4271_MODE1_MODE_2X, 256,  CS4271_MODE1_DIV_2},
311	{1, CS4271_MODE1_MODE_2X, 384,  CS4271_MODE1_DIV_3},
312	{1, CS4271_MODE1_MODE_4X, 64,   CS4271_MODE1_DIV_1},
313	{1, CS4271_MODE1_MODE_4X, 96,   CS4271_MODE1_DIV_15},
314	{1, CS4271_MODE1_MODE_4X, 128,  CS4271_MODE1_DIV_2},
315	{1, CS4271_MODE1_MODE_4X, 192,  CS4271_MODE1_DIV_3},
316	{0, CS4271_MODE1_MODE_1X, 256,  CS4271_MODE1_DIV_1},
317	{0, CS4271_MODE1_MODE_1X, 384,  CS4271_MODE1_DIV_1},
318	{0, CS4271_MODE1_MODE_1X, 512,  CS4271_MODE1_DIV_1},
319	{0, CS4271_MODE1_MODE_1X, 768,  CS4271_MODE1_DIV_2},
320	{0, CS4271_MODE1_MODE_1X, 1024, CS4271_MODE1_DIV_2},
321	{0, CS4271_MODE1_MODE_2X, 128,  CS4271_MODE1_DIV_1},
322	{0, CS4271_MODE1_MODE_2X, 192,  CS4271_MODE1_DIV_1},
323	{0, CS4271_MODE1_MODE_2X, 256,  CS4271_MODE1_DIV_1},
324	{0, CS4271_MODE1_MODE_2X, 384,  CS4271_MODE1_DIV_2},
325	{0, CS4271_MODE1_MODE_2X, 512,  CS4271_MODE1_DIV_2},
326	{0, CS4271_MODE1_MODE_4X, 64,   CS4271_MODE1_DIV_1},
327	{0, CS4271_MODE1_MODE_4X, 96,   CS4271_MODE1_DIV_1},
328	{0, CS4271_MODE1_MODE_4X, 128,  CS4271_MODE1_DIV_1},
329	{0, CS4271_MODE1_MODE_4X, 192,  CS4271_MODE1_DIV_2},
330	{0, CS4271_MODE1_MODE_4X, 256,  CS4271_MODE1_DIV_2},
331};
332
333#define CS4271_NR_RATIOS ARRAY_SIZE(cs4271_clk_tab)
334
335static int cs4271_hw_params(struct snd_pcm_substream *substream,
336			    struct snd_pcm_hw_params *params,
337			    struct snd_soc_dai *dai)
338{
339	struct snd_soc_component *component = dai->component;
340	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
341	int i, ret;
342	unsigned int ratio, val;
343
344	if (cs4271->enable_soft_reset) {
345		/*
346		 * Put the codec in soft reset and back again in case it's not
347		 * currently streaming data. This way of bringing the codec in
348		 * sync to the current clocks is not explicitly documented in
349		 * the data sheet, but it seems to work fine, and in contrast
350		 * to a read hardware reset, we don't have to sync back all
351		 * registers every time.
352		 */
353
354		if ((substream->stream == SNDRV_PCM_STREAM_PLAYBACK &&
355		     !snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_CAPTURE)) ||
356		    (substream->stream == SNDRV_PCM_STREAM_CAPTURE &&
357		     !snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_PLAYBACK))) {
358			ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
359						 CS4271_MODE2_PDN,
360						 CS4271_MODE2_PDN);
361			if (ret < 0)
362				return ret;
363
364			ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
365						 CS4271_MODE2_PDN, 0);
366			if (ret < 0)
367				return ret;
368		}
369	}
370
371	cs4271->rate = params_rate(params);
372
373	/* Configure DAC */
374	if (cs4271->rate < 50000)
375		val = CS4271_MODE1_MODE_1X;
376	else if (cs4271->rate < 100000)
377		val = CS4271_MODE1_MODE_2X;
378	else
379		val = CS4271_MODE1_MODE_4X;
380
381	ratio = cs4271->mclk / cs4271->rate;
382	for (i = 0; i < CS4271_NR_RATIOS; i++)
383		if ((cs4271_clk_tab[i].master == cs4271->master) &&
384		    (cs4271_clk_tab[i].speed_mode == val) &&
385		    (cs4271_clk_tab[i].ratio == ratio))
386			break;
387
388	if (i == CS4271_NR_RATIOS) {
389		dev_err(component->dev, "Invalid sample rate\n");
390		return -EINVAL;
391	}
392
393	val |= cs4271_clk_tab[i].ratio_mask;
394
395	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE1,
396		CS4271_MODE1_MODE_MASK | CS4271_MODE1_DIV_MASK, val);
397	if (ret < 0)
398		return ret;
399
400	return cs4271_set_deemph(component);
401}
402
403static int cs4271_mute_stream(struct snd_soc_dai *dai, int mute, int stream)
404{
405	struct snd_soc_component *component = dai->component;
406	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
407	int ret;
408	int val_a = 0;
409	int val_b = 0;
410
411	if (stream != SNDRV_PCM_STREAM_PLAYBACK)
412		return 0;
413
414	if (mute) {
415		val_a = CS4271_VOLA_MUTE;
416		val_b = CS4271_VOLB_MUTE;
417	}
418
419	ret = regmap_update_bits(cs4271->regmap, CS4271_VOLA,
420				 CS4271_VOLA_MUTE, val_a);
421	if (ret < 0)
422		return ret;
423
424	ret = regmap_update_bits(cs4271->regmap, CS4271_VOLB,
425				 CS4271_VOLB_MUTE, val_b);
426	if (ret < 0)
427		return ret;
428
429	return 0;
430}
431
432/* CS4271 controls */
433static DECLARE_TLV_DB_SCALE(cs4271_dac_tlv, -12700, 100, 0);
434
435static const struct snd_kcontrol_new cs4271_snd_controls[] = {
436	SOC_DOUBLE_R_TLV("Master Playback Volume", CS4271_VOLA, CS4271_VOLB,
437		0, 0x7F, 1, cs4271_dac_tlv),
438	SOC_SINGLE("Digital Loopback Switch", CS4271_MODE2, 4, 1, 0),
439	SOC_SINGLE("Soft Ramp Switch", CS4271_DACVOL, 5, 1, 0),
440	SOC_SINGLE("Zero Cross Switch", CS4271_DACVOL, 4, 1, 0),
441	SOC_SINGLE_BOOL_EXT("De-emphasis Switch", 0,
442		cs4271_get_deemph, cs4271_put_deemph),
443	SOC_SINGLE("Auto-Mute Switch", CS4271_DACCTL, 7, 1, 0),
444	SOC_SINGLE("Slow Roll Off Filter Switch", CS4271_DACCTL, 6, 1, 0),
445	SOC_SINGLE("Soft Volume Ramp-Up Switch", CS4271_DACCTL, 3, 1, 0),
446	SOC_SINGLE("Soft Ramp-Down Switch", CS4271_DACCTL, 2, 1, 0),
447	SOC_SINGLE("Left Channel Inversion Switch", CS4271_DACCTL, 1, 1, 0),
448	SOC_SINGLE("Right Channel Inversion Switch", CS4271_DACCTL, 0, 1, 0),
449	SOC_DOUBLE("Master Capture Switch", CS4271_ADCCTL, 3, 2, 1, 1),
450	SOC_SINGLE("Dither 16-Bit Data Switch", CS4271_ADCCTL, 5, 1, 0),
451	SOC_DOUBLE("High Pass Filter Switch", CS4271_ADCCTL, 1, 0, 1, 1),
452	SOC_DOUBLE_R("Master Playback Switch", CS4271_VOLA, CS4271_VOLB,
453		7, 1, 1),
454};
455
456static const struct snd_soc_dai_ops cs4271_dai_ops = {
457	.hw_params	= cs4271_hw_params,
458	.set_sysclk	= cs4271_set_dai_sysclk,
459	.set_fmt	= cs4271_set_dai_fmt,
460	.mute_stream	= cs4271_mute_stream,
461};
462
463static struct snd_soc_dai_driver cs4271_dai = {
464	.name = "cs4271-hifi",
465	.playback = {
466		.stream_name	= "Playback",
467		.channels_min	= 2,
468		.channels_max	= 2,
469		.rates		= CS4271_PCM_RATES,
470		.formats	= CS4271_PCM_FORMATS,
471	},
472	.capture = {
473		.stream_name	= "Capture",
474		.channels_min	= 2,
475		.channels_max	= 2,
476		.rates		= CS4271_PCM_RATES,
477		.formats	= CS4271_PCM_FORMATS,
478	},
479	.ops = &cs4271_dai_ops,
480	.symmetric_rate = 1,
481};
482
483static int cs4271_reset(struct snd_soc_component *component)
484{
485	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
486
487	gpiod_direction_output(cs4271->reset, 1);
488	mdelay(1);
489	gpiod_set_value(cs4271->reset, 0);
490	mdelay(1);
 
 
491
492	return 0;
493}
494
495#ifdef CONFIG_PM
496static int cs4271_soc_suspend(struct snd_soc_component *component)
497{
498	int ret;
499	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
500
501	/* Set power-down bit */
502	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
503				 CS4271_MODE2_PDN, CS4271_MODE2_PDN);
504	if (ret < 0)
505		return ret;
506
507	regcache_mark_dirty(cs4271->regmap);
508	regulator_bulk_disable(ARRAY_SIZE(cs4271->supplies), cs4271->supplies);
509
510	return 0;
511}
512
513static int cs4271_soc_resume(struct snd_soc_component *component)
514{
515	int ret;
516	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
517
518	ret = regulator_bulk_enable(ARRAY_SIZE(cs4271->supplies),
519				    cs4271->supplies);
520	if (ret < 0) {
521		dev_err(component->dev, "Failed to enable regulators: %d\n", ret);
522		return ret;
523	}
524
525	/* Do a proper reset after power up */
526	cs4271_reset(component);
527
528	/* Restore codec state */
529	ret = regcache_sync(cs4271->regmap);
530	if (ret < 0)
531		return ret;
532
533	/* then disable the power-down bit */
534	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
535				 CS4271_MODE2_PDN, 0);
536	if (ret < 0)
537		return ret;
538
539	return 0;
540}
541#else
542#define cs4271_soc_suspend	NULL
543#define cs4271_soc_resume	NULL
544#endif /* CONFIG_PM */
545
546#ifdef CONFIG_OF
547const struct of_device_id cs4271_dt_ids[] = {
548	{ .compatible = "cirrus,cs4271", },
549	{ }
550};
551MODULE_DEVICE_TABLE(of, cs4271_dt_ids);
552EXPORT_SYMBOL_GPL(cs4271_dt_ids);
553#endif
554
555static int cs4271_component_probe(struct snd_soc_component *component)
556{
557	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
558	struct cs4271_platform_data *cs4271plat = component->dev->platform_data;
559	int ret;
560	bool amutec_eq_bmutec;
561
562	amutec_eq_bmutec = of_property_read_bool(component->dev->of_node,
563						 "cirrus,amutec-eq-bmutec");
564	cs4271->enable_soft_reset = of_property_read_bool(component->dev->of_node,
565							  "cirrus,enable-soft-reset");
 
 
 
 
 
 
 
566
567	ret = regulator_bulk_enable(ARRAY_SIZE(cs4271->supplies),
568				    cs4271->supplies);
569	if (ret < 0) {
570		dev_err(component->dev, "Failed to enable regulators: %d\n", ret);
571		return ret;
572	}
573
574	if (cs4271plat) {
575		amutec_eq_bmutec = cs4271plat->amutec_eq_bmutec;
576		cs4271->enable_soft_reset = cs4271plat->enable_soft_reset;
577	}
578
579	/* Reset codec */
580	cs4271_reset(component);
581
582	ret = regcache_sync(cs4271->regmap);
583	if (ret < 0)
584		return ret;
585
586	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
587				 CS4271_MODE2_PDN | CS4271_MODE2_CPEN,
588				 CS4271_MODE2_PDN | CS4271_MODE2_CPEN);
589	if (ret < 0)
590		return ret;
591	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
592				 CS4271_MODE2_PDN, 0);
593	if (ret < 0)
594		return ret;
595	/* Power-up sequence requires 85 uS */
596	udelay(85);
597
598	if (amutec_eq_bmutec)
599		regmap_update_bits(cs4271->regmap, CS4271_MODE2,
600				   CS4271_MODE2_MUTECAEQUB,
601				   CS4271_MODE2_MUTECAEQUB);
602
603	return 0;
604}
605
606static void cs4271_component_remove(struct snd_soc_component *component)
607{
608	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
609
610	/* Set codec to the reset state */
611	gpiod_set_value(cs4271->reset, 1);
 
612
613	regcache_mark_dirty(cs4271->regmap);
614	regulator_bulk_disable(ARRAY_SIZE(cs4271->supplies), cs4271->supplies);
615};
616
617static const struct snd_soc_component_driver soc_component_dev_cs4271 = {
618	.probe			= cs4271_component_probe,
619	.remove			= cs4271_component_remove,
620	.suspend		= cs4271_soc_suspend,
621	.resume			= cs4271_soc_resume,
622	.controls		= cs4271_snd_controls,
623	.num_controls		= ARRAY_SIZE(cs4271_snd_controls),
624	.dapm_widgets		= cs4271_dapm_widgets,
625	.num_dapm_widgets	= ARRAY_SIZE(cs4271_dapm_widgets),
626	.dapm_routes		= cs4271_dapm_routes,
627	.num_dapm_routes	= ARRAY_SIZE(cs4271_dapm_routes),
628	.idle_bias_on		= 1,
629	.use_pmdown_time	= 1,
630	.endianness		= 1,
631};
632
633static int cs4271_common_probe(struct device *dev,
634			       struct cs4271_private **c)
635{
 
636	struct cs4271_private *cs4271;
637	int i, ret;
638
639	cs4271 = devm_kzalloc(dev, sizeof(*cs4271), GFP_KERNEL);
640	if (!cs4271)
641		return -ENOMEM;
642
643	cs4271->reset = devm_gpiod_get_optional(dev, "reset", GPIOD_ASIS);
644	if (IS_ERR(cs4271->reset))
645		return dev_err_probe(dev, PTR_ERR(cs4271->reset),
646				     "error retrieving RESET GPIO\n");
647	gpiod_set_consumer_name(cs4271->reset, "CS4271 Reset");
 
 
 
 
 
 
 
 
648
649	for (i = 0; i < ARRAY_SIZE(supply_names); i++)
650		cs4271->supplies[i].supply = supply_names[i];
651
652	ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(cs4271->supplies),
653					cs4271->supplies);
654
655	if (ret < 0) {
656		dev_err(dev, "Failed to get regulators: %d\n", ret);
657		return ret;
658	}
659
660	*c = cs4271;
661	return 0;
662}
663
664const struct regmap_config cs4271_regmap_config = {
665	.max_register = CS4271_LASTREG,
666
667	.reg_defaults = cs4271_reg_defaults,
668	.num_reg_defaults = ARRAY_SIZE(cs4271_reg_defaults),
669	.cache_type = REGCACHE_FLAT,
670	.val_bits = 8,
671	.volatile_reg = cs4271_volatile_reg,
672};
673EXPORT_SYMBOL_GPL(cs4271_regmap_config);
674
675int cs4271_probe(struct device *dev, struct regmap *regmap)
676{
677	struct cs4271_private *cs4271;
678	int ret;
679
680	if (IS_ERR(regmap))
681		return PTR_ERR(regmap);
682
683	ret = cs4271_common_probe(dev, &cs4271);
684	if (ret < 0)
685		return ret;
686
687	dev_set_drvdata(dev, cs4271);
688	cs4271->regmap = regmap;
689
690	return devm_snd_soc_register_component(dev, &soc_component_dev_cs4271,
691					       &cs4271_dai, 1);
692}
693EXPORT_SYMBOL_GPL(cs4271_probe);
694
695MODULE_AUTHOR("Alexander Sverdlin <subaparts@yandex.ru>");
696MODULE_DESCRIPTION("Cirrus Logic CS4271 ALSA SoC Codec Driver");
697MODULE_LICENSE("GPL");
v6.2
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * CS4271 ASoC codec driver
  4 *
  5 * Copyright (c) 2010 Alexander Sverdlin <subaparts@yandex.ru>
  6 *
  7 * This driver support CS4271 codec being master or slave, working
  8 * in control port mode, connected either via SPI or I2C.
  9 * The data format accepted is I2S or left-justified.
 10 * DAPM support not implemented.
 11 */
 12
 13#include <linux/module.h>
 14#include <linux/slab.h>
 15#include <linux/delay.h>
 16#include <linux/gpio.h>
 17#include <linux/of.h>
 18#include <linux/of_device.h>
 19#include <linux/of_gpio.h>
 20#include <linux/regulator/consumer.h>
 21#include <sound/pcm.h>
 22#include <sound/soc.h>
 23#include <sound/tlv.h>
 24#include <sound/cs4271.h>
 25#include "cs4271.h"
 26
 27#define CS4271_PCM_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \
 28			    SNDRV_PCM_FMTBIT_S24_LE | \
 29			    SNDRV_PCM_FMTBIT_S32_LE)
 30#define CS4271_PCM_RATES SNDRV_PCM_RATE_8000_192000
 31
 32/*
 33 * CS4271 registers
 34 */
 35#define CS4271_MODE1	0x01	/* Mode Control 1 */
 36#define CS4271_DACCTL	0x02	/* DAC Control */
 37#define CS4271_DACVOL	0x03	/* DAC Volume & Mixing Control */
 38#define CS4271_VOLA	0x04	/* DAC Channel A Volume Control */
 39#define CS4271_VOLB	0x05	/* DAC Channel B Volume Control */
 40#define CS4271_ADCCTL	0x06	/* ADC Control */
 41#define CS4271_MODE2	0x07	/* Mode Control 2 */
 42#define CS4271_CHIPID	0x08	/* Chip ID */
 43
 44#define CS4271_FIRSTREG	CS4271_MODE1
 45#define CS4271_LASTREG	CS4271_MODE2
 46#define CS4271_NR_REGS	((CS4271_LASTREG & 0xFF) + 1)
 47
 48/* Bit masks for the CS4271 registers */
 49#define CS4271_MODE1_MODE_MASK	0xC0
 50#define CS4271_MODE1_MODE_1X	0x00
 51#define CS4271_MODE1_MODE_2X	0x80
 52#define CS4271_MODE1_MODE_4X	0xC0
 53
 54#define CS4271_MODE1_DIV_MASK	0x30
 55#define CS4271_MODE1_DIV_1	0x00
 56#define CS4271_MODE1_DIV_15	0x10
 57#define CS4271_MODE1_DIV_2	0x20
 58#define CS4271_MODE1_DIV_3	0x30
 59
 60#define CS4271_MODE1_MASTER	0x08
 61
 62#define CS4271_MODE1_DAC_DIF_MASK	0x07
 63#define CS4271_MODE1_DAC_DIF_LJ		0x00
 64#define CS4271_MODE1_DAC_DIF_I2S	0x01
 65#define CS4271_MODE1_DAC_DIF_RJ16	0x02
 66#define CS4271_MODE1_DAC_DIF_RJ24	0x03
 67#define CS4271_MODE1_DAC_DIF_RJ20	0x04
 68#define CS4271_MODE1_DAC_DIF_RJ18	0x05
 69
 70#define CS4271_DACCTL_AMUTE	0x80
 71#define CS4271_DACCTL_IF_SLOW	0x40
 72
 73#define CS4271_DACCTL_DEM_MASK	0x30
 74#define CS4271_DACCTL_DEM_DIS	0x00
 75#define CS4271_DACCTL_DEM_441	0x10
 76#define CS4271_DACCTL_DEM_48	0x20
 77#define CS4271_DACCTL_DEM_32	0x30
 78
 79#define CS4271_DACCTL_SVRU	0x08
 80#define CS4271_DACCTL_SRD	0x04
 81#define CS4271_DACCTL_INVA	0x02
 82#define CS4271_DACCTL_INVB	0x01
 83
 84#define CS4271_DACVOL_BEQUA	0x40
 85#define CS4271_DACVOL_SOFT	0x20
 86#define CS4271_DACVOL_ZEROC	0x10
 87
 88#define CS4271_DACVOL_ATAPI_MASK	0x0F
 89#define CS4271_DACVOL_ATAPI_M_M		0x00
 90#define CS4271_DACVOL_ATAPI_M_BR	0x01
 91#define CS4271_DACVOL_ATAPI_M_BL	0x02
 92#define CS4271_DACVOL_ATAPI_M_BLR2	0x03
 93#define CS4271_DACVOL_ATAPI_AR_M	0x04
 94#define CS4271_DACVOL_ATAPI_AR_BR	0x05
 95#define CS4271_DACVOL_ATAPI_AR_BL	0x06
 96#define CS4271_DACVOL_ATAPI_AR_BLR2	0x07
 97#define CS4271_DACVOL_ATAPI_AL_M	0x08
 98#define CS4271_DACVOL_ATAPI_AL_BR	0x09
 99#define CS4271_DACVOL_ATAPI_AL_BL	0x0A
100#define CS4271_DACVOL_ATAPI_AL_BLR2	0x0B
101#define CS4271_DACVOL_ATAPI_ALR2_M	0x0C
102#define CS4271_DACVOL_ATAPI_ALR2_BR	0x0D
103#define CS4271_DACVOL_ATAPI_ALR2_BL	0x0E
104#define CS4271_DACVOL_ATAPI_ALR2_BLR2	0x0F
105
106#define CS4271_VOLA_MUTE	0x80
107#define CS4271_VOLA_VOL_MASK	0x7F
108#define CS4271_VOLB_MUTE	0x80
109#define CS4271_VOLB_VOL_MASK	0x7F
110
111#define CS4271_ADCCTL_DITHER16	0x20
112
113#define CS4271_ADCCTL_ADC_DIF_MASK	0x10
114#define CS4271_ADCCTL_ADC_DIF_LJ	0x00
115#define CS4271_ADCCTL_ADC_DIF_I2S	0x10
116
117#define CS4271_ADCCTL_MUTEA	0x08
118#define CS4271_ADCCTL_MUTEB	0x04
119#define CS4271_ADCCTL_HPFDA	0x02
120#define CS4271_ADCCTL_HPFDB	0x01
121
122#define CS4271_MODE2_LOOP	0x10
123#define CS4271_MODE2_MUTECAEQUB	0x08
124#define CS4271_MODE2_FREEZE	0x04
125#define CS4271_MODE2_CPEN	0x02
126#define CS4271_MODE2_PDN	0x01
127
128#define CS4271_CHIPID_PART_MASK	0xF0
129#define CS4271_CHIPID_REV_MASK	0x0F
130
131/*
132 * Default CS4271 power-up configuration
133 * Array contains non-existing in hw register at address 0
134 * Array do not include Chip ID, as codec driver does not use
135 * registers read operations at all
136 */
137static const struct reg_default cs4271_reg_defaults[] = {
138	{ CS4271_MODE1,		0, },
139	{ CS4271_DACCTL,	CS4271_DACCTL_AMUTE, },
140	{ CS4271_DACVOL,	CS4271_DACVOL_SOFT | CS4271_DACVOL_ATAPI_AL_BR, },
141	{ CS4271_VOLA,		0, },
142	{ CS4271_VOLB,		0, },
143	{ CS4271_ADCCTL,	0, },
144	{ CS4271_MODE2,		0, },
145};
146
147static bool cs4271_volatile_reg(struct device *dev, unsigned int reg)
148{
149	return reg == CS4271_CHIPID;
150}
151
152static const char * const supply_names[] = {
153	"vd", "vl", "va"
154};
155
156struct cs4271_private {
157	unsigned int			mclk;
158	bool				master;
159	bool				deemph;
160	struct regmap			*regmap;
161	/* Current sample rate for de-emphasis control */
162	int				rate;
163	/* GPIO driving Reset pin, if any */
164	int				gpio_nreset;
165	/* GPIO that disable serial bus, if any */
166	int				gpio_disable;
167	/* enable soft reset workaround */
168	bool				enable_soft_reset;
169	struct regulator_bulk_data      supplies[ARRAY_SIZE(supply_names)];
170};
171
172static const struct snd_soc_dapm_widget cs4271_dapm_widgets[] = {
173SND_SOC_DAPM_INPUT("AINA"),
174SND_SOC_DAPM_INPUT("AINB"),
175
176SND_SOC_DAPM_OUTPUT("AOUTA+"),
177SND_SOC_DAPM_OUTPUT("AOUTA-"),
178SND_SOC_DAPM_OUTPUT("AOUTB+"),
179SND_SOC_DAPM_OUTPUT("AOUTB-"),
180};
181
182static const struct snd_soc_dapm_route cs4271_dapm_routes[] = {
183	{ "Capture", NULL, "AINA" },
184	{ "Capture", NULL, "AINB" },
185
186	{ "AOUTA+", NULL, "Playback" },
187	{ "AOUTA-", NULL, "Playback" },
188	{ "AOUTB+", NULL, "Playback" },
189	{ "AOUTB-", NULL, "Playback" },
190};
191
192/*
193 * @freq is the desired MCLK rate
194 * MCLK rate should (c) be the sample rate, multiplied by one of the
195 * ratios listed in cs4271_mclk_fs_ratios table
196 */
197static int cs4271_set_dai_sysclk(struct snd_soc_dai *codec_dai,
198				 int clk_id, unsigned int freq, int dir)
199{
200	struct snd_soc_component *component = codec_dai->component;
201	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
202
203	cs4271->mclk = freq;
204	return 0;
205}
206
207static int cs4271_set_dai_fmt(struct snd_soc_dai *codec_dai,
208			      unsigned int format)
209{
210	struct snd_soc_component *component = codec_dai->component;
211	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
212	unsigned int val = 0;
213	int ret;
214
215	switch (format & SND_SOC_DAIFMT_MASTER_MASK) {
216	case SND_SOC_DAIFMT_CBS_CFS:
217		cs4271->master = false;
218		break;
219	case SND_SOC_DAIFMT_CBM_CFM:
220		cs4271->master = true;
221		val |= CS4271_MODE1_MASTER;
222		break;
223	default:
224		dev_err(component->dev, "Invalid DAI format\n");
225		return -EINVAL;
226	}
227
228	switch (format & SND_SOC_DAIFMT_FORMAT_MASK) {
229	case SND_SOC_DAIFMT_LEFT_J:
230		val |= CS4271_MODE1_DAC_DIF_LJ;
231		ret = regmap_update_bits(cs4271->regmap, CS4271_ADCCTL,
232			CS4271_ADCCTL_ADC_DIF_MASK, CS4271_ADCCTL_ADC_DIF_LJ);
233		if (ret < 0)
234			return ret;
235		break;
236	case SND_SOC_DAIFMT_I2S:
237		val |= CS4271_MODE1_DAC_DIF_I2S;
238		ret = regmap_update_bits(cs4271->regmap, CS4271_ADCCTL,
239			CS4271_ADCCTL_ADC_DIF_MASK, CS4271_ADCCTL_ADC_DIF_I2S);
240		if (ret < 0)
241			return ret;
242		break;
243	default:
244		dev_err(component->dev, "Invalid DAI format\n");
245		return -EINVAL;
246	}
247
248	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE1,
249		CS4271_MODE1_DAC_DIF_MASK | CS4271_MODE1_MASTER, val);
250	if (ret < 0)
251		return ret;
252	return 0;
253}
254
255static int cs4271_deemph[] = {0, 44100, 48000, 32000};
256
257static int cs4271_set_deemph(struct snd_soc_component *component)
258{
259	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
260	int i, ret;
261	int val = CS4271_DACCTL_DEM_DIS;
262
263	if (cs4271->deemph) {
264		/* Find closest de-emphasis freq */
265		val = 1;
266		for (i = 2; i < ARRAY_SIZE(cs4271_deemph); i++)
267			if (abs(cs4271_deemph[i] - cs4271->rate) <
268			    abs(cs4271_deemph[val] - cs4271->rate))
269				val = i;
270		val <<= 4;
271	}
272
273	ret = regmap_update_bits(cs4271->regmap, CS4271_DACCTL,
274		CS4271_DACCTL_DEM_MASK, val);
275	if (ret < 0)
276		return ret;
277	return 0;
278}
279
280static int cs4271_get_deemph(struct snd_kcontrol *kcontrol,
281			     struct snd_ctl_elem_value *ucontrol)
282{
283	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
284	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
285
286	ucontrol->value.integer.value[0] = cs4271->deemph;
287	return 0;
288}
289
290static int cs4271_put_deemph(struct snd_kcontrol *kcontrol,
291			     struct snd_ctl_elem_value *ucontrol)
292{
293	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
294	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
295
296	cs4271->deemph = ucontrol->value.integer.value[0];
297	return cs4271_set_deemph(component);
298}
299
300struct cs4271_clk_cfg {
301	bool		master;		/* codec mode */
302	u8		speed_mode;	/* codec speed mode: 1x, 2x, 4x */
303	unsigned short	ratio;		/* MCLK / sample rate */
304	u8		ratio_mask;	/* ratio bit mask for Master mode */
305};
306
307static struct cs4271_clk_cfg cs4271_clk_tab[] = {
308	{1, CS4271_MODE1_MODE_1X, 256,  CS4271_MODE1_DIV_1},
309	{1, CS4271_MODE1_MODE_1X, 384,  CS4271_MODE1_DIV_15},
310	{1, CS4271_MODE1_MODE_1X, 512,  CS4271_MODE1_DIV_2},
311	{1, CS4271_MODE1_MODE_1X, 768,  CS4271_MODE1_DIV_3},
312	{1, CS4271_MODE1_MODE_2X, 128,  CS4271_MODE1_DIV_1},
313	{1, CS4271_MODE1_MODE_2X, 192,  CS4271_MODE1_DIV_15},
314	{1, CS4271_MODE1_MODE_2X, 256,  CS4271_MODE1_DIV_2},
315	{1, CS4271_MODE1_MODE_2X, 384,  CS4271_MODE1_DIV_3},
316	{1, CS4271_MODE1_MODE_4X, 64,   CS4271_MODE1_DIV_1},
317	{1, CS4271_MODE1_MODE_4X, 96,   CS4271_MODE1_DIV_15},
318	{1, CS4271_MODE1_MODE_4X, 128,  CS4271_MODE1_DIV_2},
319	{1, CS4271_MODE1_MODE_4X, 192,  CS4271_MODE1_DIV_3},
320	{0, CS4271_MODE1_MODE_1X, 256,  CS4271_MODE1_DIV_1},
321	{0, CS4271_MODE1_MODE_1X, 384,  CS4271_MODE1_DIV_1},
322	{0, CS4271_MODE1_MODE_1X, 512,  CS4271_MODE1_DIV_1},
323	{0, CS4271_MODE1_MODE_1X, 768,  CS4271_MODE1_DIV_2},
324	{0, CS4271_MODE1_MODE_1X, 1024, CS4271_MODE1_DIV_2},
325	{0, CS4271_MODE1_MODE_2X, 128,  CS4271_MODE1_DIV_1},
326	{0, CS4271_MODE1_MODE_2X, 192,  CS4271_MODE1_DIV_1},
327	{0, CS4271_MODE1_MODE_2X, 256,  CS4271_MODE1_DIV_1},
328	{0, CS4271_MODE1_MODE_2X, 384,  CS4271_MODE1_DIV_2},
329	{0, CS4271_MODE1_MODE_2X, 512,  CS4271_MODE1_DIV_2},
330	{0, CS4271_MODE1_MODE_4X, 64,   CS4271_MODE1_DIV_1},
331	{0, CS4271_MODE1_MODE_4X, 96,   CS4271_MODE1_DIV_1},
332	{0, CS4271_MODE1_MODE_4X, 128,  CS4271_MODE1_DIV_1},
333	{0, CS4271_MODE1_MODE_4X, 192,  CS4271_MODE1_DIV_2},
334	{0, CS4271_MODE1_MODE_4X, 256,  CS4271_MODE1_DIV_2},
335};
336
337#define CS4271_NR_RATIOS ARRAY_SIZE(cs4271_clk_tab)
338
339static int cs4271_hw_params(struct snd_pcm_substream *substream,
340			    struct snd_pcm_hw_params *params,
341			    struct snd_soc_dai *dai)
342{
343	struct snd_soc_component *component = dai->component;
344	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
345	int i, ret;
346	unsigned int ratio, val;
347
348	if (cs4271->enable_soft_reset) {
349		/*
350		 * Put the codec in soft reset and back again in case it's not
351		 * currently streaming data. This way of bringing the codec in
352		 * sync to the current clocks is not explicitly documented in
353		 * the data sheet, but it seems to work fine, and in contrast
354		 * to a read hardware reset, we don't have to sync back all
355		 * registers every time.
356		 */
357
358		if ((substream->stream == SNDRV_PCM_STREAM_PLAYBACK &&
359		     !snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_CAPTURE)) ||
360		    (substream->stream == SNDRV_PCM_STREAM_CAPTURE &&
361		     !snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_PLAYBACK))) {
362			ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
363						 CS4271_MODE2_PDN,
364						 CS4271_MODE2_PDN);
365			if (ret < 0)
366				return ret;
367
368			ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
369						 CS4271_MODE2_PDN, 0);
370			if (ret < 0)
371				return ret;
372		}
373	}
374
375	cs4271->rate = params_rate(params);
376
377	/* Configure DAC */
378	if (cs4271->rate < 50000)
379		val = CS4271_MODE1_MODE_1X;
380	else if (cs4271->rate < 100000)
381		val = CS4271_MODE1_MODE_2X;
382	else
383		val = CS4271_MODE1_MODE_4X;
384
385	ratio = cs4271->mclk / cs4271->rate;
386	for (i = 0; i < CS4271_NR_RATIOS; i++)
387		if ((cs4271_clk_tab[i].master == cs4271->master) &&
388		    (cs4271_clk_tab[i].speed_mode == val) &&
389		    (cs4271_clk_tab[i].ratio == ratio))
390			break;
391
392	if (i == CS4271_NR_RATIOS) {
393		dev_err(component->dev, "Invalid sample rate\n");
394		return -EINVAL;
395	}
396
397	val |= cs4271_clk_tab[i].ratio_mask;
398
399	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE1,
400		CS4271_MODE1_MODE_MASK | CS4271_MODE1_DIV_MASK, val);
401	if (ret < 0)
402		return ret;
403
404	return cs4271_set_deemph(component);
405}
406
407static int cs4271_mute_stream(struct snd_soc_dai *dai, int mute, int stream)
408{
409	struct snd_soc_component *component = dai->component;
410	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
411	int ret;
412	int val_a = 0;
413	int val_b = 0;
414
415	if (stream != SNDRV_PCM_STREAM_PLAYBACK)
416		return 0;
417
418	if (mute) {
419		val_a = CS4271_VOLA_MUTE;
420		val_b = CS4271_VOLB_MUTE;
421	}
422
423	ret = regmap_update_bits(cs4271->regmap, CS4271_VOLA,
424				 CS4271_VOLA_MUTE, val_a);
425	if (ret < 0)
426		return ret;
427
428	ret = regmap_update_bits(cs4271->regmap, CS4271_VOLB,
429				 CS4271_VOLB_MUTE, val_b);
430	if (ret < 0)
431		return ret;
432
433	return 0;
434}
435
436/* CS4271 controls */
437static DECLARE_TLV_DB_SCALE(cs4271_dac_tlv, -12700, 100, 0);
438
439static const struct snd_kcontrol_new cs4271_snd_controls[] = {
440	SOC_DOUBLE_R_TLV("Master Playback Volume", CS4271_VOLA, CS4271_VOLB,
441		0, 0x7F, 1, cs4271_dac_tlv),
442	SOC_SINGLE("Digital Loopback Switch", CS4271_MODE2, 4, 1, 0),
443	SOC_SINGLE("Soft Ramp Switch", CS4271_DACVOL, 5, 1, 0),
444	SOC_SINGLE("Zero Cross Switch", CS4271_DACVOL, 4, 1, 0),
445	SOC_SINGLE_BOOL_EXT("De-emphasis Switch", 0,
446		cs4271_get_deemph, cs4271_put_deemph),
447	SOC_SINGLE("Auto-Mute Switch", CS4271_DACCTL, 7, 1, 0),
448	SOC_SINGLE("Slow Roll Off Filter Switch", CS4271_DACCTL, 6, 1, 0),
449	SOC_SINGLE("Soft Volume Ramp-Up Switch", CS4271_DACCTL, 3, 1, 0),
450	SOC_SINGLE("Soft Ramp-Down Switch", CS4271_DACCTL, 2, 1, 0),
451	SOC_SINGLE("Left Channel Inversion Switch", CS4271_DACCTL, 1, 1, 0),
452	SOC_SINGLE("Right Channel Inversion Switch", CS4271_DACCTL, 0, 1, 0),
453	SOC_DOUBLE("Master Capture Switch", CS4271_ADCCTL, 3, 2, 1, 1),
454	SOC_SINGLE("Dither 16-Bit Data Switch", CS4271_ADCCTL, 5, 1, 0),
455	SOC_DOUBLE("High Pass Filter Switch", CS4271_ADCCTL, 1, 0, 1, 1),
456	SOC_DOUBLE_R("Master Playback Switch", CS4271_VOLA, CS4271_VOLB,
457		7, 1, 1),
458};
459
460static const struct snd_soc_dai_ops cs4271_dai_ops = {
461	.hw_params	= cs4271_hw_params,
462	.set_sysclk	= cs4271_set_dai_sysclk,
463	.set_fmt	= cs4271_set_dai_fmt,
464	.mute_stream	= cs4271_mute_stream,
465};
466
467static struct snd_soc_dai_driver cs4271_dai = {
468	.name = "cs4271-hifi",
469	.playback = {
470		.stream_name	= "Playback",
471		.channels_min	= 2,
472		.channels_max	= 2,
473		.rates		= CS4271_PCM_RATES,
474		.formats	= CS4271_PCM_FORMATS,
475	},
476	.capture = {
477		.stream_name	= "Capture",
478		.channels_min	= 2,
479		.channels_max	= 2,
480		.rates		= CS4271_PCM_RATES,
481		.formats	= CS4271_PCM_FORMATS,
482	},
483	.ops = &cs4271_dai_ops,
484	.symmetric_rate = 1,
485};
486
487static int cs4271_reset(struct snd_soc_component *component)
488{
489	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
490
491	if (gpio_is_valid(cs4271->gpio_nreset)) {
492		gpio_direction_output(cs4271->gpio_nreset, 0);
493		mdelay(1);
494		gpio_set_value(cs4271->gpio_nreset, 1);
495		mdelay(1);
496	}
497
498	return 0;
499}
500
501#ifdef CONFIG_PM
502static int cs4271_soc_suspend(struct snd_soc_component *component)
503{
504	int ret;
505	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
506
507	/* Set power-down bit */
508	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
509				 CS4271_MODE2_PDN, CS4271_MODE2_PDN);
510	if (ret < 0)
511		return ret;
512
513	regcache_mark_dirty(cs4271->regmap);
514	regulator_bulk_disable(ARRAY_SIZE(cs4271->supplies), cs4271->supplies);
515
516	return 0;
517}
518
519static int cs4271_soc_resume(struct snd_soc_component *component)
520{
521	int ret;
522	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
523
524	ret = regulator_bulk_enable(ARRAY_SIZE(cs4271->supplies),
525				    cs4271->supplies);
526	if (ret < 0) {
527		dev_err(component->dev, "Failed to enable regulators: %d\n", ret);
528		return ret;
529	}
530
531	/* Do a proper reset after power up */
532	cs4271_reset(component);
533
534	/* Restore codec state */
535	ret = regcache_sync(cs4271->regmap);
536	if (ret < 0)
537		return ret;
538
539	/* then disable the power-down bit */
540	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
541				 CS4271_MODE2_PDN, 0);
542	if (ret < 0)
543		return ret;
544
545	return 0;
546}
547#else
548#define cs4271_soc_suspend	NULL
549#define cs4271_soc_resume	NULL
550#endif /* CONFIG_PM */
551
552#ifdef CONFIG_OF
553const struct of_device_id cs4271_dt_ids[] = {
554	{ .compatible = "cirrus,cs4271", },
555	{ }
556};
557MODULE_DEVICE_TABLE(of, cs4271_dt_ids);
558EXPORT_SYMBOL_GPL(cs4271_dt_ids);
559#endif
560
561static int cs4271_component_probe(struct snd_soc_component *component)
562{
563	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
564	struct cs4271_platform_data *cs4271plat = component->dev->platform_data;
565	int ret;
566	bool amutec_eq_bmutec = false;
567
568#ifdef CONFIG_OF
569	if (of_match_device(cs4271_dt_ids, component->dev)) {
570		if (of_get_property(component->dev->of_node,
571				     "cirrus,amutec-eq-bmutec", NULL))
572			amutec_eq_bmutec = true;
573
574		if (of_get_property(component->dev->of_node,
575				     "cirrus,enable-soft-reset", NULL))
576			cs4271->enable_soft_reset = true;
577	}
578#endif
579
580	ret = regulator_bulk_enable(ARRAY_SIZE(cs4271->supplies),
581				    cs4271->supplies);
582	if (ret < 0) {
583		dev_err(component->dev, "Failed to enable regulators: %d\n", ret);
584		return ret;
585	}
586
587	if (cs4271plat) {
588		amutec_eq_bmutec = cs4271plat->amutec_eq_bmutec;
589		cs4271->enable_soft_reset = cs4271plat->enable_soft_reset;
590	}
591
592	/* Reset codec */
593	cs4271_reset(component);
594
595	ret = regcache_sync(cs4271->regmap);
596	if (ret < 0)
597		return ret;
598
599	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
600				 CS4271_MODE2_PDN | CS4271_MODE2_CPEN,
601				 CS4271_MODE2_PDN | CS4271_MODE2_CPEN);
602	if (ret < 0)
603		return ret;
604	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
605				 CS4271_MODE2_PDN, 0);
606	if (ret < 0)
607		return ret;
608	/* Power-up sequence requires 85 uS */
609	udelay(85);
610
611	if (amutec_eq_bmutec)
612		regmap_update_bits(cs4271->regmap, CS4271_MODE2,
613				   CS4271_MODE2_MUTECAEQUB,
614				   CS4271_MODE2_MUTECAEQUB);
615
616	return 0;
617}
618
619static void cs4271_component_remove(struct snd_soc_component *component)
620{
621	struct cs4271_private *cs4271 = snd_soc_component_get_drvdata(component);
622
623	if (gpio_is_valid(cs4271->gpio_nreset))
624		/* Set codec to the reset state */
625		gpio_set_value(cs4271->gpio_nreset, 0);
626
627	regcache_mark_dirty(cs4271->regmap);
628	regulator_bulk_disable(ARRAY_SIZE(cs4271->supplies), cs4271->supplies);
629};
630
631static const struct snd_soc_component_driver soc_component_dev_cs4271 = {
632	.probe			= cs4271_component_probe,
633	.remove			= cs4271_component_remove,
634	.suspend		= cs4271_soc_suspend,
635	.resume			= cs4271_soc_resume,
636	.controls		= cs4271_snd_controls,
637	.num_controls		= ARRAY_SIZE(cs4271_snd_controls),
638	.dapm_widgets		= cs4271_dapm_widgets,
639	.num_dapm_widgets	= ARRAY_SIZE(cs4271_dapm_widgets),
640	.dapm_routes		= cs4271_dapm_routes,
641	.num_dapm_routes	= ARRAY_SIZE(cs4271_dapm_routes),
642	.idle_bias_on		= 1,
643	.use_pmdown_time	= 1,
644	.endianness		= 1,
645};
646
647static int cs4271_common_probe(struct device *dev,
648			       struct cs4271_private **c)
649{
650	struct cs4271_platform_data *cs4271plat = dev->platform_data;
651	struct cs4271_private *cs4271;
652	int i, ret;
653
654	cs4271 = devm_kzalloc(dev, sizeof(*cs4271), GFP_KERNEL);
655	if (!cs4271)
656		return -ENOMEM;
657
658	if (of_match_device(cs4271_dt_ids, dev))
659		cs4271->gpio_nreset =
660			of_get_named_gpio(dev->of_node, "reset-gpio", 0);
661
662	if (cs4271plat)
663		cs4271->gpio_nreset = cs4271plat->gpio_nreset;
664
665	if (gpio_is_valid(cs4271->gpio_nreset)) {
666		ret = devm_gpio_request(dev, cs4271->gpio_nreset,
667					"CS4271 Reset");
668		if (ret < 0)
669			return ret;
670	}
671
672	for (i = 0; i < ARRAY_SIZE(supply_names); i++)
673		cs4271->supplies[i].supply = supply_names[i];
674
675	ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(cs4271->supplies),
676					cs4271->supplies);
677
678	if (ret < 0) {
679		dev_err(dev, "Failed to get regulators: %d\n", ret);
680		return ret;
681	}
682
683	*c = cs4271;
684	return 0;
685}
686
687const struct regmap_config cs4271_regmap_config = {
688	.max_register = CS4271_LASTREG,
689
690	.reg_defaults = cs4271_reg_defaults,
691	.num_reg_defaults = ARRAY_SIZE(cs4271_reg_defaults),
692	.cache_type = REGCACHE_RBTREE,
693
694	.volatile_reg = cs4271_volatile_reg,
695};
696EXPORT_SYMBOL_GPL(cs4271_regmap_config);
697
698int cs4271_probe(struct device *dev, struct regmap *regmap)
699{
700	struct cs4271_private *cs4271;
701	int ret;
702
703	if (IS_ERR(regmap))
704		return PTR_ERR(regmap);
705
706	ret = cs4271_common_probe(dev, &cs4271);
707	if (ret < 0)
708		return ret;
709
710	dev_set_drvdata(dev, cs4271);
711	cs4271->regmap = regmap;
712
713	return devm_snd_soc_register_component(dev, &soc_component_dev_cs4271,
714					       &cs4271_dai, 1);
715}
716EXPORT_SYMBOL_GPL(cs4271_probe);
717
718MODULE_AUTHOR("Alexander Sverdlin <subaparts@yandex.ru>");
719MODULE_DESCRIPTION("Cirrus Logic CS4271 ALSA SoC Codec Driver");
720MODULE_LICENSE("GPL");