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