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