1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * cs35l33.c -- CS35L33 ALSA SoC audio driver 4 * 5 * Copyright 2016 Cirrus Logic, Inc. 6 * 7 * Author: Paul Handrigan <paul.handrigan@cirrus.com> 8 */ 9 #include <linux/module.h> 10 #include <linux/moduleparam.h> 11 #include <linux/kernel.h> 12 #include <linux/init.h> 13 #include <linux/delay.h> 14 #include <linux/i2c.h> 15 #include <linux/slab.h> 16 #include <linux/workqueue.h> 17 #include <linux/platform_device.h> 18 #include <sound/core.h> 19 #include <sound/pcm.h> 20 #include <sound/pcm_params.h> 21 #include <sound/soc.h> 22 #include <sound/soc-dapm.h> 23 #include <sound/initval.h> 24 #include <sound/tlv.h> 25 #include <linux/gpio.h> 26 #include <linux/gpio/consumer.h> 27 #include <sound/cs35l33.h> 28 #include <linux/pm_runtime.h> 29 #include <linux/regulator/consumer.h> 30 #include <linux/regulator/machine.h> 31 #include <linux/of_gpio.h> 32 #include <linux/of.h> 33 #include <linux/of_device.h> 34 #include <linux/of_irq.h> 35 36 #include "cs35l33.h" 37 38 #define CS35L33_BOOT_DELAY 50 39 40 struct cs35l33_private { 41 struct snd_soc_component *component; 42 struct cs35l33_pdata pdata; 43 struct regmap *regmap; 44 struct gpio_desc *reset_gpio; 45 bool amp_cal; 46 int mclk_int; 47 struct regulator_bulk_data core_supplies[2]; 48 int num_core_supplies; 49 bool is_tdm_mode; 50 bool enable_soft_ramp; 51 }; 52 53 static const struct reg_default cs35l33_reg[] = { 54 {CS35L33_PWRCTL1, 0x85}, 55 {CS35L33_PWRCTL2, 0xFE}, 56 {CS35L33_CLK_CTL, 0x0C}, 57 {CS35L33_BST_PEAK_CTL, 0x90}, 58 {CS35L33_PROTECT_CTL, 0x55}, 59 {CS35L33_BST_CTL1, 0x00}, 60 {CS35L33_BST_CTL2, 0x01}, 61 {CS35L33_ADSP_CTL, 0x00}, 62 {CS35L33_ADC_CTL, 0xC8}, 63 {CS35L33_DAC_CTL, 0x14}, 64 {CS35L33_DIG_VOL_CTL, 0x00}, 65 {CS35L33_CLASSD_CTL, 0x04}, 66 {CS35L33_AMP_CTL, 0x90}, 67 {CS35L33_INT_MASK_1, 0xFF}, 68 {CS35L33_INT_MASK_2, 0xFF}, 69 {CS35L33_DIAG_LOCK, 0x00}, 70 {CS35L33_DIAG_CTRL_1, 0x40}, 71 {CS35L33_DIAG_CTRL_2, 0x00}, 72 {CS35L33_HG_MEMLDO_CTL, 0x62}, 73 {CS35L33_HG_REL_RATE, 0x03}, 74 {CS35L33_LDO_DEL, 0x12}, 75 {CS35L33_HG_HEAD, 0x0A}, 76 {CS35L33_HG_EN, 0x05}, 77 {CS35L33_TX_VMON, 0x00}, 78 {CS35L33_TX_IMON, 0x03}, 79 {CS35L33_TX_VPMON, 0x02}, 80 {CS35L33_TX_VBSTMON, 0x05}, 81 {CS35L33_TX_FLAG, 0x06}, 82 {CS35L33_TX_EN1, 0x00}, 83 {CS35L33_TX_EN2, 0x00}, 84 {CS35L33_TX_EN3, 0x00}, 85 {CS35L33_TX_EN4, 0x00}, 86 {CS35L33_RX_AUD, 0x40}, 87 {CS35L33_RX_SPLY, 0x03}, 88 {CS35L33_RX_ALIVE, 0x04}, 89 {CS35L33_BST_CTL4, 0x63}, 90 }; 91 92 static const struct reg_sequence cs35l33_patch[] = { 93 { 0x00, 0x99, 0 }, 94 { 0x59, 0x02, 0 }, 95 { 0x52, 0x30, 0 }, 96 { 0x39, 0x45, 0 }, 97 { 0x57, 0x30, 0 }, 98 { 0x2C, 0x68, 0 }, 99 { 0x00, 0x00, 0 }, 100 }; 101 102 static bool cs35l33_volatile_register(struct device *dev, unsigned int reg) 103 { 104 switch (reg) { 105 case CS35L33_DEVID_AB: 106 case CS35L33_DEVID_CD: 107 case CS35L33_DEVID_E: 108 case CS35L33_REV_ID: 109 case CS35L33_INT_STATUS_1: 110 case CS35L33_INT_STATUS_2: 111 case CS35L33_HG_STATUS: 112 return true; 113 default: 114 return false; 115 } 116 } 117 118 static bool cs35l33_writeable_register(struct device *dev, unsigned int reg) 119 { 120 switch (reg) { 121 /* these are read only registers */ 122 case CS35L33_DEVID_AB: 123 case CS35L33_DEVID_CD: 124 case CS35L33_DEVID_E: 125 case CS35L33_REV_ID: 126 case CS35L33_INT_STATUS_1: 127 case CS35L33_INT_STATUS_2: 128 case CS35L33_HG_STATUS: 129 return false; 130 default: 131 return true; 132 } 133 } 134 135 static bool cs35l33_readable_register(struct device *dev, unsigned int reg) 136 { 137 switch (reg) { 138 case CS35L33_DEVID_AB: 139 case CS35L33_DEVID_CD: 140 case CS35L33_DEVID_E: 141 case CS35L33_REV_ID: 142 case CS35L33_PWRCTL1: 143 case CS35L33_PWRCTL2: 144 case CS35L33_CLK_CTL: 145 case CS35L33_BST_PEAK_CTL: 146 case CS35L33_PROTECT_CTL: 147 case CS35L33_BST_CTL1: 148 case CS35L33_BST_CTL2: 149 case CS35L33_ADSP_CTL: 150 case CS35L33_ADC_CTL: 151 case CS35L33_DAC_CTL: 152 case CS35L33_DIG_VOL_CTL: 153 case CS35L33_CLASSD_CTL: 154 case CS35L33_AMP_CTL: 155 case CS35L33_INT_MASK_1: 156 case CS35L33_INT_MASK_2: 157 case CS35L33_INT_STATUS_1: 158 case CS35L33_INT_STATUS_2: 159 case CS35L33_DIAG_LOCK: 160 case CS35L33_DIAG_CTRL_1: 161 case CS35L33_DIAG_CTRL_2: 162 case CS35L33_HG_MEMLDO_CTL: 163 case CS35L33_HG_REL_RATE: 164 case CS35L33_LDO_DEL: 165 case CS35L33_HG_HEAD: 166 case CS35L33_HG_EN: 167 case CS35L33_TX_VMON: 168 case CS35L33_TX_IMON: 169 case CS35L33_TX_VPMON: 170 case CS35L33_TX_VBSTMON: 171 case CS35L33_TX_FLAG: 172 case CS35L33_TX_EN1: 173 case CS35L33_TX_EN2: 174 case CS35L33_TX_EN3: 175 case CS35L33_TX_EN4: 176 case CS35L33_RX_AUD: 177 case CS35L33_RX_SPLY: 178 case CS35L33_RX_ALIVE: 179 case CS35L33_BST_CTL4: 180 return true; 181 default: 182 return false; 183 } 184 } 185 186 static DECLARE_TLV_DB_SCALE(classd_ctl_tlv, 900, 100, 0); 187 static DECLARE_TLV_DB_SCALE(dac_tlv, -10200, 50, 0); 188 189 static const struct snd_kcontrol_new cs35l33_snd_controls[] = { 190 191 SOC_SINGLE_TLV("SPK Amp Volume", CS35L33_AMP_CTL, 192 4, 0x09, 0, classd_ctl_tlv), 193 SOC_SINGLE_SX_TLV("DAC Volume", CS35L33_DIG_VOL_CTL, 194 0, 0x34, 0xE4, dac_tlv), 195 }; 196 197 static int cs35l33_spkrdrv_event(struct snd_soc_dapm_widget *w, 198 struct snd_kcontrol *kcontrol, int event) 199 { 200 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 201 struct cs35l33_private *priv = snd_soc_component_get_drvdata(component); 202 203 switch (event) { 204 case SND_SOC_DAPM_POST_PMU: 205 if (!priv->amp_cal) { 206 usleep_range(8000, 9000); 207 priv->amp_cal = true; 208 regmap_update_bits(priv->regmap, CS35L33_CLASSD_CTL, 209 CS35L33_AMP_CAL, 0); 210 dev_dbg(component->dev, "Amp calibration done\n"); 211 } 212 dev_dbg(component->dev, "Amp turned on\n"); 213 break; 214 case SND_SOC_DAPM_POST_PMD: 215 dev_dbg(component->dev, "Amp turned off\n"); 216 break; 217 default: 218 dev_err(component->dev, "Invalid event = 0x%x\n", event); 219 break; 220 } 221 222 return 0; 223 } 224 225 static int cs35l33_sdin_event(struct snd_soc_dapm_widget *w, 226 struct snd_kcontrol *kcontrol, int event) 227 { 228 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 229 struct cs35l33_private *priv = snd_soc_component_get_drvdata(component); 230 unsigned int val; 231 232 switch (event) { 233 case SND_SOC_DAPM_PRE_PMU: 234 regmap_update_bits(priv->regmap, CS35L33_PWRCTL1, 235 CS35L33_PDN_BST, 0); 236 val = priv->is_tdm_mode ? 0 : CS35L33_PDN_TDM; 237 regmap_update_bits(priv->regmap, CS35L33_PWRCTL2, 238 CS35L33_PDN_TDM, val); 239 dev_dbg(component->dev, "BST turned on\n"); 240 break; 241 case SND_SOC_DAPM_POST_PMU: 242 dev_dbg(component->dev, "SDIN turned on\n"); 243 if (!priv->amp_cal) { 244 regmap_update_bits(priv->regmap, CS35L33_CLASSD_CTL, 245 CS35L33_AMP_CAL, CS35L33_AMP_CAL); 246 dev_dbg(component->dev, "Amp calibration started\n"); 247 usleep_range(10000, 11000); 248 } 249 break; 250 case SND_SOC_DAPM_POST_PMD: 251 regmap_update_bits(priv->regmap, CS35L33_PWRCTL2, 252 CS35L33_PDN_TDM, CS35L33_PDN_TDM); 253 usleep_range(4000, 4100); 254 regmap_update_bits(priv->regmap, CS35L33_PWRCTL1, 255 CS35L33_PDN_BST, CS35L33_PDN_BST); 256 dev_dbg(component->dev, "BST and SDIN turned off\n"); 257 break; 258 default: 259 dev_err(component->dev, "Invalid event = 0x%x\n", event); 260 261 } 262 263 return 0; 264 } 265 266 static int cs35l33_sdout_event(struct snd_soc_dapm_widget *w, 267 struct snd_kcontrol *kcontrol, int event) 268 { 269 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 270 struct cs35l33_private *priv = snd_soc_component_get_drvdata(component); 271 unsigned int mask = CS35L33_SDOUT_3ST_I2S | CS35L33_PDN_TDM; 272 unsigned int mask2 = CS35L33_SDOUT_3ST_TDM; 273 unsigned int val, val2; 274 275 switch (event) { 276 case SND_SOC_DAPM_PRE_PMU: 277 if (priv->is_tdm_mode) { 278 /* set sdout_3st_i2s and reset pdn_tdm */ 279 val = CS35L33_SDOUT_3ST_I2S; 280 /* reset sdout_3st_tdm */ 281 val2 = 0; 282 } else { 283 /* reset sdout_3st_i2s and set pdn_tdm */ 284 val = CS35L33_PDN_TDM; 285 /* set sdout_3st_tdm */ 286 val2 = CS35L33_SDOUT_3ST_TDM; 287 } 288 dev_dbg(component->dev, "SDOUT turned on\n"); 289 break; 290 case SND_SOC_DAPM_PRE_PMD: 291 val = CS35L33_SDOUT_3ST_I2S | CS35L33_PDN_TDM; 292 val2 = CS35L33_SDOUT_3ST_TDM; 293 dev_dbg(component->dev, "SDOUT turned off\n"); 294 break; 295 default: 296 dev_err(component->dev, "Invalid event = 0x%x\n", event); 297 return 0; 298 } 299 300 regmap_update_bits(priv->regmap, CS35L33_PWRCTL2, 301 mask, val); 302 regmap_update_bits(priv->regmap, CS35L33_CLK_CTL, 303 mask2, val2); 304 305 return 0; 306 } 307 308 static const struct snd_soc_dapm_widget cs35l33_dapm_widgets[] = { 309 310 SND_SOC_DAPM_OUTPUT("SPK"), 311 SND_SOC_DAPM_OUT_DRV_E("SPKDRV", CS35L33_PWRCTL1, 7, 1, NULL, 0, 312 cs35l33_spkrdrv_event, 313 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), 314 SND_SOC_DAPM_AIF_IN_E("SDIN", NULL, 0, CS35L33_PWRCTL2, 315 2, 1, cs35l33_sdin_event, SND_SOC_DAPM_PRE_PMU | 316 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), 317 318 SND_SOC_DAPM_INPUT("MON"), 319 320 SND_SOC_DAPM_ADC("VMON", NULL, 321 CS35L33_PWRCTL2, CS35L33_PDN_VMON_SHIFT, 1), 322 SND_SOC_DAPM_ADC("IMON", NULL, 323 CS35L33_PWRCTL2, CS35L33_PDN_IMON_SHIFT, 1), 324 SND_SOC_DAPM_ADC("VPMON", NULL, 325 CS35L33_PWRCTL2, CS35L33_PDN_VPMON_SHIFT, 1), 326 SND_SOC_DAPM_ADC("VBSTMON", NULL, 327 CS35L33_PWRCTL2, CS35L33_PDN_VBSTMON_SHIFT, 1), 328 329 SND_SOC_DAPM_AIF_OUT_E("SDOUT", NULL, 0, SND_SOC_NOPM, 0, 0, 330 cs35l33_sdout_event, SND_SOC_DAPM_PRE_PMU | 331 SND_SOC_DAPM_PRE_PMD), 332 }; 333 334 static const struct snd_soc_dapm_route cs35l33_audio_map[] = { 335 {"SDIN", NULL, "CS35L33 Playback"}, 336 {"SPKDRV", NULL, "SDIN"}, 337 {"SPK", NULL, "SPKDRV"}, 338 339 {"VMON", NULL, "MON"}, 340 {"IMON", NULL, "MON"}, 341 342 {"SDOUT", NULL, "VMON"}, 343 {"SDOUT", NULL, "IMON"}, 344 {"CS35L33 Capture", NULL, "SDOUT"}, 345 }; 346 347 static const struct snd_soc_dapm_route cs35l33_vphg_auto_route[] = { 348 {"SPKDRV", NULL, "VPMON"}, 349 {"VPMON", NULL, "CS35L33 Playback"}, 350 }; 351 352 static const struct snd_soc_dapm_route cs35l33_vp_vbst_mon_route[] = { 353 {"SDOUT", NULL, "VPMON"}, 354 {"VPMON", NULL, "MON"}, 355 {"SDOUT", NULL, "VBSTMON"}, 356 {"VBSTMON", NULL, "MON"}, 357 }; 358 359 static int cs35l33_set_bias_level(struct snd_soc_component *component, 360 enum snd_soc_bias_level level) 361 { 362 unsigned int val; 363 struct cs35l33_private *priv = snd_soc_component_get_drvdata(component); 364 365 switch (level) { 366 case SND_SOC_BIAS_ON: 367 break; 368 case SND_SOC_BIAS_PREPARE: 369 regmap_update_bits(priv->regmap, CS35L33_PWRCTL1, 370 CS35L33_PDN_ALL, 0); 371 regmap_update_bits(priv->regmap, CS35L33_CLK_CTL, 372 CS35L33_MCLKDIS, 0); 373 break; 374 case SND_SOC_BIAS_STANDBY: 375 regmap_update_bits(priv->regmap, CS35L33_PWRCTL1, 376 CS35L33_PDN_ALL, CS35L33_PDN_ALL); 377 regmap_read(priv->regmap, CS35L33_INT_STATUS_2, &val); 378 usleep_range(1000, 1100); 379 if (val & CS35L33_PDN_DONE) 380 regmap_update_bits(priv->regmap, CS35L33_CLK_CTL, 381 CS35L33_MCLKDIS, CS35L33_MCLKDIS); 382 break; 383 case SND_SOC_BIAS_OFF: 384 break; 385 default: 386 return -EINVAL; 387 } 388 389 return 0; 390 } 391 392 struct cs35l33_mclk_div { 393 int mclk; 394 int srate; 395 u8 adsp_rate; 396 u8 int_fs_ratio; 397 }; 398 399 static const struct cs35l33_mclk_div cs35l33_mclk_coeffs[] = { 400 /* MCLK, Sample Rate, adsp_rate, int_fs_ratio */ 401 {5644800, 11025, 0x4, CS35L33_INT_FS_RATE}, 402 {5644800, 22050, 0x8, CS35L33_INT_FS_RATE}, 403 {5644800, 44100, 0xC, CS35L33_INT_FS_RATE}, 404 405 {6000000, 8000, 0x1, 0}, 406 {6000000, 11025, 0x2, 0}, 407 {6000000, 11029, 0x3, 0}, 408 {6000000, 12000, 0x4, 0}, 409 {6000000, 16000, 0x5, 0}, 410 {6000000, 22050, 0x6, 0}, 411 {6000000, 22059, 0x7, 0}, 412 {6000000, 24000, 0x8, 0}, 413 {6000000, 32000, 0x9, 0}, 414 {6000000, 44100, 0xA, 0}, 415 {6000000, 44118, 0xB, 0}, 416 {6000000, 48000, 0xC, 0}, 417 418 {6144000, 8000, 0x1, CS35L33_INT_FS_RATE}, 419 {6144000, 12000, 0x4, CS35L33_INT_FS_RATE}, 420 {6144000, 16000, 0x5, CS35L33_INT_FS_RATE}, 421 {6144000, 24000, 0x8, CS35L33_INT_FS_RATE}, 422 {6144000, 32000, 0x9, CS35L33_INT_FS_RATE}, 423 {6144000, 48000, 0xC, CS35L33_INT_FS_RATE}, 424 }; 425 426 static int cs35l33_get_mclk_coeff(int mclk, int srate) 427 { 428 int i; 429 430 for (i = 0; i < ARRAY_SIZE(cs35l33_mclk_coeffs); i++) { 431 if (cs35l33_mclk_coeffs[i].mclk == mclk && 432 cs35l33_mclk_coeffs[i].srate == srate) 433 return i; 434 } 435 return -EINVAL; 436 } 437 438 static int cs35l33_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt) 439 { 440 struct snd_soc_component *component = codec_dai->component; 441 struct cs35l33_private *priv = snd_soc_component_get_drvdata(component); 442 443 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { 444 case SND_SOC_DAIFMT_CBM_CFM: 445 regmap_update_bits(priv->regmap, CS35L33_ADSP_CTL, 446 CS35L33_MS_MASK, CS35L33_MS_MASK); 447 dev_dbg(component->dev, "Audio port in master mode\n"); 448 break; 449 case SND_SOC_DAIFMT_CBS_CFS: 450 regmap_update_bits(priv->regmap, CS35L33_ADSP_CTL, 451 CS35L33_MS_MASK, 0); 452 dev_dbg(component->dev, "Audio port in slave mode\n"); 453 break; 454 default: 455 return -EINVAL; 456 } 457 458 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { 459 case SND_SOC_DAIFMT_DSP_A: 460 /* 461 * tdm mode in cs35l33 resembles dsp-a mode very 462 * closely, it is dsp-a with fsync shifted left by half bclk 463 */ 464 priv->is_tdm_mode = true; 465 dev_dbg(component->dev, "Audio port in TDM mode\n"); 466 break; 467 case SND_SOC_DAIFMT_I2S: 468 priv->is_tdm_mode = false; 469 dev_dbg(component->dev, "Audio port in I2S mode\n"); 470 break; 471 default: 472 return -EINVAL; 473 } 474 475 return 0; 476 } 477 478 static int cs35l33_pcm_hw_params(struct snd_pcm_substream *substream, 479 struct snd_pcm_hw_params *params, 480 struct snd_soc_dai *dai) 481 { 482 struct snd_soc_component *component = dai->component; 483 struct cs35l33_private *priv = snd_soc_component_get_drvdata(component); 484 int sample_size = params_width(params); 485 int coeff = cs35l33_get_mclk_coeff(priv->mclk_int, params_rate(params)); 486 487 if (coeff < 0) 488 return coeff; 489 490 regmap_update_bits(priv->regmap, CS35L33_CLK_CTL, 491 CS35L33_ADSP_FS | CS35L33_INT_FS_RATE, 492 cs35l33_mclk_coeffs[coeff].int_fs_ratio 493 | cs35l33_mclk_coeffs[coeff].adsp_rate); 494 495 if (priv->is_tdm_mode) { 496 sample_size = (sample_size / 8) - 1; 497 if (sample_size > 2) 498 sample_size = 2; 499 regmap_update_bits(priv->regmap, CS35L33_RX_AUD, 500 CS35L33_AUDIN_RX_DEPTH, 501 sample_size << CS35L33_AUDIN_RX_DEPTH_SHIFT); 502 } 503 504 dev_dbg(component->dev, "sample rate=%d, bits per sample=%d\n", 505 params_rate(params), params_width(params)); 506 507 return 0; 508 } 509 510 static const unsigned int cs35l33_src_rates[] = { 511 8000, 11025, 11029, 12000, 16000, 22050, 512 22059, 24000, 32000, 44100, 44118, 48000 513 }; 514 515 static const struct snd_pcm_hw_constraint_list cs35l33_constraints = { 516 .count = ARRAY_SIZE(cs35l33_src_rates), 517 .list = cs35l33_src_rates, 518 }; 519 520 static int cs35l33_pcm_startup(struct snd_pcm_substream *substream, 521 struct snd_soc_dai *dai) 522 { 523 snd_pcm_hw_constraint_list(substream->runtime, 0, 524 SNDRV_PCM_HW_PARAM_RATE, 525 &cs35l33_constraints); 526 return 0; 527 } 528 529 static int cs35l33_set_tristate(struct snd_soc_dai *dai, int tristate) 530 { 531 struct snd_soc_component *component = dai->component; 532 struct cs35l33_private *priv = snd_soc_component_get_drvdata(component); 533 534 if (tristate) { 535 regmap_update_bits(priv->regmap, CS35L33_PWRCTL2, 536 CS35L33_SDOUT_3ST_I2S, CS35L33_SDOUT_3ST_I2S); 537 regmap_update_bits(priv->regmap, CS35L33_CLK_CTL, 538 CS35L33_SDOUT_3ST_TDM, CS35L33_SDOUT_3ST_TDM); 539 } else { 540 regmap_update_bits(priv->regmap, CS35L33_PWRCTL2, 541 CS35L33_SDOUT_3ST_I2S, 0); 542 regmap_update_bits(priv->regmap, CS35L33_CLK_CTL, 543 CS35L33_SDOUT_3ST_TDM, 0); 544 } 545 546 return 0; 547 } 548 549 static int cs35l33_set_tdm_slot(struct snd_soc_dai *dai, unsigned int tx_mask, 550 unsigned int rx_mask, int slots, int slot_width) 551 { 552 struct snd_soc_component *component = dai->component; 553 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component); 554 struct cs35l33_private *priv = snd_soc_component_get_drvdata(component); 555 unsigned int reg, bit_pos, i; 556 int slot, slot_num; 557 558 if (slot_width != 8) 559 return -EINVAL; 560 561 /* scan rx_mask for aud slot */ 562 slot = ffs(rx_mask) - 1; 563 if (slot >= 0) { 564 regmap_update_bits(priv->regmap, CS35L33_RX_AUD, 565 CS35L33_X_LOC, slot); 566 dev_dbg(component->dev, "Audio starts from slots %d", slot); 567 } 568 569 /* 570 * scan tx_mask: vmon(2 slots); imon (2 slots); 571 * vpmon (1 slot) vbstmon (1 slot) 572 */ 573 slot = ffs(tx_mask) - 1; 574 slot_num = 0; 575 576 for (i = 0; i < 2 ; i++) { 577 /* disable vpmon/vbstmon: enable later if set in tx_mask */ 578 regmap_update_bits(priv->regmap, CS35L33_TX_VPMON + i, 579 CS35L33_X_STATE | CS35L33_X_LOC, CS35L33_X_STATE 580 | CS35L33_X_LOC); 581 } 582 583 /* disconnect {vp,vbst}_mon routes: eanble later if set in tx_mask*/ 584 snd_soc_dapm_del_routes(dapm, cs35l33_vp_vbst_mon_route, 585 ARRAY_SIZE(cs35l33_vp_vbst_mon_route)); 586 587 while (slot >= 0) { 588 /* configure VMON_TX_LOC */ 589 if (slot_num == 0) { 590 regmap_update_bits(priv->regmap, CS35L33_TX_VMON, 591 CS35L33_X_STATE | CS35L33_X_LOC, slot); 592 dev_dbg(component->dev, "VMON enabled in slots %d-%d", 593 slot, slot + 1); 594 } 595 596 /* configure IMON_TX_LOC */ 597 if (slot_num == 3) { 598 regmap_update_bits(priv->regmap, CS35L33_TX_IMON, 599 CS35L33_X_STATE | CS35L33_X_LOC, slot); 600 dev_dbg(component->dev, "IMON enabled in slots %d-%d", 601 slot, slot + 1); 602 } 603 604 /* configure VPMON_TX_LOC */ 605 if (slot_num == 4) { 606 regmap_update_bits(priv->regmap, CS35L33_TX_VPMON, 607 CS35L33_X_STATE | CS35L33_X_LOC, slot); 608 snd_soc_dapm_add_routes(dapm, 609 &cs35l33_vp_vbst_mon_route[0], 2); 610 dev_dbg(component->dev, "VPMON enabled in slots %d", slot); 611 } 612 613 /* configure VBSTMON_TX_LOC */ 614 if (slot_num == 5) { 615 regmap_update_bits(priv->regmap, CS35L33_TX_VBSTMON, 616 CS35L33_X_STATE | CS35L33_X_LOC, slot); 617 snd_soc_dapm_add_routes(dapm, 618 &cs35l33_vp_vbst_mon_route[2], 2); 619 dev_dbg(component->dev, 620 "VBSTMON enabled in slots %d", slot); 621 } 622 623 /* Enable the relevant tx slot */ 624 reg = CS35L33_TX_EN4 - (slot/8); 625 bit_pos = slot - ((slot / 8) * (8)); 626 regmap_update_bits(priv->regmap, reg, 627 1 << bit_pos, 1 << bit_pos); 628 629 tx_mask &= ~(1 << slot); 630 slot = ffs(tx_mask) - 1; 631 slot_num++; 632 } 633 634 return 0; 635 } 636 637 static int cs35l33_component_set_sysclk(struct snd_soc_component *component, 638 int clk_id, int source, unsigned int freq, int dir) 639 { 640 struct cs35l33_private *cs35l33 = snd_soc_component_get_drvdata(component); 641 642 switch (freq) { 643 case CS35L33_MCLK_5644: 644 case CS35L33_MCLK_6: 645 case CS35L33_MCLK_6144: 646 regmap_update_bits(cs35l33->regmap, CS35L33_CLK_CTL, 647 CS35L33_MCLKDIV2, 0); 648 cs35l33->mclk_int = freq; 649 break; 650 case CS35L33_MCLK_11289: 651 case CS35L33_MCLK_12: 652 case CS35L33_MCLK_12288: 653 regmap_update_bits(cs35l33->regmap, CS35L33_CLK_CTL, 654 CS35L33_MCLKDIV2, CS35L33_MCLKDIV2); 655 cs35l33->mclk_int = freq/2; 656 break; 657 default: 658 cs35l33->mclk_int = 0; 659 return -EINVAL; 660 } 661 662 dev_dbg(component->dev, "external mclk freq=%d, internal mclk freq=%d\n", 663 freq, cs35l33->mclk_int); 664 665 return 0; 666 } 667 668 static const struct snd_soc_dai_ops cs35l33_ops = { 669 .startup = cs35l33_pcm_startup, 670 .set_tristate = cs35l33_set_tristate, 671 .set_fmt = cs35l33_set_dai_fmt, 672 .hw_params = cs35l33_pcm_hw_params, 673 .set_tdm_slot = cs35l33_set_tdm_slot, 674 }; 675 676 static struct snd_soc_dai_driver cs35l33_dai = { 677 .name = "cs35l33-dai", 678 .id = 0, 679 .playback = { 680 .stream_name = "CS35L33 Playback", 681 .channels_min = 1, 682 .channels_max = 1, 683 .rates = CS35L33_RATES, 684 .formats = CS35L33_FORMATS, 685 }, 686 .capture = { 687 .stream_name = "CS35L33 Capture", 688 .channels_min = 2, 689 .channels_max = 2, 690 .rates = CS35L33_RATES, 691 .formats = CS35L33_FORMATS, 692 }, 693 .ops = &cs35l33_ops, 694 .symmetric_rate = 1, 695 }; 696 697 static int cs35l33_set_hg_data(struct snd_soc_component *component, 698 struct cs35l33_pdata *pdata) 699 { 700 struct cs35l33_hg *hg_config = &pdata->hg_config; 701 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component); 702 struct cs35l33_private *priv = snd_soc_component_get_drvdata(component); 703 704 if (hg_config->enable_hg_algo) { 705 regmap_update_bits(priv->regmap, CS35L33_HG_MEMLDO_CTL, 706 CS35L33_MEM_DEPTH_MASK, 707 hg_config->mem_depth << CS35L33_MEM_DEPTH_SHIFT); 708 regmap_write(priv->regmap, CS35L33_HG_REL_RATE, 709 hg_config->release_rate); 710 regmap_update_bits(priv->regmap, CS35L33_HG_HEAD, 711 CS35L33_HD_RM_MASK, 712 hg_config->hd_rm << CS35L33_HD_RM_SHIFT); 713 regmap_update_bits(priv->regmap, CS35L33_HG_MEMLDO_CTL, 714 CS35L33_LDO_THLD_MASK, 715 hg_config->ldo_thld << CS35L33_LDO_THLD_SHIFT); 716 regmap_update_bits(priv->regmap, CS35L33_HG_MEMLDO_CTL, 717 CS35L33_LDO_DISABLE_MASK, 718 hg_config->ldo_path_disable << 719 CS35L33_LDO_DISABLE_SHIFT); 720 regmap_update_bits(priv->regmap, CS35L33_LDO_DEL, 721 CS35L33_LDO_ENTRY_DELAY_MASK, 722 hg_config->ldo_entry_delay << 723 CS35L33_LDO_ENTRY_DELAY_SHIFT); 724 if (hg_config->vp_hg_auto) { 725 regmap_update_bits(priv->regmap, CS35L33_HG_EN, 726 CS35L33_VP_HG_AUTO_MASK, 727 CS35L33_VP_HG_AUTO_MASK); 728 snd_soc_dapm_add_routes(dapm, cs35l33_vphg_auto_route, 729 ARRAY_SIZE(cs35l33_vphg_auto_route)); 730 } 731 regmap_update_bits(priv->regmap, CS35L33_HG_EN, 732 CS35L33_VP_HG_MASK, 733 hg_config->vp_hg << CS35L33_VP_HG_SHIFT); 734 regmap_update_bits(priv->regmap, CS35L33_LDO_DEL, 735 CS35L33_VP_HG_RATE_MASK, 736 hg_config->vp_hg_rate << CS35L33_VP_HG_RATE_SHIFT); 737 regmap_update_bits(priv->regmap, CS35L33_LDO_DEL, 738 CS35L33_VP_HG_VA_MASK, 739 hg_config->vp_hg_va << CS35L33_VP_HG_VA_SHIFT); 740 regmap_update_bits(priv->regmap, CS35L33_HG_EN, 741 CS35L33_CLASS_HG_EN_MASK, CS35L33_CLASS_HG_EN_MASK); 742 } 743 return 0; 744 } 745 746 static int cs35l33_set_bst_ipk(struct snd_soc_component *component, unsigned int bst) 747 { 748 struct cs35l33_private *cs35l33 = snd_soc_component_get_drvdata(component); 749 int ret = 0, steps = 0; 750 751 /* Boost current in uA */ 752 if (bst > 3600000 || bst < 1850000) { 753 dev_err(component->dev, "Invalid boost current %d\n", bst); 754 ret = -EINVAL; 755 goto err; 756 } 757 758 if (bst % 15625) { 759 dev_err(component->dev, "Current not a multiple of 15625uA (%d)\n", 760 bst); 761 ret = -EINVAL; 762 goto err; 763 } 764 765 while (bst > 1850000) { 766 bst -= 15625; 767 steps++; 768 } 769 770 regmap_write(cs35l33->regmap, CS35L33_BST_PEAK_CTL, 771 steps+0x70); 772 773 err: 774 return ret; 775 } 776 777 static int cs35l33_probe(struct snd_soc_component *component) 778 { 779 struct cs35l33_private *cs35l33 = snd_soc_component_get_drvdata(component); 780 781 cs35l33->component = component; 782 pm_runtime_get_sync(component->dev); 783 784 regmap_update_bits(cs35l33->regmap, CS35L33_PROTECT_CTL, 785 CS35L33_ALIVE_WD_DIS, 0x8); 786 regmap_update_bits(cs35l33->regmap, CS35L33_BST_CTL2, 787 CS35L33_ALIVE_WD_DIS2, 788 CS35L33_ALIVE_WD_DIS2); 789 790 /* Set Platform Data */ 791 regmap_update_bits(cs35l33->regmap, CS35L33_BST_CTL1, 792 CS35L33_BST_CTL_MASK, cs35l33->pdata.boost_ctl); 793 regmap_update_bits(cs35l33->regmap, CS35L33_CLASSD_CTL, 794 CS35L33_AMP_DRV_SEL_MASK, 795 cs35l33->pdata.amp_drv_sel << CS35L33_AMP_DRV_SEL_SHIFT); 796 797 if (cs35l33->pdata.boost_ipk) 798 cs35l33_set_bst_ipk(component, cs35l33->pdata.boost_ipk); 799 800 if (cs35l33->enable_soft_ramp) { 801 snd_soc_component_update_bits(component, CS35L33_DAC_CTL, 802 CS35L33_DIGSFT, CS35L33_DIGSFT); 803 snd_soc_component_update_bits(component, CS35L33_DAC_CTL, 804 CS35L33_DSR_RATE, cs35l33->pdata.ramp_rate); 805 } else { 806 snd_soc_component_update_bits(component, CS35L33_DAC_CTL, 807 CS35L33_DIGSFT, 0); 808 } 809 810 /* update IMON scaling rate if different from default of 0x8 */ 811 if (cs35l33->pdata.imon_adc_scale != 0x8) 812 snd_soc_component_update_bits(component, CS35L33_ADC_CTL, 813 CS35L33_IMON_SCALE, cs35l33->pdata.imon_adc_scale); 814 815 cs35l33_set_hg_data(component, &(cs35l33->pdata)); 816 817 /* 818 * unmask important interrupts that causes the chip to enter 819 * speaker safe mode and hence deserves user attention 820 */ 821 regmap_update_bits(cs35l33->regmap, CS35L33_INT_MASK_1, 822 CS35L33_M_OTE | CS35L33_M_OTW | CS35L33_M_AMP_SHORT | 823 CS35L33_M_CAL_ERR, 0); 824 825 pm_runtime_put_sync(component->dev); 826 827 return 0; 828 } 829 830 static const struct snd_soc_component_driver soc_component_dev_cs35l33 = { 831 .probe = cs35l33_probe, 832 .set_bias_level = cs35l33_set_bias_level, 833 .set_sysclk = cs35l33_component_set_sysclk, 834 .controls = cs35l33_snd_controls, 835 .num_controls = ARRAY_SIZE(cs35l33_snd_controls), 836 .dapm_widgets = cs35l33_dapm_widgets, 837 .num_dapm_widgets = ARRAY_SIZE(cs35l33_dapm_widgets), 838 .dapm_routes = cs35l33_audio_map, 839 .num_dapm_routes = ARRAY_SIZE(cs35l33_audio_map), 840 .use_pmdown_time = 1, 841 .endianness = 1, 842 .non_legacy_dai_naming = 1, 843 }; 844 845 static const struct regmap_config cs35l33_regmap = { 846 .reg_bits = 8, 847 .val_bits = 8, 848 849 .max_register = CS35L33_MAX_REGISTER, 850 .reg_defaults = cs35l33_reg, 851 .num_reg_defaults = ARRAY_SIZE(cs35l33_reg), 852 .volatile_reg = cs35l33_volatile_register, 853 .readable_reg = cs35l33_readable_register, 854 .writeable_reg = cs35l33_writeable_register, 855 .cache_type = REGCACHE_RBTREE, 856 .use_single_read = true, 857 .use_single_write = true, 858 }; 859 860 static int __maybe_unused cs35l33_runtime_resume(struct device *dev) 861 { 862 struct cs35l33_private *cs35l33 = dev_get_drvdata(dev); 863 int ret; 864 865 dev_dbg(dev, "%s\n", __func__); 866 867 gpiod_set_value_cansleep(cs35l33->reset_gpio, 0); 868 869 ret = regulator_bulk_enable(cs35l33->num_core_supplies, 870 cs35l33->core_supplies); 871 if (ret != 0) { 872 dev_err(dev, "Failed to enable core supplies: %d\n", ret); 873 return ret; 874 } 875 876 regcache_cache_only(cs35l33->regmap, false); 877 878 gpiod_set_value_cansleep(cs35l33->reset_gpio, 1); 879 880 msleep(CS35L33_BOOT_DELAY); 881 882 ret = regcache_sync(cs35l33->regmap); 883 if (ret != 0) { 884 dev_err(dev, "Failed to restore register cache\n"); 885 goto err; 886 } 887 888 return 0; 889 890 err: 891 regcache_cache_only(cs35l33->regmap, true); 892 regulator_bulk_disable(cs35l33->num_core_supplies, 893 cs35l33->core_supplies); 894 895 return ret; 896 } 897 898 static int __maybe_unused cs35l33_runtime_suspend(struct device *dev) 899 { 900 struct cs35l33_private *cs35l33 = dev_get_drvdata(dev); 901 902 dev_dbg(dev, "%s\n", __func__); 903 904 /* redo the calibration in next power up */ 905 cs35l33->amp_cal = false; 906 907 regcache_cache_only(cs35l33->regmap, true); 908 regcache_mark_dirty(cs35l33->regmap); 909 regulator_bulk_disable(cs35l33->num_core_supplies, 910 cs35l33->core_supplies); 911 912 return 0; 913 } 914 915 static const struct dev_pm_ops cs35l33_pm_ops = { 916 SET_RUNTIME_PM_OPS(cs35l33_runtime_suspend, 917 cs35l33_runtime_resume, 918 NULL) 919 }; 920 921 static int cs35l33_get_hg_data(const struct device_node *np, 922 struct cs35l33_pdata *pdata) 923 { 924 struct device_node *hg; 925 struct cs35l33_hg *hg_config = &pdata->hg_config; 926 u32 val32; 927 928 hg = of_get_child_by_name(np, "cirrus,hg-algo"); 929 hg_config->enable_hg_algo = hg ? true : false; 930 931 if (hg_config->enable_hg_algo) { 932 if (of_property_read_u32(hg, "cirrus,mem-depth", &val32) >= 0) 933 hg_config->mem_depth = val32; 934 if (of_property_read_u32(hg, "cirrus,release-rate", 935 &val32) >= 0) 936 hg_config->release_rate = val32; 937 if (of_property_read_u32(hg, "cirrus,ldo-thld", &val32) >= 0) 938 hg_config->ldo_thld = val32; 939 if (of_property_read_u32(hg, "cirrus,ldo-path-disable", 940 &val32) >= 0) 941 hg_config->ldo_path_disable = val32; 942 if (of_property_read_u32(hg, "cirrus,ldo-entry-delay", 943 &val32) >= 0) 944 hg_config->ldo_entry_delay = val32; 945 946 hg_config->vp_hg_auto = of_property_read_bool(hg, 947 "cirrus,vp-hg-auto"); 948 949 if (of_property_read_u32(hg, "cirrus,vp-hg", &val32) >= 0) 950 hg_config->vp_hg = val32; 951 if (of_property_read_u32(hg, "cirrus,vp-hg-rate", &val32) >= 0) 952 hg_config->vp_hg_rate = val32; 953 if (of_property_read_u32(hg, "cirrus,vp-hg-va", &val32) >= 0) 954 hg_config->vp_hg_va = val32; 955 } 956 957 of_node_put(hg); 958 959 return 0; 960 } 961 962 static irqreturn_t cs35l33_irq_thread(int irq, void *data) 963 { 964 struct cs35l33_private *cs35l33 = data; 965 struct snd_soc_component *component = cs35l33->component; 966 unsigned int sticky_val1, sticky_val2, current_val, mask1, mask2; 967 968 regmap_read(cs35l33->regmap, CS35L33_INT_STATUS_2, 969 &sticky_val2); 970 regmap_read(cs35l33->regmap, CS35L33_INT_STATUS_1, 971 &sticky_val1); 972 regmap_read(cs35l33->regmap, CS35L33_INT_MASK_2, &mask2); 973 regmap_read(cs35l33->regmap, CS35L33_INT_MASK_1, &mask1); 974 975 /* Check to see if the unmasked bits are active, 976 * if not then exit. 977 */ 978 if (!(sticky_val1 & ~mask1) && !(sticky_val2 & ~mask2)) 979 return IRQ_NONE; 980 981 regmap_read(cs35l33->regmap, CS35L33_INT_STATUS_1, 982 ¤t_val); 983 984 /* handle the interrupts */ 985 986 if (sticky_val1 & CS35L33_AMP_SHORT) { 987 dev_crit(component->dev, "Amp short error\n"); 988 if (!(current_val & CS35L33_AMP_SHORT)) { 989 dev_dbg(component->dev, 990 "Amp short error release\n"); 991 regmap_update_bits(cs35l33->regmap, 992 CS35L33_AMP_CTL, 993 CS35L33_AMP_SHORT_RLS, 0); 994 regmap_update_bits(cs35l33->regmap, 995 CS35L33_AMP_CTL, 996 CS35L33_AMP_SHORT_RLS, 997 CS35L33_AMP_SHORT_RLS); 998 regmap_update_bits(cs35l33->regmap, 999 CS35L33_AMP_CTL, CS35L33_AMP_SHORT_RLS, 1000 0); 1001 } 1002 } 1003 1004 if (sticky_val1 & CS35L33_CAL_ERR) { 1005 dev_err(component->dev, "Cal error\n"); 1006 1007 /* redo the calibration in next power up */ 1008 cs35l33->amp_cal = false; 1009 1010 if (!(current_val & CS35L33_CAL_ERR)) { 1011 dev_dbg(component->dev, "Cal error release\n"); 1012 regmap_update_bits(cs35l33->regmap, 1013 CS35L33_AMP_CTL, CS35L33_CAL_ERR_RLS, 1014 0); 1015 regmap_update_bits(cs35l33->regmap, 1016 CS35L33_AMP_CTL, CS35L33_CAL_ERR_RLS, 1017 CS35L33_CAL_ERR_RLS); 1018 regmap_update_bits(cs35l33->regmap, 1019 CS35L33_AMP_CTL, CS35L33_CAL_ERR_RLS, 1020 0); 1021 } 1022 } 1023 1024 if (sticky_val1 & CS35L33_OTE) { 1025 dev_crit(component->dev, "Over temperature error\n"); 1026 if (!(current_val & CS35L33_OTE)) { 1027 dev_dbg(component->dev, 1028 "Over temperature error release\n"); 1029 regmap_update_bits(cs35l33->regmap, 1030 CS35L33_AMP_CTL, CS35L33_OTE_RLS, 0); 1031 regmap_update_bits(cs35l33->regmap, 1032 CS35L33_AMP_CTL, CS35L33_OTE_RLS, 1033 CS35L33_OTE_RLS); 1034 regmap_update_bits(cs35l33->regmap, 1035 CS35L33_AMP_CTL, CS35L33_OTE_RLS, 0); 1036 } 1037 } 1038 1039 if (sticky_val1 & CS35L33_OTW) { 1040 dev_err(component->dev, "Over temperature warning\n"); 1041 if (!(current_val & CS35L33_OTW)) { 1042 dev_dbg(component->dev, 1043 "Over temperature warning release\n"); 1044 regmap_update_bits(cs35l33->regmap, 1045 CS35L33_AMP_CTL, CS35L33_OTW_RLS, 0); 1046 regmap_update_bits(cs35l33->regmap, 1047 CS35L33_AMP_CTL, CS35L33_OTW_RLS, 1048 CS35L33_OTW_RLS); 1049 regmap_update_bits(cs35l33->regmap, 1050 CS35L33_AMP_CTL, CS35L33_OTW_RLS, 0); 1051 } 1052 } 1053 if (CS35L33_ALIVE_ERR & sticky_val1) 1054 dev_err(component->dev, "ERROR: ADSPCLK Interrupt\n"); 1055 1056 if (CS35L33_MCLK_ERR & sticky_val1) 1057 dev_err(component->dev, "ERROR: MCLK Interrupt\n"); 1058 1059 if (CS35L33_VMON_OVFL & sticky_val2) 1060 dev_err(component->dev, 1061 "ERROR: VMON Overflow Interrupt\n"); 1062 1063 if (CS35L33_IMON_OVFL & sticky_val2) 1064 dev_err(component->dev, 1065 "ERROR: IMON Overflow Interrupt\n"); 1066 1067 if (CS35L33_VPMON_OVFL & sticky_val2) 1068 dev_err(component->dev, 1069 "ERROR: VPMON Overflow Interrupt\n"); 1070 1071 return IRQ_HANDLED; 1072 } 1073 1074 static const char * const cs35l33_core_supplies[] = { 1075 "VA", 1076 "VP", 1077 }; 1078 1079 static int cs35l33_of_get_pdata(struct device *dev, 1080 struct cs35l33_private *cs35l33) 1081 { 1082 struct device_node *np = dev->of_node; 1083 struct cs35l33_pdata *pdata = &cs35l33->pdata; 1084 u32 val32; 1085 1086 if (!np) 1087 return 0; 1088 1089 if (of_property_read_u32(np, "cirrus,boost-ctl", &val32) >= 0) { 1090 pdata->boost_ctl = val32; 1091 pdata->amp_drv_sel = 1; 1092 } 1093 1094 if (of_property_read_u32(np, "cirrus,ramp-rate", &val32) >= 0) { 1095 pdata->ramp_rate = val32; 1096 cs35l33->enable_soft_ramp = true; 1097 } 1098 1099 if (of_property_read_u32(np, "cirrus,boost-ipk", &val32) >= 0) 1100 pdata->boost_ipk = val32; 1101 1102 if (of_property_read_u32(np, "cirrus,imon-adc-scale", &val32) >= 0) { 1103 if ((val32 == 0x0) || (val32 == 0x7) || (val32 == 0x6)) 1104 pdata->imon_adc_scale = val32; 1105 else 1106 /* use default value */ 1107 pdata->imon_adc_scale = 0x8; 1108 } else { 1109 /* use default value */ 1110 pdata->imon_adc_scale = 0x8; 1111 } 1112 1113 cs35l33_get_hg_data(np, pdata); 1114 1115 return 0; 1116 } 1117 1118 static int cs35l33_i2c_probe(struct i2c_client *i2c_client, 1119 const struct i2c_device_id *id) 1120 { 1121 struct cs35l33_private *cs35l33; 1122 struct cs35l33_pdata *pdata = dev_get_platdata(&i2c_client->dev); 1123 int ret, devid, i; 1124 unsigned int reg; 1125 1126 cs35l33 = devm_kzalloc(&i2c_client->dev, sizeof(struct cs35l33_private), 1127 GFP_KERNEL); 1128 if (!cs35l33) 1129 return -ENOMEM; 1130 1131 i2c_set_clientdata(i2c_client, cs35l33); 1132 cs35l33->regmap = devm_regmap_init_i2c(i2c_client, &cs35l33_regmap); 1133 if (IS_ERR(cs35l33->regmap)) { 1134 ret = PTR_ERR(cs35l33->regmap); 1135 dev_err(&i2c_client->dev, "regmap_init() failed: %d\n", ret); 1136 return ret; 1137 } 1138 1139 regcache_cache_only(cs35l33->regmap, true); 1140 1141 for (i = 0; i < ARRAY_SIZE(cs35l33_core_supplies); i++) 1142 cs35l33->core_supplies[i].supply 1143 = cs35l33_core_supplies[i]; 1144 cs35l33->num_core_supplies = ARRAY_SIZE(cs35l33_core_supplies); 1145 1146 ret = devm_regulator_bulk_get(&i2c_client->dev, 1147 cs35l33->num_core_supplies, 1148 cs35l33->core_supplies); 1149 if (ret != 0) { 1150 dev_err(&i2c_client->dev, 1151 "Failed to request core supplies: %d\n", 1152 ret); 1153 return ret; 1154 } 1155 1156 if (pdata) { 1157 cs35l33->pdata = *pdata; 1158 } else { 1159 cs35l33_of_get_pdata(&i2c_client->dev, cs35l33); 1160 pdata = &cs35l33->pdata; 1161 } 1162 1163 ret = devm_request_threaded_irq(&i2c_client->dev, i2c_client->irq, NULL, 1164 cs35l33_irq_thread, IRQF_ONESHOT | IRQF_TRIGGER_LOW, 1165 "cs35l33", cs35l33); 1166 if (ret != 0) 1167 dev_warn(&i2c_client->dev, "Failed to request IRQ: %d\n", ret); 1168 1169 /* We could issue !RST or skip it based on AMP topology */ 1170 cs35l33->reset_gpio = devm_gpiod_get_optional(&i2c_client->dev, 1171 "reset-gpios", GPIOD_OUT_HIGH); 1172 if (IS_ERR(cs35l33->reset_gpio)) { 1173 dev_err(&i2c_client->dev, "%s ERROR: Can't get reset GPIO\n", 1174 __func__); 1175 return PTR_ERR(cs35l33->reset_gpio); 1176 } 1177 1178 ret = regulator_bulk_enable(cs35l33->num_core_supplies, 1179 cs35l33->core_supplies); 1180 if (ret != 0) { 1181 dev_err(&i2c_client->dev, 1182 "Failed to enable core supplies: %d\n", 1183 ret); 1184 return ret; 1185 } 1186 1187 gpiod_set_value_cansleep(cs35l33->reset_gpio, 1); 1188 1189 msleep(CS35L33_BOOT_DELAY); 1190 regcache_cache_only(cs35l33->regmap, false); 1191 1192 /* initialize codec */ 1193 ret = regmap_read(cs35l33->regmap, CS35L33_DEVID_AB, ®); 1194 devid = (reg & 0xFF) << 12; 1195 ret = regmap_read(cs35l33->regmap, CS35L33_DEVID_CD, ®); 1196 devid |= (reg & 0xFF) << 4; 1197 ret = regmap_read(cs35l33->regmap, CS35L33_DEVID_E, ®); 1198 devid |= (reg & 0xF0) >> 4; 1199 1200 if (devid != CS35L33_CHIP_ID) { 1201 dev_err(&i2c_client->dev, 1202 "CS35L33 Device ID (%X). Expected ID %X\n", 1203 devid, CS35L33_CHIP_ID); 1204 ret = -EINVAL; 1205 goto err_enable; 1206 } 1207 1208 ret = regmap_read(cs35l33->regmap, CS35L33_REV_ID, ®); 1209 if (ret < 0) { 1210 dev_err(&i2c_client->dev, "Get Revision ID failed\n"); 1211 goto err_enable; 1212 } 1213 1214 dev_info(&i2c_client->dev, 1215 "Cirrus Logic CS35L33, Revision: %02X\n", reg & 0xFF); 1216 1217 ret = regmap_register_patch(cs35l33->regmap, 1218 cs35l33_patch, ARRAY_SIZE(cs35l33_patch)); 1219 if (ret < 0) { 1220 dev_err(&i2c_client->dev, 1221 "Error in applying regmap patch: %d\n", ret); 1222 goto err_enable; 1223 } 1224 1225 /* disable mclk and tdm */ 1226 regmap_update_bits(cs35l33->regmap, CS35L33_CLK_CTL, 1227 CS35L33_MCLKDIS | CS35L33_SDOUT_3ST_TDM, 1228 CS35L33_MCLKDIS | CS35L33_SDOUT_3ST_TDM); 1229 1230 pm_runtime_set_autosuspend_delay(&i2c_client->dev, 100); 1231 pm_runtime_use_autosuspend(&i2c_client->dev); 1232 pm_runtime_set_active(&i2c_client->dev); 1233 pm_runtime_enable(&i2c_client->dev); 1234 1235 ret = devm_snd_soc_register_component(&i2c_client->dev, 1236 &soc_component_dev_cs35l33, &cs35l33_dai, 1); 1237 if (ret < 0) { 1238 dev_err(&i2c_client->dev, "%s: Register component failed\n", 1239 __func__); 1240 goto err_enable; 1241 } 1242 1243 return 0; 1244 1245 err_enable: 1246 regulator_bulk_disable(cs35l33->num_core_supplies, 1247 cs35l33->core_supplies); 1248 1249 return ret; 1250 } 1251 1252 static int cs35l33_i2c_remove(struct i2c_client *client) 1253 { 1254 struct cs35l33_private *cs35l33 = i2c_get_clientdata(client); 1255 1256 gpiod_set_value_cansleep(cs35l33->reset_gpio, 0); 1257 1258 pm_runtime_disable(&client->dev); 1259 regulator_bulk_disable(cs35l33->num_core_supplies, 1260 cs35l33->core_supplies); 1261 1262 return 0; 1263 } 1264 1265 static const struct of_device_id cs35l33_of_match[] = { 1266 { .compatible = "cirrus,cs35l33", }, 1267 {}, 1268 }; 1269 MODULE_DEVICE_TABLE(of, cs35l33_of_match); 1270 1271 static const struct i2c_device_id cs35l33_id[] = { 1272 {"cs35l33", 0}, 1273 {} 1274 }; 1275 1276 MODULE_DEVICE_TABLE(i2c, cs35l33_id); 1277 1278 static struct i2c_driver cs35l33_i2c_driver = { 1279 .driver = { 1280 .name = "cs35l33", 1281 .pm = &cs35l33_pm_ops, 1282 .of_match_table = cs35l33_of_match, 1283 1284 }, 1285 .id_table = cs35l33_id, 1286 .probe = cs35l33_i2c_probe, 1287 .remove = cs35l33_i2c_remove, 1288 1289 }; 1290 module_i2c_driver(cs35l33_i2c_driver); 1291 1292 MODULE_DESCRIPTION("ASoC CS35L33 driver"); 1293 MODULE_AUTHOR("Paul Handrigan, Cirrus Logic Inc, <paul.handrigan@cirrus.com>"); 1294 MODULE_LICENSE("GPL"); 1295