Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / sound / soc / codecs / cs4271.c
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");