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