1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * cs35l34.c -- CS35l34 ALSA SoC audio driver 4 * 5 * Copyright 2016 Cirrus Logic, Inc. 6 * 7 * Author: Paul Handrigan <Paul.Handrigan@cirrus.com> 8 */ 9 10 #include <linux/module.h> 11 #include <linux/moduleparam.h> 12 #include <linux/kernel.h> 13 #include <linux/init.h> 14 #include <linux/delay.h> 15 #include <linux/i2c.h> 16 #include <linux/slab.h> 17 #include <linux/workqueue.h> 18 #include <linux/platform_device.h> 19 #include <linux/regulator/consumer.h> 20 #include <linux/regulator/machine.h> 21 #include <linux/pm_runtime.h> 22 #include <linux/of_device.h> 23 #include <linux/of_gpio.h> 24 #include <linux/of_irq.h> 25 #include <sound/core.h> 26 #include <sound/pcm.h> 27 #include <sound/pcm_params.h> 28 #include <sound/soc.h> 29 #include <sound/soc-dapm.h> 30 #include <linux/gpio.h> 31 #include <linux/gpio/consumer.h> 32 #include <sound/initval.h> 33 #include <sound/tlv.h> 34 #include <sound/cs35l34.h> 35 36 #include "cs35l34.h" 37 #include "cirrus_legacy.h" 38 39 #define PDN_DONE_ATTEMPTS 10 40 #define CS35L34_START_DELAY 50 41 42 struct cs35l34_private { 43 struct snd_soc_component *component; 44 struct cs35l34_platform_data pdata; 45 struct regmap *regmap; 46 struct regulator_bulk_data core_supplies[2]; 47 int num_core_supplies; 48 int mclk_int; 49 bool tdm_mode; 50 struct gpio_desc *reset_gpio; /* Active-low reset GPIO */ 51 }; 52 53 static const struct reg_default cs35l34_reg[] = { 54 {CS35L34_PWRCTL1, 0x01}, 55 {CS35L34_PWRCTL2, 0x19}, 56 {CS35L34_PWRCTL3, 0x01}, 57 {CS35L34_ADSP_CLK_CTL, 0x08}, 58 {CS35L34_MCLK_CTL, 0x11}, 59 {CS35L34_AMP_INP_DRV_CTL, 0x01}, 60 {CS35L34_AMP_DIG_VOL_CTL, 0x12}, 61 {CS35L34_AMP_DIG_VOL, 0x00}, 62 {CS35L34_AMP_ANLG_GAIN_CTL, 0x0F}, 63 {CS35L34_PROTECT_CTL, 0x06}, 64 {CS35L34_AMP_KEEP_ALIVE_CTL, 0x04}, 65 {CS35L34_BST_CVTR_V_CTL, 0x00}, 66 {CS35L34_BST_PEAK_I, 0x10}, 67 {CS35L34_BST_RAMP_CTL, 0x87}, 68 {CS35L34_BST_CONV_COEF_1, 0x24}, 69 {CS35L34_BST_CONV_COEF_2, 0x24}, 70 {CS35L34_BST_CONV_SLOPE_COMP, 0x4E}, 71 {CS35L34_BST_CONV_SW_FREQ, 0x08}, 72 {CS35L34_CLASS_H_CTL, 0x0D}, 73 {CS35L34_CLASS_H_HEADRM_CTL, 0x0D}, 74 {CS35L34_CLASS_H_RELEASE_RATE, 0x08}, 75 {CS35L34_CLASS_H_FET_DRIVE_CTL, 0x41}, 76 {CS35L34_CLASS_H_STATUS, 0x05}, 77 {CS35L34_VPBR_CTL, 0x0A}, 78 {CS35L34_VPBR_VOL_CTL, 0x90}, 79 {CS35L34_VPBR_TIMING_CTL, 0x6A}, 80 {CS35L34_PRED_MAX_ATTEN_SPK_LOAD, 0x95}, 81 {CS35L34_PRED_BROWNOUT_THRESH, 0x1C}, 82 {CS35L34_PRED_BROWNOUT_VOL_CTL, 0x00}, 83 {CS35L34_PRED_BROWNOUT_RATE_CTL, 0x10}, 84 {CS35L34_PRED_WAIT_CTL, 0x10}, 85 {CS35L34_PRED_ZVP_INIT_IMP_CTL, 0x08}, 86 {CS35L34_PRED_MAN_SAFE_VPI_CTL, 0x80}, 87 {CS35L34_VPBR_ATTEN_STATUS, 0x00}, 88 {CS35L34_PRED_BRWNOUT_ATT_STATUS, 0x00}, 89 {CS35L34_SPKR_MON_CTL, 0xC6}, 90 {CS35L34_ADSP_I2S_CTL, 0x00}, 91 {CS35L34_ADSP_TDM_CTL, 0x00}, 92 {CS35L34_TDM_TX_CTL_1_VMON, 0x00}, 93 {CS35L34_TDM_TX_CTL_2_IMON, 0x04}, 94 {CS35L34_TDM_TX_CTL_3_VPMON, 0x03}, 95 {CS35L34_TDM_TX_CTL_4_VBSTMON, 0x07}, 96 {CS35L34_TDM_TX_CTL_5_FLAG1, 0x08}, 97 {CS35L34_TDM_TX_CTL_6_FLAG2, 0x09}, 98 {CS35L34_TDM_TX_SLOT_EN_1, 0x00}, 99 {CS35L34_TDM_TX_SLOT_EN_2, 0x00}, 100 {CS35L34_TDM_TX_SLOT_EN_3, 0x00}, 101 {CS35L34_TDM_TX_SLOT_EN_4, 0x00}, 102 {CS35L34_TDM_RX_CTL_1_AUDIN, 0x40}, 103 {CS35L34_TDM_RX_CTL_3_ALIVE, 0x04}, 104 {CS35L34_MULT_DEV_SYNCH1, 0x00}, 105 {CS35L34_MULT_DEV_SYNCH2, 0x80}, 106 {CS35L34_PROT_RELEASE_CTL, 0x00}, 107 {CS35L34_DIAG_MODE_REG_LOCK, 0x00}, 108 {CS35L34_DIAG_MODE_CTL_1, 0x00}, 109 {CS35L34_DIAG_MODE_CTL_2, 0x00}, 110 {CS35L34_INT_MASK_1, 0xFF}, 111 {CS35L34_INT_MASK_2, 0xFF}, 112 {CS35L34_INT_MASK_3, 0xFF}, 113 {CS35L34_INT_MASK_4, 0xFF}, 114 {CS35L34_INT_STATUS_1, 0x30}, 115 {CS35L34_INT_STATUS_2, 0x05}, 116 {CS35L34_INT_STATUS_3, 0x00}, 117 {CS35L34_INT_STATUS_4, 0x00}, 118 {CS35L34_OTP_TRIM_STATUS, 0x00}, 119 }; 120 121 static bool cs35l34_volatile_register(struct device *dev, unsigned int reg) 122 { 123 switch (reg) { 124 case CS35L34_DEVID_AB: 125 case CS35L34_DEVID_CD: 126 case CS35L34_DEVID_E: 127 case CS35L34_FAB_ID: 128 case CS35L34_REV_ID: 129 case CS35L34_INT_STATUS_1: 130 case CS35L34_INT_STATUS_2: 131 case CS35L34_INT_STATUS_3: 132 case CS35L34_INT_STATUS_4: 133 case CS35L34_CLASS_H_STATUS: 134 case CS35L34_VPBR_ATTEN_STATUS: 135 case CS35L34_OTP_TRIM_STATUS: 136 return true; 137 default: 138 return false; 139 } 140 } 141 142 static bool cs35l34_readable_register(struct device *dev, unsigned int reg) 143 { 144 switch (reg) { 145 case CS35L34_DEVID_AB: 146 case CS35L34_DEVID_CD: 147 case CS35L34_DEVID_E: 148 case CS35L34_FAB_ID: 149 case CS35L34_REV_ID: 150 case CS35L34_PWRCTL1: 151 case CS35L34_PWRCTL2: 152 case CS35L34_PWRCTL3: 153 case CS35L34_ADSP_CLK_CTL: 154 case CS35L34_MCLK_CTL: 155 case CS35L34_AMP_INP_DRV_CTL: 156 case CS35L34_AMP_DIG_VOL_CTL: 157 case CS35L34_AMP_DIG_VOL: 158 case CS35L34_AMP_ANLG_GAIN_CTL: 159 case CS35L34_PROTECT_CTL: 160 case CS35L34_AMP_KEEP_ALIVE_CTL: 161 case CS35L34_BST_CVTR_V_CTL: 162 case CS35L34_BST_PEAK_I: 163 case CS35L34_BST_RAMP_CTL: 164 case CS35L34_BST_CONV_COEF_1: 165 case CS35L34_BST_CONV_COEF_2: 166 case CS35L34_BST_CONV_SLOPE_COMP: 167 case CS35L34_BST_CONV_SW_FREQ: 168 case CS35L34_CLASS_H_CTL: 169 case CS35L34_CLASS_H_HEADRM_CTL: 170 case CS35L34_CLASS_H_RELEASE_RATE: 171 case CS35L34_CLASS_H_FET_DRIVE_CTL: 172 case CS35L34_CLASS_H_STATUS: 173 case CS35L34_VPBR_CTL: 174 case CS35L34_VPBR_VOL_CTL: 175 case CS35L34_VPBR_TIMING_CTL: 176 case CS35L34_PRED_MAX_ATTEN_SPK_LOAD: 177 case CS35L34_PRED_BROWNOUT_THRESH: 178 case CS35L34_PRED_BROWNOUT_VOL_CTL: 179 case CS35L34_PRED_BROWNOUT_RATE_CTL: 180 case CS35L34_PRED_WAIT_CTL: 181 case CS35L34_PRED_ZVP_INIT_IMP_CTL: 182 case CS35L34_PRED_MAN_SAFE_VPI_CTL: 183 case CS35L34_VPBR_ATTEN_STATUS: 184 case CS35L34_PRED_BRWNOUT_ATT_STATUS: 185 case CS35L34_SPKR_MON_CTL: 186 case CS35L34_ADSP_I2S_CTL: 187 case CS35L34_ADSP_TDM_CTL: 188 case CS35L34_TDM_TX_CTL_1_VMON: 189 case CS35L34_TDM_TX_CTL_2_IMON: 190 case CS35L34_TDM_TX_CTL_3_VPMON: 191 case CS35L34_TDM_TX_CTL_4_VBSTMON: 192 case CS35L34_TDM_TX_CTL_5_FLAG1: 193 case CS35L34_TDM_TX_CTL_6_FLAG2: 194 case CS35L34_TDM_TX_SLOT_EN_1: 195 case CS35L34_TDM_TX_SLOT_EN_2: 196 case CS35L34_TDM_TX_SLOT_EN_3: 197 case CS35L34_TDM_TX_SLOT_EN_4: 198 case CS35L34_TDM_RX_CTL_1_AUDIN: 199 case CS35L34_TDM_RX_CTL_3_ALIVE: 200 case CS35L34_MULT_DEV_SYNCH1: 201 case CS35L34_MULT_DEV_SYNCH2: 202 case CS35L34_PROT_RELEASE_CTL: 203 case CS35L34_DIAG_MODE_REG_LOCK: 204 case CS35L34_DIAG_MODE_CTL_1: 205 case CS35L34_DIAG_MODE_CTL_2: 206 case CS35L34_INT_MASK_1: 207 case CS35L34_INT_MASK_2: 208 case CS35L34_INT_MASK_3: 209 case CS35L34_INT_MASK_4: 210 case CS35L34_INT_STATUS_1: 211 case CS35L34_INT_STATUS_2: 212 case CS35L34_INT_STATUS_3: 213 case CS35L34_INT_STATUS_4: 214 case CS35L34_OTP_TRIM_STATUS: 215 return true; 216 default: 217 return false; 218 } 219 } 220 221 static bool cs35l34_precious_register(struct device *dev, unsigned int reg) 222 { 223 switch (reg) { 224 case CS35L34_INT_STATUS_1: 225 case CS35L34_INT_STATUS_2: 226 case CS35L34_INT_STATUS_3: 227 case CS35L34_INT_STATUS_4: 228 return true; 229 default: 230 return false; 231 } 232 } 233 234 static int cs35l34_sdin_event(struct snd_soc_dapm_widget *w, 235 struct snd_kcontrol *kcontrol, int event) 236 { 237 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 238 struct cs35l34_private *priv = snd_soc_component_get_drvdata(component); 239 int ret; 240 241 switch (event) { 242 case SND_SOC_DAPM_PRE_PMU: 243 if (priv->tdm_mode) 244 regmap_update_bits(priv->regmap, CS35L34_PWRCTL3, 245 CS35L34_PDN_TDM, 0x00); 246 247 ret = regmap_update_bits(priv->regmap, CS35L34_PWRCTL1, 248 CS35L34_PDN_ALL, 0); 249 if (ret < 0) { 250 dev_err(component->dev, "Cannot set Power bits %d\n", ret); 251 return ret; 252 } 253 usleep_range(5000, 5100); 254 break; 255 case SND_SOC_DAPM_POST_PMD: 256 if (priv->tdm_mode) { 257 regmap_update_bits(priv->regmap, CS35L34_PWRCTL3, 258 CS35L34_PDN_TDM, CS35L34_PDN_TDM); 259 } 260 ret = regmap_update_bits(priv->regmap, CS35L34_PWRCTL1, 261 CS35L34_PDN_ALL, CS35L34_PDN_ALL); 262 break; 263 default: 264 pr_err("Invalid event = 0x%x\n", event); 265 } 266 return 0; 267 } 268 269 static int cs35l34_set_tdm_slot(struct snd_soc_dai *dai, unsigned int tx_mask, 270 unsigned int rx_mask, int slots, int slot_width) 271 { 272 struct snd_soc_component *component = dai->component; 273 struct cs35l34_private *priv = snd_soc_component_get_drvdata(component); 274 unsigned int reg, bit_pos; 275 int slot, slot_num; 276 277 if (slot_width != 8) 278 return -EINVAL; 279 280 priv->tdm_mode = true; 281 /* scan rx_mask for aud slot */ 282 slot = ffs(rx_mask) - 1; 283 if (slot >= 0) 284 snd_soc_component_update_bits(component, CS35L34_TDM_RX_CTL_1_AUDIN, 285 CS35L34_X_LOC, slot); 286 287 /* scan tx_mask: vmon(2 slots); imon (2 slots); vpmon (1 slot) 288 * vbstmon (1 slot) 289 */ 290 slot = ffs(tx_mask) - 1; 291 slot_num = 0; 292 293 /* disable vpmon/vbstmon: enable later if set in tx_mask */ 294 snd_soc_component_update_bits(component, CS35L34_TDM_TX_CTL_3_VPMON, 295 CS35L34_X_STATE | CS35L34_X_LOC, 296 CS35L34_X_STATE | CS35L34_X_LOC); 297 snd_soc_component_update_bits(component, CS35L34_TDM_TX_CTL_4_VBSTMON, 298 CS35L34_X_STATE | CS35L34_X_LOC, 299 CS35L34_X_STATE | CS35L34_X_LOC); 300 301 /* disconnect {vp,vbst}_mon routes: eanble later if set in tx_mask*/ 302 while (slot >= 0) { 303 /* configure VMON_TX_LOC */ 304 if (slot_num == 0) 305 snd_soc_component_update_bits(component, CS35L34_TDM_TX_CTL_1_VMON, 306 CS35L34_X_STATE | CS35L34_X_LOC, slot); 307 308 /* configure IMON_TX_LOC */ 309 if (slot_num == 4) { 310 snd_soc_component_update_bits(component, CS35L34_TDM_TX_CTL_2_IMON, 311 CS35L34_X_STATE | CS35L34_X_LOC, slot); 312 } 313 /* configure VPMON_TX_LOC */ 314 if (slot_num == 3) { 315 snd_soc_component_update_bits(component, CS35L34_TDM_TX_CTL_3_VPMON, 316 CS35L34_X_STATE | CS35L34_X_LOC, slot); 317 } 318 /* configure VBSTMON_TX_LOC */ 319 if (slot_num == 7) { 320 snd_soc_component_update_bits(component, 321 CS35L34_TDM_TX_CTL_4_VBSTMON, 322 CS35L34_X_STATE | CS35L34_X_LOC, slot); 323 } 324 325 /* Enable the relevant tx slot */ 326 reg = CS35L34_TDM_TX_SLOT_EN_4 - (slot/8); 327 bit_pos = slot - ((slot / 8) * (8)); 328 snd_soc_component_update_bits(component, reg, 329 1 << bit_pos, 1 << bit_pos); 330 331 tx_mask &= ~(1 << slot); 332 slot = ffs(tx_mask) - 1; 333 slot_num++; 334 } 335 336 return 0; 337 } 338 339 static int cs35l34_main_amp_event(struct snd_soc_dapm_widget *w, 340 struct snd_kcontrol *kcontrol, int event) 341 { 342 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 343 struct cs35l34_private *priv = snd_soc_component_get_drvdata(component); 344 345 switch (event) { 346 case SND_SOC_DAPM_POST_PMU: 347 regmap_update_bits(priv->regmap, CS35L34_BST_CVTR_V_CTL, 348 CS35L34_BST_CVTL_MASK, priv->pdata.boost_vtge); 349 usleep_range(5000, 5100); 350 regmap_update_bits(priv->regmap, CS35L34_PROTECT_CTL, 351 CS35L34_MUTE, 0); 352 break; 353 case SND_SOC_DAPM_POST_PMD: 354 regmap_update_bits(priv->regmap, CS35L34_BST_CVTR_V_CTL, 355 CS35L34_BST_CVTL_MASK, 0); 356 regmap_update_bits(priv->regmap, CS35L34_PROTECT_CTL, 357 CS35L34_MUTE, CS35L34_MUTE); 358 usleep_range(5000, 5100); 359 break; 360 default: 361 pr_err("Invalid event = 0x%x\n", event); 362 } 363 return 0; 364 } 365 366 static DECLARE_TLV_DB_SCALE(dig_vol_tlv, -10200, 50, 0); 367 368 static DECLARE_TLV_DB_SCALE(amp_gain_tlv, 300, 100, 0); 369 370 371 static const struct snd_kcontrol_new cs35l34_snd_controls[] = { 372 SOC_SINGLE_SX_TLV("Digital Volume", CS35L34_AMP_DIG_VOL, 373 0, 0x34, 0xE4, dig_vol_tlv), 374 SOC_SINGLE_TLV("Amp Gain Volume", CS35L34_AMP_ANLG_GAIN_CTL, 375 0, 0xF, 0, amp_gain_tlv), 376 }; 377 378 379 static int cs35l34_mclk_event(struct snd_soc_dapm_widget *w, 380 struct snd_kcontrol *kcontrol, int event) 381 { 382 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 383 struct cs35l34_private *priv = snd_soc_component_get_drvdata(component); 384 int ret, i; 385 unsigned int reg; 386 387 switch (event) { 388 case SND_SOC_DAPM_PRE_PMD: 389 ret = regmap_read(priv->regmap, CS35L34_AMP_DIG_VOL_CTL, 390 ®); 391 if (ret != 0) { 392 pr_err("%s regmap read failure %d\n", __func__, ret); 393 return ret; 394 } 395 if (reg & CS35L34_AMP_DIGSFT) 396 msleep(40); 397 else 398 usleep_range(2000, 2100); 399 400 for (i = 0; i < PDN_DONE_ATTEMPTS; i++) { 401 ret = regmap_read(priv->regmap, CS35L34_INT_STATUS_2, 402 ®); 403 if (ret != 0) { 404 pr_err("%s regmap read failure %d\n", 405 __func__, ret); 406 return ret; 407 } 408 if (reg & CS35L34_PDN_DONE) 409 break; 410 411 usleep_range(5000, 5100); 412 } 413 if (i == PDN_DONE_ATTEMPTS) 414 pr_err("%s Device did not power down properly\n", 415 __func__); 416 break; 417 default: 418 pr_err("Invalid event = 0x%x\n", event); 419 break; 420 } 421 return 0; 422 } 423 424 static const struct snd_soc_dapm_widget cs35l34_dapm_widgets[] = { 425 SND_SOC_DAPM_AIF_IN_E("SDIN", NULL, 0, CS35L34_PWRCTL3, 426 1, 1, cs35l34_sdin_event, 427 SND_SOC_DAPM_PRE_PMU | 428 SND_SOC_DAPM_POST_PMD), 429 SND_SOC_DAPM_AIF_OUT("SDOUT", NULL, 0, CS35L34_PWRCTL3, 2, 1), 430 431 SND_SOC_DAPM_SUPPLY("EXTCLK", CS35L34_PWRCTL3, 7, 1, 432 cs35l34_mclk_event, SND_SOC_DAPM_PRE_PMD), 433 434 SND_SOC_DAPM_OUTPUT("SPK"), 435 436 SND_SOC_DAPM_INPUT("VP"), 437 SND_SOC_DAPM_INPUT("VPST"), 438 SND_SOC_DAPM_INPUT("ISENSE"), 439 SND_SOC_DAPM_INPUT("VSENSE"), 440 441 SND_SOC_DAPM_ADC("VMON ADC", NULL, CS35L34_PWRCTL2, 7, 1), 442 SND_SOC_DAPM_ADC("IMON ADC", NULL, CS35L34_PWRCTL2, 6, 1), 443 SND_SOC_DAPM_ADC("VPMON ADC", NULL, CS35L34_PWRCTL3, 3, 1), 444 SND_SOC_DAPM_ADC("VBSTMON ADC", NULL, CS35L34_PWRCTL3, 4, 1), 445 SND_SOC_DAPM_ADC("CLASS H", NULL, CS35L34_PWRCTL2, 5, 1), 446 SND_SOC_DAPM_ADC("BOOST", NULL, CS35L34_PWRCTL2, 2, 1), 447 448 SND_SOC_DAPM_OUT_DRV_E("Main AMP", CS35L34_PWRCTL2, 0, 1, NULL, 0, 449 cs35l34_main_amp_event, SND_SOC_DAPM_POST_PMU | 450 SND_SOC_DAPM_POST_PMD), 451 }; 452 453 static const struct snd_soc_dapm_route cs35l34_audio_map[] = { 454 {"SDIN", NULL, "AMP Playback"}, 455 {"BOOST", NULL, "SDIN"}, 456 {"CLASS H", NULL, "BOOST"}, 457 {"Main AMP", NULL, "CLASS H"}, 458 {"SPK", NULL, "Main AMP"}, 459 460 {"VPMON ADC", NULL, "CLASS H"}, 461 {"VBSTMON ADC", NULL, "CLASS H"}, 462 {"SPK", NULL, "VPMON ADC"}, 463 {"SPK", NULL, "VBSTMON ADC"}, 464 465 {"IMON ADC", NULL, "ISENSE"}, 466 {"VMON ADC", NULL, "VSENSE"}, 467 {"SDOUT", NULL, "IMON ADC"}, 468 {"SDOUT", NULL, "VMON ADC"}, 469 {"AMP Capture", NULL, "SDOUT"}, 470 471 {"SDIN", NULL, "EXTCLK"}, 472 {"SDOUT", NULL, "EXTCLK"}, 473 }; 474 475 struct cs35l34_mclk_div { 476 int mclk; 477 int srate; 478 u8 adsp_rate; 479 }; 480 481 static struct cs35l34_mclk_div cs35l34_mclk_coeffs[] = { 482 483 /* MCLK, Sample Rate, adsp_rate */ 484 485 {5644800, 11025, 0x1}, 486 {5644800, 22050, 0x4}, 487 {5644800, 44100, 0x7}, 488 489 {6000000, 8000, 0x0}, 490 {6000000, 11025, 0x1}, 491 {6000000, 12000, 0x2}, 492 {6000000, 16000, 0x3}, 493 {6000000, 22050, 0x4}, 494 {6000000, 24000, 0x5}, 495 {6000000, 32000, 0x6}, 496 {6000000, 44100, 0x7}, 497 {6000000, 48000, 0x8}, 498 499 {6144000, 8000, 0x0}, 500 {6144000, 11025, 0x1}, 501 {6144000, 12000, 0x2}, 502 {6144000, 16000, 0x3}, 503 {6144000, 22050, 0x4}, 504 {6144000, 24000, 0x5}, 505 {6144000, 32000, 0x6}, 506 {6144000, 44100, 0x7}, 507 {6144000, 48000, 0x8}, 508 }; 509 510 static int cs35l34_get_mclk_coeff(int mclk, int srate) 511 { 512 int i; 513 514 for (i = 0; i < ARRAY_SIZE(cs35l34_mclk_coeffs); i++) { 515 if (cs35l34_mclk_coeffs[i].mclk == mclk && 516 cs35l34_mclk_coeffs[i].srate == srate) 517 return i; 518 } 519 return -EINVAL; 520 } 521 522 static int cs35l34_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt) 523 { 524 struct snd_soc_component *component = codec_dai->component; 525 struct cs35l34_private *priv = snd_soc_component_get_drvdata(component); 526 527 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { 528 case SND_SOC_DAIFMT_CBM_CFM: 529 regmap_update_bits(priv->regmap, CS35L34_ADSP_CLK_CTL, 530 0x80, 0x80); 531 break; 532 case SND_SOC_DAIFMT_CBS_CFS: 533 regmap_update_bits(priv->regmap, CS35L34_ADSP_CLK_CTL, 534 0x80, 0x00); 535 break; 536 default: 537 return -EINVAL; 538 } 539 return 0; 540 } 541 542 static int cs35l34_pcm_hw_params(struct snd_pcm_substream *substream, 543 struct snd_pcm_hw_params *params, 544 struct snd_soc_dai *dai) 545 { 546 struct snd_soc_component *component = dai->component; 547 struct cs35l34_private *priv = snd_soc_component_get_drvdata(component); 548 int srate = params_rate(params); 549 int ret; 550 551 int coeff = cs35l34_get_mclk_coeff(priv->mclk_int, srate); 552 553 if (coeff < 0) { 554 dev_err(component->dev, "ERROR: Invalid mclk %d and/or srate %d\n", 555 priv->mclk_int, srate); 556 return coeff; 557 } 558 559 ret = regmap_update_bits(priv->regmap, CS35L34_ADSP_CLK_CTL, 560 CS35L34_ADSP_RATE, cs35l34_mclk_coeffs[coeff].adsp_rate); 561 if (ret != 0) 562 dev_err(component->dev, "Failed to set clock state %d\n", ret); 563 564 return ret; 565 } 566 567 static const unsigned int cs35l34_src_rates[] = { 568 8000, 11025, 12000, 16000, 22050, 24000, 32000, 44100, 48000 569 }; 570 571 572 static const struct snd_pcm_hw_constraint_list cs35l34_constraints = { 573 .count = ARRAY_SIZE(cs35l34_src_rates), 574 .list = cs35l34_src_rates, 575 }; 576 577 static int cs35l34_pcm_startup(struct snd_pcm_substream *substream, 578 struct snd_soc_dai *dai) 579 { 580 581 snd_pcm_hw_constraint_list(substream->runtime, 0, 582 SNDRV_PCM_HW_PARAM_RATE, &cs35l34_constraints); 583 return 0; 584 } 585 586 587 static int cs35l34_set_tristate(struct snd_soc_dai *dai, int tristate) 588 { 589 590 struct snd_soc_component *component = dai->component; 591 592 if (tristate) 593 snd_soc_component_update_bits(component, CS35L34_PWRCTL3, 594 CS35L34_PDN_SDOUT, CS35L34_PDN_SDOUT); 595 else 596 snd_soc_component_update_bits(component, CS35L34_PWRCTL3, 597 CS35L34_PDN_SDOUT, 0); 598 return 0; 599 } 600 601 static int cs35l34_dai_set_sysclk(struct snd_soc_dai *dai, 602 int clk_id, unsigned int freq, int dir) 603 { 604 struct snd_soc_component *component = dai->component; 605 struct cs35l34_private *cs35l34 = snd_soc_component_get_drvdata(component); 606 unsigned int value; 607 608 switch (freq) { 609 case CS35L34_MCLK_5644: 610 value = CS35L34_MCLK_RATE_5P6448; 611 cs35l34->mclk_int = freq; 612 break; 613 case CS35L34_MCLK_6: 614 value = CS35L34_MCLK_RATE_6P0000; 615 cs35l34->mclk_int = freq; 616 break; 617 case CS35L34_MCLK_6144: 618 value = CS35L34_MCLK_RATE_6P1440; 619 cs35l34->mclk_int = freq; 620 break; 621 case CS35L34_MCLK_11289: 622 value = CS35L34_MCLK_DIV | CS35L34_MCLK_RATE_5P6448; 623 cs35l34->mclk_int = freq / 2; 624 break; 625 case CS35L34_MCLK_12: 626 value = CS35L34_MCLK_DIV | CS35L34_MCLK_RATE_6P0000; 627 cs35l34->mclk_int = freq / 2; 628 break; 629 case CS35L34_MCLK_12288: 630 value = CS35L34_MCLK_DIV | CS35L34_MCLK_RATE_6P1440; 631 cs35l34->mclk_int = freq / 2; 632 break; 633 default: 634 dev_err(component->dev, "ERROR: Invalid Frequency %d\n", freq); 635 cs35l34->mclk_int = 0; 636 return -EINVAL; 637 } 638 regmap_update_bits(cs35l34->regmap, CS35L34_MCLK_CTL, 639 CS35L34_MCLK_DIV | CS35L34_MCLK_RATE_MASK, value); 640 return 0; 641 } 642 643 static const struct snd_soc_dai_ops cs35l34_ops = { 644 .startup = cs35l34_pcm_startup, 645 .set_tristate = cs35l34_set_tristate, 646 .set_fmt = cs35l34_set_dai_fmt, 647 .hw_params = cs35l34_pcm_hw_params, 648 .set_sysclk = cs35l34_dai_set_sysclk, 649 .set_tdm_slot = cs35l34_set_tdm_slot, 650 }; 651 652 static struct snd_soc_dai_driver cs35l34_dai = { 653 .name = "cs35l34", 654 .id = 0, 655 .playback = { 656 .stream_name = "AMP Playback", 657 .channels_min = 1, 658 .channels_max = 8, 659 .rates = CS35L34_RATES, 660 .formats = CS35L34_FORMATS, 661 }, 662 .capture = { 663 .stream_name = "AMP Capture", 664 .channels_min = 1, 665 .channels_max = 8, 666 .rates = CS35L34_RATES, 667 .formats = CS35L34_FORMATS, 668 }, 669 .ops = &cs35l34_ops, 670 .symmetric_rate = 1, 671 }; 672 673 static int cs35l34_boost_inductor(struct cs35l34_private *cs35l34, 674 unsigned int inductor) 675 { 676 struct snd_soc_component *component = cs35l34->component; 677 678 switch (inductor) { 679 case 1000: /* 1 uH */ 680 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_1, 0x24); 681 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_2, 0x24); 682 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SLOPE_COMP, 683 0x4E); 684 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SW_FREQ, 0); 685 break; 686 case 1200: /* 1.2 uH */ 687 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_1, 0x20); 688 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_2, 0x20); 689 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SLOPE_COMP, 690 0x47); 691 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SW_FREQ, 1); 692 break; 693 case 1500: /* 1.5uH */ 694 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_1, 0x20); 695 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_2, 0x20); 696 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SLOPE_COMP, 697 0x3C); 698 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SW_FREQ, 2); 699 break; 700 case 2200: /* 2.2uH */ 701 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_1, 0x19); 702 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_2, 0x25); 703 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SLOPE_COMP, 704 0x23); 705 regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SW_FREQ, 3); 706 break; 707 default: 708 dev_err(component->dev, "%s Invalid Inductor Value %d uH\n", 709 __func__, inductor); 710 return -EINVAL; 711 } 712 return 0; 713 } 714 715 static int cs35l34_probe(struct snd_soc_component *component) 716 { 717 int ret = 0; 718 struct cs35l34_private *cs35l34 = snd_soc_component_get_drvdata(component); 719 720 pm_runtime_get_sync(component->dev); 721 722 /* Set over temperature warning attenuation to 6 dB */ 723 regmap_update_bits(cs35l34->regmap, CS35L34_PROTECT_CTL, 724 CS35L34_OTW_ATTN_MASK, 0x8); 725 726 /* Set Power control registers 2 and 3 to have everything 727 * powered down at initialization 728 */ 729 regmap_write(cs35l34->regmap, CS35L34_PWRCTL2, 0xFD); 730 regmap_write(cs35l34->regmap, CS35L34_PWRCTL3, 0x1F); 731 732 /* Set mute bit at startup */ 733 regmap_update_bits(cs35l34->regmap, CS35L34_PROTECT_CTL, 734 CS35L34_MUTE, CS35L34_MUTE); 735 736 /* Set Platform Data */ 737 if (cs35l34->pdata.boost_peak) 738 regmap_update_bits(cs35l34->regmap, CS35L34_BST_PEAK_I, 739 CS35L34_BST_PEAK_MASK, 740 cs35l34->pdata.boost_peak); 741 742 if (cs35l34->pdata.gain_zc_disable) 743 regmap_update_bits(cs35l34->regmap, CS35L34_PROTECT_CTL, 744 CS35L34_GAIN_ZC_MASK, 0); 745 else 746 regmap_update_bits(cs35l34->regmap, CS35L34_PROTECT_CTL, 747 CS35L34_GAIN_ZC_MASK, CS35L34_GAIN_ZC_MASK); 748 749 if (cs35l34->pdata.aif_half_drv) 750 regmap_update_bits(cs35l34->regmap, CS35L34_ADSP_CLK_CTL, 751 CS35L34_ADSP_DRIVE, 0); 752 753 if (cs35l34->pdata.digsft_disable) 754 regmap_update_bits(cs35l34->regmap, CS35L34_AMP_DIG_VOL_CTL, 755 CS35L34_AMP_DIGSFT, 0); 756 757 if (cs35l34->pdata.amp_inv) 758 regmap_update_bits(cs35l34->regmap, CS35L34_AMP_DIG_VOL_CTL, 759 CS35L34_INV, CS35L34_INV); 760 761 if (cs35l34->pdata.boost_ind) 762 ret = cs35l34_boost_inductor(cs35l34, cs35l34->pdata.boost_ind); 763 764 if (cs35l34->pdata.i2s_sdinloc) 765 regmap_update_bits(cs35l34->regmap, CS35L34_ADSP_I2S_CTL, 766 CS35L34_I2S_LOC_MASK, 767 cs35l34->pdata.i2s_sdinloc << CS35L34_I2S_LOC_SHIFT); 768 769 if (cs35l34->pdata.tdm_rising_edge) 770 regmap_update_bits(cs35l34->regmap, CS35L34_ADSP_TDM_CTL, 771 1, 1); 772 773 pm_runtime_put_sync(component->dev); 774 775 return ret; 776 } 777 778 779 static const struct snd_soc_component_driver soc_component_dev_cs35l34 = { 780 .probe = cs35l34_probe, 781 .dapm_widgets = cs35l34_dapm_widgets, 782 .num_dapm_widgets = ARRAY_SIZE(cs35l34_dapm_widgets), 783 .dapm_routes = cs35l34_audio_map, 784 .num_dapm_routes = ARRAY_SIZE(cs35l34_audio_map), 785 .controls = cs35l34_snd_controls, 786 .num_controls = ARRAY_SIZE(cs35l34_snd_controls), 787 .idle_bias_on = 1, 788 .use_pmdown_time = 1, 789 .endianness = 1, 790 .non_legacy_dai_naming = 1, 791 }; 792 793 static struct regmap_config cs35l34_regmap = { 794 .reg_bits = 8, 795 .val_bits = 8, 796 797 .max_register = CS35L34_MAX_REGISTER, 798 .reg_defaults = cs35l34_reg, 799 .num_reg_defaults = ARRAY_SIZE(cs35l34_reg), 800 .volatile_reg = cs35l34_volatile_register, 801 .readable_reg = cs35l34_readable_register, 802 .precious_reg = cs35l34_precious_register, 803 .cache_type = REGCACHE_RBTREE, 804 805 .use_single_read = true, 806 .use_single_write = true, 807 }; 808 809 static int cs35l34_handle_of_data(struct i2c_client *i2c_client, 810 struct cs35l34_platform_data *pdata) 811 { 812 struct device_node *np = i2c_client->dev.of_node; 813 unsigned int val; 814 815 if (of_property_read_u32(np, "cirrus,boost-vtge-millivolt", 816 &val) >= 0) { 817 /* Boost Voltage has a maximum of 8V */ 818 if (val > 8000 || (val < 3300 && val > 0)) { 819 dev_err(&i2c_client->dev, 820 "Invalid Boost Voltage %d mV\n", val); 821 return -EINVAL; 822 } 823 if (val == 0) 824 pdata->boost_vtge = 0; /* Use VP */ 825 else 826 pdata->boost_vtge = ((val - 3300)/100) + 1; 827 } else { 828 dev_warn(&i2c_client->dev, 829 "Boost Voltage not specified. Using VP\n"); 830 } 831 832 if (of_property_read_u32(np, "cirrus,boost-ind-nanohenry", &val) >= 0) { 833 pdata->boost_ind = val; 834 } else { 835 dev_err(&i2c_client->dev, "Inductor not specified.\n"); 836 return -EINVAL; 837 } 838 839 if (of_property_read_u32(np, "cirrus,boost-peak-milliamp", &val) >= 0) { 840 if (val > 3840 || val < 1200) { 841 dev_err(&i2c_client->dev, 842 "Invalid Boost Peak Current %d mA\n", val); 843 return -EINVAL; 844 } 845 pdata->boost_peak = ((val - 1200)/80) + 1; 846 } 847 848 pdata->aif_half_drv = of_property_read_bool(np, 849 "cirrus,aif-half-drv"); 850 pdata->digsft_disable = of_property_read_bool(np, 851 "cirrus,digsft-disable"); 852 853 pdata->gain_zc_disable = of_property_read_bool(np, 854 "cirrus,gain-zc-disable"); 855 pdata->amp_inv = of_property_read_bool(np, "cirrus,amp-inv"); 856 857 if (of_property_read_u32(np, "cirrus,i2s-sdinloc", &val) >= 0) 858 pdata->i2s_sdinloc = val; 859 if (of_property_read_u32(np, "cirrus,tdm-rising-edge", &val) >= 0) 860 pdata->tdm_rising_edge = val; 861 862 return 0; 863 } 864 865 static irqreturn_t cs35l34_irq_thread(int irq, void *data) 866 { 867 struct cs35l34_private *cs35l34 = data; 868 struct snd_soc_component *component = cs35l34->component; 869 unsigned int sticky1, sticky2, sticky3, sticky4; 870 unsigned int mask1, mask2, mask3, mask4, current1; 871 872 873 /* ack the irq by reading all status registers */ 874 regmap_read(cs35l34->regmap, CS35L34_INT_STATUS_4, &sticky4); 875 regmap_read(cs35l34->regmap, CS35L34_INT_STATUS_3, &sticky3); 876 regmap_read(cs35l34->regmap, CS35L34_INT_STATUS_2, &sticky2); 877 regmap_read(cs35l34->regmap, CS35L34_INT_STATUS_1, &sticky1); 878 879 regmap_read(cs35l34->regmap, CS35L34_INT_MASK_4, &mask4); 880 regmap_read(cs35l34->regmap, CS35L34_INT_MASK_3, &mask3); 881 regmap_read(cs35l34->regmap, CS35L34_INT_MASK_2, &mask2); 882 regmap_read(cs35l34->regmap, CS35L34_INT_MASK_1, &mask1); 883 884 if (!(sticky1 & ~mask1) && !(sticky2 & ~mask2) && !(sticky3 & ~mask3) 885 && !(sticky4 & ~mask4)) 886 return IRQ_NONE; 887 888 regmap_read(cs35l34->regmap, CS35L34_INT_STATUS_1, ¤t1); 889 890 if (sticky1 & CS35L34_CAL_ERR) { 891 dev_err(component->dev, "Cal error\n"); 892 893 /* error is no longer asserted; safe to reset */ 894 if (!(current1 & CS35L34_CAL_ERR)) { 895 dev_dbg(component->dev, "Cal error release\n"); 896 regmap_update_bits(cs35l34->regmap, 897 CS35L34_PROT_RELEASE_CTL, 898 CS35L34_CAL_ERR_RLS, 0); 899 regmap_update_bits(cs35l34->regmap, 900 CS35L34_PROT_RELEASE_CTL, 901 CS35L34_CAL_ERR_RLS, 902 CS35L34_CAL_ERR_RLS); 903 regmap_update_bits(cs35l34->regmap, 904 CS35L34_PROT_RELEASE_CTL, 905 CS35L34_CAL_ERR_RLS, 0); 906 /* note: amp will re-calibrate on next resume */ 907 } 908 } 909 910 if (sticky1 & CS35L34_ALIVE_ERR) 911 dev_err(component->dev, "Alive error\n"); 912 913 if (sticky1 & CS35L34_AMP_SHORT) { 914 dev_crit(component->dev, "Amp short error\n"); 915 916 /* error is no longer asserted; safe to reset */ 917 if (!(current1 & CS35L34_AMP_SHORT)) { 918 dev_dbg(component->dev, 919 "Amp short error release\n"); 920 regmap_update_bits(cs35l34->regmap, 921 CS35L34_PROT_RELEASE_CTL, 922 CS35L34_SHORT_RLS, 0); 923 regmap_update_bits(cs35l34->regmap, 924 CS35L34_PROT_RELEASE_CTL, 925 CS35L34_SHORT_RLS, 926 CS35L34_SHORT_RLS); 927 regmap_update_bits(cs35l34->regmap, 928 CS35L34_PROT_RELEASE_CTL, 929 CS35L34_SHORT_RLS, 0); 930 } 931 } 932 933 if (sticky1 & CS35L34_OTW) { 934 dev_crit(component->dev, "Over temperature warning\n"); 935 936 /* error is no longer asserted; safe to reset */ 937 if (!(current1 & CS35L34_OTW)) { 938 dev_dbg(component->dev, 939 "Over temperature warning release\n"); 940 regmap_update_bits(cs35l34->regmap, 941 CS35L34_PROT_RELEASE_CTL, 942 CS35L34_OTW_RLS, 0); 943 regmap_update_bits(cs35l34->regmap, 944 CS35L34_PROT_RELEASE_CTL, 945 CS35L34_OTW_RLS, 946 CS35L34_OTW_RLS); 947 regmap_update_bits(cs35l34->regmap, 948 CS35L34_PROT_RELEASE_CTL, 949 CS35L34_OTW_RLS, 0); 950 } 951 } 952 953 if (sticky1 & CS35L34_OTE) { 954 dev_crit(component->dev, "Over temperature error\n"); 955 956 /* error is no longer asserted; safe to reset */ 957 if (!(current1 & CS35L34_OTE)) { 958 dev_dbg(component->dev, 959 "Over temperature error release\n"); 960 regmap_update_bits(cs35l34->regmap, 961 CS35L34_PROT_RELEASE_CTL, 962 CS35L34_OTE_RLS, 0); 963 regmap_update_bits(cs35l34->regmap, 964 CS35L34_PROT_RELEASE_CTL, 965 CS35L34_OTE_RLS, 966 CS35L34_OTE_RLS); 967 regmap_update_bits(cs35l34->regmap, 968 CS35L34_PROT_RELEASE_CTL, 969 CS35L34_OTE_RLS, 0); 970 } 971 } 972 973 if (sticky3 & CS35L34_BST_HIGH) { 974 dev_crit(component->dev, "VBST too high error; powering off!\n"); 975 regmap_update_bits(cs35l34->regmap, CS35L34_PWRCTL2, 976 CS35L34_PDN_AMP, CS35L34_PDN_AMP); 977 regmap_update_bits(cs35l34->regmap, CS35L34_PWRCTL1, 978 CS35L34_PDN_ALL, CS35L34_PDN_ALL); 979 } 980 981 if (sticky3 & CS35L34_LBST_SHORT) { 982 dev_crit(component->dev, "LBST short error; powering off!\n"); 983 regmap_update_bits(cs35l34->regmap, CS35L34_PWRCTL2, 984 CS35L34_PDN_AMP, CS35L34_PDN_AMP); 985 regmap_update_bits(cs35l34->regmap, CS35L34_PWRCTL1, 986 CS35L34_PDN_ALL, CS35L34_PDN_ALL); 987 } 988 989 return IRQ_HANDLED; 990 } 991 992 static const char * const cs35l34_core_supplies[] = { 993 "VA", 994 "VP", 995 }; 996 997 static int cs35l34_i2c_probe(struct i2c_client *i2c_client) 998 { 999 struct cs35l34_private *cs35l34; 1000 struct cs35l34_platform_data *pdata = 1001 dev_get_platdata(&i2c_client->dev); 1002 int i, devid; 1003 int ret; 1004 unsigned int reg; 1005 1006 cs35l34 = devm_kzalloc(&i2c_client->dev, sizeof(*cs35l34), GFP_KERNEL); 1007 if (!cs35l34) 1008 return -ENOMEM; 1009 1010 i2c_set_clientdata(i2c_client, cs35l34); 1011 cs35l34->regmap = devm_regmap_init_i2c(i2c_client, &cs35l34_regmap); 1012 if (IS_ERR(cs35l34->regmap)) { 1013 ret = PTR_ERR(cs35l34->regmap); 1014 dev_err(&i2c_client->dev, "regmap_init() failed: %d\n", ret); 1015 return ret; 1016 } 1017 1018 cs35l34->num_core_supplies = ARRAY_SIZE(cs35l34_core_supplies); 1019 for (i = 0; i < ARRAY_SIZE(cs35l34_core_supplies); i++) 1020 cs35l34->core_supplies[i].supply = cs35l34_core_supplies[i]; 1021 1022 ret = devm_regulator_bulk_get(&i2c_client->dev, 1023 cs35l34->num_core_supplies, 1024 cs35l34->core_supplies); 1025 if (ret != 0) { 1026 dev_err(&i2c_client->dev, 1027 "Failed to request core supplies %d\n", ret); 1028 return ret; 1029 } 1030 1031 ret = regulator_bulk_enable(cs35l34->num_core_supplies, 1032 cs35l34->core_supplies); 1033 if (ret != 0) { 1034 dev_err(&i2c_client->dev, 1035 "Failed to enable core supplies: %d\n", ret); 1036 return ret; 1037 } 1038 1039 if (pdata) { 1040 cs35l34->pdata = *pdata; 1041 } else { 1042 pdata = devm_kzalloc(&i2c_client->dev, sizeof(*pdata), 1043 GFP_KERNEL); 1044 if (!pdata) { 1045 ret = -ENOMEM; 1046 goto err_regulator; 1047 } 1048 1049 if (i2c_client->dev.of_node) { 1050 ret = cs35l34_handle_of_data(i2c_client, pdata); 1051 if (ret != 0) 1052 goto err_regulator; 1053 1054 } 1055 cs35l34->pdata = *pdata; 1056 } 1057 1058 ret = devm_request_threaded_irq(&i2c_client->dev, i2c_client->irq, NULL, 1059 cs35l34_irq_thread, IRQF_ONESHOT | IRQF_TRIGGER_LOW, 1060 "cs35l34", cs35l34); 1061 if (ret != 0) 1062 dev_err(&i2c_client->dev, "Failed to request IRQ: %d\n", ret); 1063 1064 cs35l34->reset_gpio = devm_gpiod_get_optional(&i2c_client->dev, 1065 "reset-gpios", GPIOD_OUT_LOW); 1066 if (IS_ERR(cs35l34->reset_gpio)) { 1067 ret = PTR_ERR(cs35l34->reset_gpio); 1068 goto err_regulator; 1069 } 1070 1071 gpiod_set_value_cansleep(cs35l34->reset_gpio, 1); 1072 1073 msleep(CS35L34_START_DELAY); 1074 1075 devid = cirrus_read_device_id(cs35l34->regmap, CS35L34_DEVID_AB); 1076 if (devid < 0) { 1077 ret = devid; 1078 dev_err(&i2c_client->dev, "Failed to read device ID: %d\n", ret); 1079 goto err_reset; 1080 } 1081 1082 if (devid != CS35L34_CHIP_ID) { 1083 dev_err(&i2c_client->dev, 1084 "CS35l34 Device ID (%X). Expected ID %X\n", 1085 devid, CS35L34_CHIP_ID); 1086 ret = -ENODEV; 1087 goto err_reset; 1088 } 1089 1090 ret = regmap_read(cs35l34->regmap, CS35L34_REV_ID, ®); 1091 if (ret < 0) { 1092 dev_err(&i2c_client->dev, "Get Revision ID failed\n"); 1093 goto err_reset; 1094 } 1095 1096 dev_info(&i2c_client->dev, 1097 "Cirrus Logic CS35l34 (%x), Revision: %02X\n", devid, 1098 reg & 0xFF); 1099 1100 /* Unmask critical interrupts */ 1101 regmap_update_bits(cs35l34->regmap, CS35L34_INT_MASK_1, 1102 CS35L34_M_CAL_ERR | CS35L34_M_ALIVE_ERR | 1103 CS35L34_M_AMP_SHORT | CS35L34_M_OTW | 1104 CS35L34_M_OTE, 0); 1105 regmap_update_bits(cs35l34->regmap, CS35L34_INT_MASK_3, 1106 CS35L34_M_BST_HIGH | CS35L34_M_LBST_SHORT, 0); 1107 1108 pm_runtime_set_autosuspend_delay(&i2c_client->dev, 100); 1109 pm_runtime_use_autosuspend(&i2c_client->dev); 1110 pm_runtime_set_active(&i2c_client->dev); 1111 pm_runtime_enable(&i2c_client->dev); 1112 1113 ret = devm_snd_soc_register_component(&i2c_client->dev, 1114 &soc_component_dev_cs35l34, &cs35l34_dai, 1); 1115 if (ret < 0) { 1116 dev_err(&i2c_client->dev, 1117 "%s: Register component failed\n", __func__); 1118 goto err_reset; 1119 } 1120 1121 return 0; 1122 1123 err_reset: 1124 gpiod_set_value_cansleep(cs35l34->reset_gpio, 0); 1125 err_regulator: 1126 regulator_bulk_disable(cs35l34->num_core_supplies, 1127 cs35l34->core_supplies); 1128 1129 return ret; 1130 } 1131 1132 static int cs35l34_i2c_remove(struct i2c_client *client) 1133 { 1134 struct cs35l34_private *cs35l34 = i2c_get_clientdata(client); 1135 1136 gpiod_set_value_cansleep(cs35l34->reset_gpio, 0); 1137 1138 pm_runtime_disable(&client->dev); 1139 regulator_bulk_disable(cs35l34->num_core_supplies, 1140 cs35l34->core_supplies); 1141 1142 return 0; 1143 } 1144 1145 static int __maybe_unused cs35l34_runtime_resume(struct device *dev) 1146 { 1147 struct cs35l34_private *cs35l34 = dev_get_drvdata(dev); 1148 int ret; 1149 1150 ret = regulator_bulk_enable(cs35l34->num_core_supplies, 1151 cs35l34->core_supplies); 1152 1153 if (ret != 0) { 1154 dev_err(dev, "Failed to enable core supplies: %d\n", 1155 ret); 1156 return ret; 1157 } 1158 1159 regcache_cache_only(cs35l34->regmap, false); 1160 1161 gpiod_set_value_cansleep(cs35l34->reset_gpio, 1); 1162 msleep(CS35L34_START_DELAY); 1163 1164 ret = regcache_sync(cs35l34->regmap); 1165 if (ret != 0) { 1166 dev_err(dev, "Failed to restore register cache\n"); 1167 goto err; 1168 } 1169 return 0; 1170 err: 1171 regcache_cache_only(cs35l34->regmap, true); 1172 regulator_bulk_disable(cs35l34->num_core_supplies, 1173 cs35l34->core_supplies); 1174 1175 return ret; 1176 } 1177 1178 static int __maybe_unused cs35l34_runtime_suspend(struct device *dev) 1179 { 1180 struct cs35l34_private *cs35l34 = dev_get_drvdata(dev); 1181 1182 regcache_cache_only(cs35l34->regmap, true); 1183 regcache_mark_dirty(cs35l34->regmap); 1184 1185 gpiod_set_value_cansleep(cs35l34->reset_gpio, 0); 1186 1187 regulator_bulk_disable(cs35l34->num_core_supplies, 1188 cs35l34->core_supplies); 1189 1190 return 0; 1191 } 1192 1193 static const struct dev_pm_ops cs35l34_pm_ops = { 1194 SET_RUNTIME_PM_OPS(cs35l34_runtime_suspend, 1195 cs35l34_runtime_resume, 1196 NULL) 1197 }; 1198 1199 static const struct of_device_id cs35l34_of_match[] = { 1200 {.compatible = "cirrus,cs35l34"}, 1201 {}, 1202 }; 1203 MODULE_DEVICE_TABLE(of, cs35l34_of_match); 1204 1205 static const struct i2c_device_id cs35l34_id[] = { 1206 {"cs35l34", 0}, 1207 {} 1208 }; 1209 MODULE_DEVICE_TABLE(i2c, cs35l34_id); 1210 1211 static struct i2c_driver cs35l34_i2c_driver = { 1212 .driver = { 1213 .name = "cs35l34", 1214 .pm = &cs35l34_pm_ops, 1215 .of_match_table = cs35l34_of_match, 1216 1217 }, 1218 .id_table = cs35l34_id, 1219 .probe_new = cs35l34_i2c_probe, 1220 .remove = cs35l34_i2c_remove, 1221 1222 }; 1223 1224 static int __init cs35l34_modinit(void) 1225 { 1226 int ret; 1227 1228 ret = i2c_add_driver(&cs35l34_i2c_driver); 1229 if (ret != 0) { 1230 pr_err("Failed to register CS35l34 I2C driver: %d\n", ret); 1231 return ret; 1232 } 1233 return 0; 1234 } 1235 module_init(cs35l34_modinit); 1236 1237 static void __exit cs35l34_exit(void) 1238 { 1239 i2c_del_driver(&cs35l34_i2c_driver); 1240 } 1241 module_exit(cs35l34_exit); 1242 1243 MODULE_DESCRIPTION("ASoC CS35l34 driver"); 1244 MODULE_AUTHOR("Paul Handrigan, Cirrus Logic Inc, <Paul.Handrigan@cirrus.com>"); 1245 MODULE_LICENSE("GPL"); 1246