xref: /openbmc/linux/sound/soc/codecs/cs4271.c (revision d3597236)
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/of.h>
27 #include <linux/of_device.h>
28 #include <linux/of_gpio.h>
29 #include <sound/pcm.h>
30 #include <sound/soc.h>
31 #include <sound/tlv.h>
32 #include <sound/cs4271.h>
33 #include "cs4271.h"
34 
35 #define CS4271_PCM_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \
36 			    SNDRV_PCM_FMTBIT_S24_LE | \
37 			    SNDRV_PCM_FMTBIT_S32_LE)
38 #define CS4271_PCM_RATES SNDRV_PCM_RATE_8000_192000
39 
40 /*
41  * CS4271 registers
42  */
43 #define CS4271_MODE1	0x01	/* Mode Control 1 */
44 #define CS4271_DACCTL	0x02	/* DAC Control */
45 #define CS4271_DACVOL	0x03	/* DAC Volume & Mixing Control */
46 #define CS4271_VOLA	0x04	/* DAC Channel A Volume Control */
47 #define CS4271_VOLB	0x05	/* DAC Channel B Volume Control */
48 #define CS4271_ADCCTL	0x06	/* ADC Control */
49 #define CS4271_MODE2	0x07	/* Mode Control 2 */
50 #define CS4271_CHIPID	0x08	/* Chip ID */
51 
52 #define CS4271_FIRSTREG	CS4271_MODE1
53 #define CS4271_LASTREG	CS4271_MODE2
54 #define CS4271_NR_REGS	((CS4271_LASTREG & 0xFF) + 1)
55 
56 /* Bit masks for the CS4271 registers */
57 #define CS4271_MODE1_MODE_MASK	0xC0
58 #define CS4271_MODE1_MODE_1X	0x00
59 #define CS4271_MODE1_MODE_2X	0x80
60 #define CS4271_MODE1_MODE_4X	0xC0
61 
62 #define CS4271_MODE1_DIV_MASK	0x30
63 #define CS4271_MODE1_DIV_1	0x00
64 #define CS4271_MODE1_DIV_15	0x10
65 #define CS4271_MODE1_DIV_2	0x20
66 #define CS4271_MODE1_DIV_3	0x30
67 
68 #define CS4271_MODE1_MASTER	0x08
69 
70 #define CS4271_MODE1_DAC_DIF_MASK	0x07
71 #define CS4271_MODE1_DAC_DIF_LJ		0x00
72 #define CS4271_MODE1_DAC_DIF_I2S	0x01
73 #define CS4271_MODE1_DAC_DIF_RJ16	0x02
74 #define CS4271_MODE1_DAC_DIF_RJ24	0x03
75 #define CS4271_MODE1_DAC_DIF_RJ20	0x04
76 #define CS4271_MODE1_DAC_DIF_RJ18	0x05
77 
78 #define CS4271_DACCTL_AMUTE	0x80
79 #define CS4271_DACCTL_IF_SLOW	0x40
80 
81 #define CS4271_DACCTL_DEM_MASK	0x30
82 #define CS4271_DACCTL_DEM_DIS	0x00
83 #define CS4271_DACCTL_DEM_441	0x10
84 #define CS4271_DACCTL_DEM_48	0x20
85 #define CS4271_DACCTL_DEM_32	0x30
86 
87 #define CS4271_DACCTL_SVRU	0x08
88 #define CS4271_DACCTL_SRD	0x04
89 #define CS4271_DACCTL_INVA	0x02
90 #define CS4271_DACCTL_INVB	0x01
91 
92 #define CS4271_DACVOL_BEQUA	0x40
93 #define CS4271_DACVOL_SOFT	0x20
94 #define CS4271_DACVOL_ZEROC	0x10
95 
96 #define CS4271_DACVOL_ATAPI_MASK	0x0F
97 #define CS4271_DACVOL_ATAPI_M_M		0x00
98 #define CS4271_DACVOL_ATAPI_M_BR	0x01
99 #define CS4271_DACVOL_ATAPI_M_BL	0x02
100 #define CS4271_DACVOL_ATAPI_M_BLR2	0x03
101 #define CS4271_DACVOL_ATAPI_AR_M	0x04
102 #define CS4271_DACVOL_ATAPI_AR_BR	0x05
103 #define CS4271_DACVOL_ATAPI_AR_BL	0x06
104 #define CS4271_DACVOL_ATAPI_AR_BLR2	0x07
105 #define CS4271_DACVOL_ATAPI_AL_M	0x08
106 #define CS4271_DACVOL_ATAPI_AL_BR	0x09
107 #define CS4271_DACVOL_ATAPI_AL_BL	0x0A
108 #define CS4271_DACVOL_ATAPI_AL_BLR2	0x0B
109 #define CS4271_DACVOL_ATAPI_ALR2_M	0x0C
110 #define CS4271_DACVOL_ATAPI_ALR2_BR	0x0D
111 #define CS4271_DACVOL_ATAPI_ALR2_BL	0x0E
112 #define CS4271_DACVOL_ATAPI_ALR2_BLR2	0x0F
113 
114 #define CS4271_VOLA_MUTE	0x80
115 #define CS4271_VOLA_VOL_MASK	0x7F
116 #define CS4271_VOLB_MUTE	0x80
117 #define CS4271_VOLB_VOL_MASK	0x7F
118 
119 #define CS4271_ADCCTL_DITHER16	0x20
120 
121 #define CS4271_ADCCTL_ADC_DIF_MASK	0x10
122 #define CS4271_ADCCTL_ADC_DIF_LJ	0x00
123 #define CS4271_ADCCTL_ADC_DIF_I2S	0x10
124 
125 #define CS4271_ADCCTL_MUTEA	0x08
126 #define CS4271_ADCCTL_MUTEB	0x04
127 #define CS4271_ADCCTL_HPFDA	0x02
128 #define CS4271_ADCCTL_HPFDB	0x01
129 
130 #define CS4271_MODE2_LOOP	0x10
131 #define CS4271_MODE2_MUTECAEQUB	0x08
132 #define CS4271_MODE2_FREEZE	0x04
133 #define CS4271_MODE2_CPEN	0x02
134 #define CS4271_MODE2_PDN	0x01
135 
136 #define CS4271_CHIPID_PART_MASK	0xF0
137 #define CS4271_CHIPID_REV_MASK	0x0F
138 
139 /*
140  * Default CS4271 power-up configuration
141  * Array contains non-existing in hw register at address 0
142  * Array do not include Chip ID, as codec driver does not use
143  * registers read operations at all
144  */
145 static const struct reg_default cs4271_reg_defaults[] = {
146 	{ CS4271_MODE1,		0, },
147 	{ CS4271_DACCTL,	CS4271_DACCTL_AMUTE, },
148 	{ CS4271_DACVOL,	CS4271_DACVOL_SOFT | CS4271_DACVOL_ATAPI_AL_BR, },
149 	{ CS4271_VOLA,		0, },
150 	{ CS4271_VOLB,		0, },
151 	{ CS4271_ADCCTL,	0, },
152 	{ CS4271_MODE2,		0, },
153 };
154 
155 static bool cs4271_volatile_reg(struct device *dev, unsigned int reg)
156 {
157 	return reg == CS4271_CHIPID;
158 }
159 
160 struct cs4271_private {
161 	unsigned int			mclk;
162 	bool				master;
163 	bool				deemph;
164 	struct regmap			*regmap;
165 	/* Current sample rate for de-emphasis control */
166 	int				rate;
167 	/* GPIO driving Reset pin, if any */
168 	int				gpio_nreset;
169 	/* GPIO that disable serial bus, if any */
170 	int				gpio_disable;
171 	/* enable soft reset workaround */
172 	bool				enable_soft_reset;
173 };
174 
175 static const struct snd_soc_dapm_widget cs4271_dapm_widgets[] = {
176 SND_SOC_DAPM_INPUT("AINA"),
177 SND_SOC_DAPM_INPUT("AINB"),
178 
179 SND_SOC_DAPM_OUTPUT("AOUTA+"),
180 SND_SOC_DAPM_OUTPUT("AOUTA-"),
181 SND_SOC_DAPM_OUTPUT("AOUTB+"),
182 SND_SOC_DAPM_OUTPUT("AOUTB-"),
183 };
184 
185 static const struct snd_soc_dapm_route cs4271_dapm_routes[] = {
186 	{ "Capture", NULL, "AINA" },
187 	{ "Capture", NULL, "AINB" },
188 
189 	{ "AOUTA+", NULL, "Playback" },
190 	{ "AOUTA-", NULL, "Playback" },
191 	{ "AOUTB+", NULL, "Playback" },
192 	{ "AOUTB-", NULL, "Playback" },
193 };
194 
195 /*
196  * @freq is the desired MCLK rate
197  * MCLK rate should (c) be the sample rate, multiplied by one of the
198  * ratios listed in cs4271_mclk_fs_ratios table
199  */
200 static int cs4271_set_dai_sysclk(struct snd_soc_dai *codec_dai,
201 				 int clk_id, unsigned int freq, int dir)
202 {
203 	struct snd_soc_codec *codec = codec_dai->codec;
204 	struct cs4271_private *cs4271 = snd_soc_codec_get_drvdata(codec);
205 
206 	cs4271->mclk = freq;
207 	return 0;
208 }
209 
210 static int cs4271_set_dai_fmt(struct snd_soc_dai *codec_dai,
211 			      unsigned int format)
212 {
213 	struct snd_soc_codec *codec = codec_dai->codec;
214 	struct cs4271_private *cs4271 = snd_soc_codec_get_drvdata(codec);
215 	unsigned int val = 0;
216 	int ret;
217 
218 	switch (format & SND_SOC_DAIFMT_MASTER_MASK) {
219 	case SND_SOC_DAIFMT_CBS_CFS:
220 		cs4271->master = 0;
221 		break;
222 	case SND_SOC_DAIFMT_CBM_CFM:
223 		cs4271->master = 1;
224 		val |= CS4271_MODE1_MASTER;
225 		break;
226 	default:
227 		dev_err(codec->dev, "Invalid DAI format\n");
228 		return -EINVAL;
229 	}
230 
231 	switch (format & SND_SOC_DAIFMT_FORMAT_MASK) {
232 	case SND_SOC_DAIFMT_LEFT_J:
233 		val |= CS4271_MODE1_DAC_DIF_LJ;
234 		ret = regmap_update_bits(cs4271->regmap, CS4271_ADCCTL,
235 			CS4271_ADCCTL_ADC_DIF_MASK, CS4271_ADCCTL_ADC_DIF_LJ);
236 		if (ret < 0)
237 			return ret;
238 		break;
239 	case SND_SOC_DAIFMT_I2S:
240 		val |= CS4271_MODE1_DAC_DIF_I2S;
241 		ret = regmap_update_bits(cs4271->regmap, CS4271_ADCCTL,
242 			CS4271_ADCCTL_ADC_DIF_MASK, CS4271_ADCCTL_ADC_DIF_I2S);
243 		if (ret < 0)
244 			return ret;
245 		break;
246 	default:
247 		dev_err(codec->dev, "Invalid DAI format\n");
248 		return -EINVAL;
249 	}
250 
251 	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE1,
252 		CS4271_MODE1_DAC_DIF_MASK | CS4271_MODE1_MASTER, val);
253 	if (ret < 0)
254 		return ret;
255 	return 0;
256 }
257 
258 static int cs4271_deemph[] = {0, 44100, 48000, 32000};
259 
260 static int cs4271_set_deemph(struct snd_soc_codec *codec)
261 {
262 	struct cs4271_private *cs4271 = snd_soc_codec_get_drvdata(codec);
263 	int i, ret;
264 	int val = CS4271_DACCTL_DEM_DIS;
265 
266 	if (cs4271->deemph) {
267 		/* Find closest de-emphasis freq */
268 		val = 1;
269 		for (i = 2; i < ARRAY_SIZE(cs4271_deemph); i++)
270 			if (abs(cs4271_deemph[i] - cs4271->rate) <
271 			    abs(cs4271_deemph[val] - cs4271->rate))
272 				val = i;
273 		val <<= 4;
274 	}
275 
276 	ret = regmap_update_bits(cs4271->regmap, CS4271_DACCTL,
277 		CS4271_DACCTL_DEM_MASK, val);
278 	if (ret < 0)
279 		return ret;
280 	return 0;
281 }
282 
283 static int cs4271_get_deemph(struct snd_kcontrol *kcontrol,
284 			     struct snd_ctl_elem_value *ucontrol)
285 {
286 	struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
287 	struct cs4271_private *cs4271 = snd_soc_codec_get_drvdata(codec);
288 
289 	ucontrol->value.integer.value[0] = cs4271->deemph;
290 	return 0;
291 }
292 
293 static int cs4271_put_deemph(struct snd_kcontrol *kcontrol,
294 			     struct snd_ctl_elem_value *ucontrol)
295 {
296 	struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
297 	struct cs4271_private *cs4271 = snd_soc_codec_get_drvdata(codec);
298 
299 	cs4271->deemph = ucontrol->value.integer.value[0];
300 	return cs4271_set_deemph(codec);
301 }
302 
303 struct cs4271_clk_cfg {
304 	bool		master;		/* codec mode */
305 	u8		speed_mode;	/* codec speed mode: 1x, 2x, 4x */
306 	unsigned short	ratio;		/* MCLK / sample rate */
307 	u8		ratio_mask;	/* ratio bit mask for Master mode */
308 };
309 
310 static struct cs4271_clk_cfg cs4271_clk_tab[] = {
311 	{1, CS4271_MODE1_MODE_1X, 256,  CS4271_MODE1_DIV_1},
312 	{1, CS4271_MODE1_MODE_1X, 384,  CS4271_MODE1_DIV_15},
313 	{1, CS4271_MODE1_MODE_1X, 512,  CS4271_MODE1_DIV_2},
314 	{1, CS4271_MODE1_MODE_1X, 768,  CS4271_MODE1_DIV_3},
315 	{1, CS4271_MODE1_MODE_2X, 128,  CS4271_MODE1_DIV_1},
316 	{1, CS4271_MODE1_MODE_2X, 192,  CS4271_MODE1_DIV_15},
317 	{1, CS4271_MODE1_MODE_2X, 256,  CS4271_MODE1_DIV_2},
318 	{1, CS4271_MODE1_MODE_2X, 384,  CS4271_MODE1_DIV_3},
319 	{1, CS4271_MODE1_MODE_4X, 64,   CS4271_MODE1_DIV_1},
320 	{1, CS4271_MODE1_MODE_4X, 96,   CS4271_MODE1_DIV_15},
321 	{1, CS4271_MODE1_MODE_4X, 128,  CS4271_MODE1_DIV_2},
322 	{1, CS4271_MODE1_MODE_4X, 192,  CS4271_MODE1_DIV_3},
323 	{0, CS4271_MODE1_MODE_1X, 256,  CS4271_MODE1_DIV_1},
324 	{0, CS4271_MODE1_MODE_1X, 384,  CS4271_MODE1_DIV_1},
325 	{0, CS4271_MODE1_MODE_1X, 512,  CS4271_MODE1_DIV_1},
326 	{0, CS4271_MODE1_MODE_1X, 768,  CS4271_MODE1_DIV_2},
327 	{0, CS4271_MODE1_MODE_1X, 1024, CS4271_MODE1_DIV_2},
328 	{0, CS4271_MODE1_MODE_2X, 128,  CS4271_MODE1_DIV_1},
329 	{0, CS4271_MODE1_MODE_2X, 192,  CS4271_MODE1_DIV_1},
330 	{0, CS4271_MODE1_MODE_2X, 256,  CS4271_MODE1_DIV_1},
331 	{0, CS4271_MODE1_MODE_2X, 384,  CS4271_MODE1_DIV_2},
332 	{0, CS4271_MODE1_MODE_2X, 512,  CS4271_MODE1_DIV_2},
333 	{0, CS4271_MODE1_MODE_4X, 64,   CS4271_MODE1_DIV_1},
334 	{0, CS4271_MODE1_MODE_4X, 96,   CS4271_MODE1_DIV_1},
335 	{0, CS4271_MODE1_MODE_4X, 128,  CS4271_MODE1_DIV_1},
336 	{0, CS4271_MODE1_MODE_4X, 192,  CS4271_MODE1_DIV_2},
337 	{0, CS4271_MODE1_MODE_4X, 256,  CS4271_MODE1_DIV_2},
338 };
339 
340 #define CS4171_NR_RATIOS ARRAY_SIZE(cs4271_clk_tab)
341 
342 static int cs4271_hw_params(struct snd_pcm_substream *substream,
343 			    struct snd_pcm_hw_params *params,
344 			    struct snd_soc_dai *dai)
345 {
346 	struct snd_soc_codec *codec = dai->codec;
347 	struct cs4271_private *cs4271 = snd_soc_codec_get_drvdata(codec);
348 	int i, ret;
349 	unsigned int ratio, val;
350 
351 	if (cs4271->enable_soft_reset) {
352 		/*
353 		 * Put the codec in soft reset and back again in case it's not
354 		 * currently streaming data. This way of bringing the codec in
355 		 * sync to the current clocks is not explicitly documented in
356 		 * the data sheet, but it seems to work fine, and in contrast
357 		 * to a read hardware reset, we don't have to sync back all
358 		 * registers every time.
359 		 */
360 
361 		if ((substream->stream == SNDRV_PCM_STREAM_PLAYBACK &&
362 		     !dai->capture_active) ||
363 		    (substream->stream == SNDRV_PCM_STREAM_CAPTURE &&
364 		     !dai->playback_active)) {
365 			ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
366 						 CS4271_MODE2_PDN,
367 						 CS4271_MODE2_PDN);
368 			if (ret < 0)
369 				return ret;
370 
371 			ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
372 						 CS4271_MODE2_PDN, 0);
373 			if (ret < 0)
374 				return ret;
375 		}
376 	}
377 
378 	cs4271->rate = params_rate(params);
379 
380 	/* Configure DAC */
381 	if (cs4271->rate < 50000)
382 		val = CS4271_MODE1_MODE_1X;
383 	else if (cs4271->rate < 100000)
384 		val = CS4271_MODE1_MODE_2X;
385 	else
386 		val = CS4271_MODE1_MODE_4X;
387 
388 	ratio = cs4271->mclk / cs4271->rate;
389 	for (i = 0; i < CS4171_NR_RATIOS; i++)
390 		if ((cs4271_clk_tab[i].master == cs4271->master) &&
391 		    (cs4271_clk_tab[i].speed_mode == val) &&
392 		    (cs4271_clk_tab[i].ratio == ratio))
393 			break;
394 
395 	if (i == CS4171_NR_RATIOS) {
396 		dev_err(codec->dev, "Invalid sample rate\n");
397 		return -EINVAL;
398 	}
399 
400 	val |= cs4271_clk_tab[i].ratio_mask;
401 
402 	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE1,
403 		CS4271_MODE1_MODE_MASK | CS4271_MODE1_DIV_MASK, val);
404 	if (ret < 0)
405 		return ret;
406 
407 	return cs4271_set_deemph(codec);
408 }
409 
410 static int cs4271_mute_stream(struct snd_soc_dai *dai, int mute, int stream)
411 {
412 	struct snd_soc_codec *codec = dai->codec;
413 	struct cs4271_private *cs4271 = snd_soc_codec_get_drvdata(codec);
414 	int ret;
415 	int val_a = 0;
416 	int val_b = 0;
417 
418 	if (stream != SNDRV_PCM_STREAM_PLAYBACK)
419 		return 0;
420 
421 	if (mute) {
422 		val_a = CS4271_VOLA_MUTE;
423 		val_b = CS4271_VOLB_MUTE;
424 	}
425 
426 	ret = regmap_update_bits(cs4271->regmap, CS4271_VOLA,
427 				 CS4271_VOLA_MUTE, val_a);
428 	if (ret < 0)
429 		return ret;
430 
431 	ret = regmap_update_bits(cs4271->regmap, CS4271_VOLB,
432 				 CS4271_VOLB_MUTE, val_b);
433 	if (ret < 0)
434 		return ret;
435 
436 	return 0;
437 }
438 
439 /* CS4271 controls */
440 static DECLARE_TLV_DB_SCALE(cs4271_dac_tlv, -12700, 100, 0);
441 
442 static const struct snd_kcontrol_new cs4271_snd_controls[] = {
443 	SOC_DOUBLE_R_TLV("Master Playback Volume", CS4271_VOLA, CS4271_VOLB,
444 		0, 0x7F, 1, cs4271_dac_tlv),
445 	SOC_SINGLE("Digital Loopback Switch", CS4271_MODE2, 4, 1, 0),
446 	SOC_SINGLE("Soft Ramp Switch", CS4271_DACVOL, 5, 1, 0),
447 	SOC_SINGLE("Zero Cross Switch", CS4271_DACVOL, 4, 1, 0),
448 	SOC_SINGLE_BOOL_EXT("De-emphasis Switch", 0,
449 		cs4271_get_deemph, cs4271_put_deemph),
450 	SOC_SINGLE("Auto-Mute Switch", CS4271_DACCTL, 7, 1, 0),
451 	SOC_SINGLE("Slow Roll Off Filter Switch", CS4271_DACCTL, 6, 1, 0),
452 	SOC_SINGLE("Soft Volume Ramp-Up Switch", CS4271_DACCTL, 3, 1, 0),
453 	SOC_SINGLE("Soft Ramp-Down Switch", CS4271_DACCTL, 2, 1, 0),
454 	SOC_SINGLE("Left Channel Inversion Switch", CS4271_DACCTL, 1, 1, 0),
455 	SOC_SINGLE("Right Channel Inversion Switch", CS4271_DACCTL, 0, 1, 0),
456 	SOC_DOUBLE("Master Capture Switch", CS4271_ADCCTL, 3, 2, 1, 1),
457 	SOC_SINGLE("Dither 16-Bit Data Switch", CS4271_ADCCTL, 5, 1, 0),
458 	SOC_DOUBLE("High Pass Filter Switch", CS4271_ADCCTL, 1, 0, 1, 1),
459 	SOC_DOUBLE_R("Master Playback Switch", CS4271_VOLA, CS4271_VOLB,
460 		7, 1, 1),
461 };
462 
463 static const struct snd_soc_dai_ops cs4271_dai_ops = {
464 	.hw_params	= cs4271_hw_params,
465 	.set_sysclk	= cs4271_set_dai_sysclk,
466 	.set_fmt	= cs4271_set_dai_fmt,
467 	.mute_stream	= cs4271_mute_stream,
468 };
469 
470 static struct snd_soc_dai_driver cs4271_dai = {
471 	.name = "cs4271-hifi",
472 	.playback = {
473 		.stream_name	= "Playback",
474 		.channels_min	= 2,
475 		.channels_max	= 2,
476 		.rates		= CS4271_PCM_RATES,
477 		.formats	= CS4271_PCM_FORMATS,
478 	},
479 	.capture = {
480 		.stream_name	= "Capture",
481 		.channels_min	= 2,
482 		.channels_max	= 2,
483 		.rates		= CS4271_PCM_RATES,
484 		.formats	= CS4271_PCM_FORMATS,
485 	},
486 	.ops = &cs4271_dai_ops,
487 	.symmetric_rates = 1,
488 };
489 
490 #ifdef CONFIG_PM
491 static int cs4271_soc_suspend(struct snd_soc_codec *codec)
492 {
493 	int ret;
494 	struct cs4271_private *cs4271 = snd_soc_codec_get_drvdata(codec);
495 
496 	/* Set power-down bit */
497 	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
498 				 CS4271_MODE2_PDN, CS4271_MODE2_PDN);
499 	if (ret < 0)
500 		return ret;
501 
502 	return 0;
503 }
504 
505 static int cs4271_soc_resume(struct snd_soc_codec *codec)
506 {
507 	int ret;
508 	struct cs4271_private *cs4271 = snd_soc_codec_get_drvdata(codec);
509 
510 	/* Restore codec state */
511 	ret = regcache_sync(cs4271->regmap);
512 	if (ret < 0)
513 		return ret;
514 
515 	/* then disable the power-down bit */
516 	ret = regmap_update_bits(cs4271->regmap, CS4271_MODE2,
517 				 CS4271_MODE2_PDN, 0);
518 	if (ret < 0)
519 		return ret;
520 
521 	return 0;
522 }
523 #else
524 #define cs4271_soc_suspend	NULL
525 #define cs4271_soc_resume	NULL
526 #endif /* CONFIG_PM */
527 
528 #ifdef CONFIG_OF
529 const struct of_device_id cs4271_dt_ids[] = {
530 	{ .compatible = "cirrus,cs4271", },
531 	{ }
532 };
533 MODULE_DEVICE_TABLE(of, cs4271_dt_ids);
534 EXPORT_SYMBOL_GPL(cs4271_dt_ids);
535 #endif
536 
537 static int cs4271_codec_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 		mdelay(1);
565 		gpio_set_value(cs4271->gpio_nreset, 1);
566 		/* Give the codec time to wake up */
567 		mdelay(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 
590 static int cs4271_codec_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 
601 static struct snd_soc_codec_driver soc_codec_dev_cs4271 = {
602 	.probe			= cs4271_codec_probe,
603 	.remove			= cs4271_codec_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 
615 static 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 const struct regmap_config cs4271_regmap_config = {
646 	.max_register = CS4271_LASTREG,
647 
648 	.reg_defaults = cs4271_reg_defaults,
649 	.num_reg_defaults = ARRAY_SIZE(cs4271_reg_defaults),
650 	.cache_type = REGCACHE_RBTREE,
651 
652 	.volatile_reg = cs4271_volatile_reg,
653 };
654 EXPORT_SYMBOL_GPL(cs4271_regmap_config);
655 
656 int cs4271_probe(struct device *dev, struct regmap *regmap)
657 {
658 	struct cs4271_private *cs4271;
659 	int ret;
660 
661 	if (IS_ERR(regmap))
662 		return PTR_ERR(regmap);
663 
664 	ret = cs4271_common_probe(dev, &cs4271);
665 	if (ret < 0)
666 		return ret;
667 
668 	dev_set_drvdata(dev, cs4271);
669 	cs4271->regmap = regmap;
670 
671 	return snd_soc_register_codec(dev, &soc_codec_dev_cs4271, &cs4271_dai,
672 				      1);
673 }
674 EXPORT_SYMBOL_GPL(cs4271_probe);
675 
676 MODULE_AUTHOR("Alexander Sverdlin <subaparts@yandex.ru>");
677 MODULE_DESCRIPTION("Cirrus Logic CS4271 ALSA SoC Codec Driver");
678 MODULE_LICENSE("GPL");
679