root/sound/soc/codecs/pcm512x.c

/* [<][>][^][v][top][bottom][index][help] */

DEFINITIONS

This source file includes following definitions.
  1. pcm512x_readable
  2. pcm512x_volatile
  3. pcm512x_overclock_pll_get
  4. pcm512x_overclock_pll_put
  5. pcm512x_overclock_dsp_get
  6. pcm512x_overclock_dsp_put
  7. pcm512x_overclock_dac_get
  8. pcm512x_overclock_dac_put
  9. pcm512x_update_mute
  10. pcm512x_digital_playback_switch_get
  11. pcm512x_digital_playback_switch_put
  12. pcm512x_pll_max
  13. pcm512x_dsp_max
  14. pcm512x_dac_max
  15. pcm512x_sck_max
  16. pcm512x_ncp_target
  17. pcm512x_hw_rule_rate
  18. pcm512x_dai_startup_master
  19. pcm512x_dai_startup_slave
  20. pcm512x_dai_startup
  21. pcm512x_set_bias_level
  22. pcm512x_find_sck
  23. pcm512x_find_pll_coeff
  24. pcm512x_pllin_dac_rate
  25. pcm512x_set_dividers
  26. pcm512x_hw_params
  27. pcm512x_set_fmt
  28. pcm512x_set_bclk_ratio
  29. pcm512x_digital_mute
  30. pcm512x_probe
  31. pcm512x_remove
  32. pcm512x_suspend
  33. pcm512x_resume

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Driver for the PCM512x CODECs
   4  *
   5  * Author:      Mark Brown <broonie@kernel.org>
   6  *              Copyright 2014 Linaro Ltd
   7  */
   8 
   9 
  10 #include <linux/init.h>
  11 #include <linux/module.h>
  12 #include <linux/clk.h>
  13 #include <linux/kernel.h>
  14 #include <linux/pm_runtime.h>
  15 #include <linux/regmap.h>
  16 #include <linux/regulator/consumer.h>
  17 #include <linux/gcd.h>
  18 #include <sound/soc.h>
  19 #include <sound/soc-dapm.h>
  20 #include <sound/pcm_params.h>
  21 #include <sound/tlv.h>
  22 
  23 #include "pcm512x.h"
  24 
  25 #define PCM512x_NUM_SUPPLIES 3
  26 static const char * const pcm512x_supply_names[PCM512x_NUM_SUPPLIES] = {
  27         "AVDD",
  28         "DVDD",
  29         "CPVDD",
  30 };
  31 
  32 struct pcm512x_priv {
  33         struct regmap *regmap;
  34         struct clk *sclk;
  35         struct regulator_bulk_data supplies[PCM512x_NUM_SUPPLIES];
  36         struct notifier_block supply_nb[PCM512x_NUM_SUPPLIES];
  37         int fmt;
  38         int pll_in;
  39         int pll_out;
  40         int pll_r;
  41         int pll_j;
  42         int pll_d;
  43         int pll_p;
  44         unsigned long real_pll;
  45         unsigned long overclock_pll;
  46         unsigned long overclock_dac;
  47         unsigned long overclock_dsp;
  48         int mute;
  49         struct mutex mutex;
  50         unsigned int bclk_ratio;
  51 };
  52 
  53 /*
  54  * We can't use the same notifier block for more than one supply and
  55  * there's no way I can see to get from a callback to the caller
  56  * except container_of().
  57  */
  58 #define PCM512x_REGULATOR_EVENT(n) \
  59 static int pcm512x_regulator_event_##n(struct notifier_block *nb, \
  60                                       unsigned long event, void *data)    \
  61 { \
  62         struct pcm512x_priv *pcm512x = container_of(nb, struct pcm512x_priv, \
  63                                                     supply_nb[n]); \
  64         if (event & REGULATOR_EVENT_DISABLE) { \
  65                 regcache_mark_dirty(pcm512x->regmap);   \
  66                 regcache_cache_only(pcm512x->regmap, true);     \
  67         } \
  68         return 0; \
  69 }
  70 
  71 PCM512x_REGULATOR_EVENT(0)
  72 PCM512x_REGULATOR_EVENT(1)
  73 PCM512x_REGULATOR_EVENT(2)
  74 
  75 static const struct reg_default pcm512x_reg_defaults[] = {
  76         { PCM512x_RESET,             0x00 },
  77         { PCM512x_POWER,             0x00 },
  78         { PCM512x_MUTE,              0x00 },
  79         { PCM512x_DSP,               0x00 },
  80         { PCM512x_PLL_REF,           0x00 },
  81         { PCM512x_DAC_REF,           0x00 },
  82         { PCM512x_DAC_ROUTING,       0x11 },
  83         { PCM512x_DSP_PROGRAM,       0x01 },
  84         { PCM512x_CLKDET,            0x00 },
  85         { PCM512x_AUTO_MUTE,         0x00 },
  86         { PCM512x_ERROR_DETECT,      0x00 },
  87         { PCM512x_DIGITAL_VOLUME_1,  0x00 },
  88         { PCM512x_DIGITAL_VOLUME_2,  0x30 },
  89         { PCM512x_DIGITAL_VOLUME_3,  0x30 },
  90         { PCM512x_DIGITAL_MUTE_1,    0x22 },
  91         { PCM512x_DIGITAL_MUTE_2,    0x00 },
  92         { PCM512x_DIGITAL_MUTE_3,    0x07 },
  93         { PCM512x_OUTPUT_AMPLITUDE,  0x00 },
  94         { PCM512x_ANALOG_GAIN_CTRL,  0x00 },
  95         { PCM512x_UNDERVOLTAGE_PROT, 0x00 },
  96         { PCM512x_ANALOG_MUTE_CTRL,  0x00 },
  97         { PCM512x_ANALOG_GAIN_BOOST, 0x00 },
  98         { PCM512x_VCOM_CTRL_1,       0x00 },
  99         { PCM512x_VCOM_CTRL_2,       0x01 },
 100         { PCM512x_BCLK_LRCLK_CFG,    0x00 },
 101         { PCM512x_MASTER_MODE,       0x7c },
 102         { PCM512x_GPIO_DACIN,        0x00 },
 103         { PCM512x_GPIO_PLLIN,        0x00 },
 104         { PCM512x_SYNCHRONIZE,       0x10 },
 105         { PCM512x_PLL_COEFF_0,       0x00 },
 106         { PCM512x_PLL_COEFF_1,       0x00 },
 107         { PCM512x_PLL_COEFF_2,       0x00 },
 108         { PCM512x_PLL_COEFF_3,       0x00 },
 109         { PCM512x_PLL_COEFF_4,       0x00 },
 110         { PCM512x_DSP_CLKDIV,        0x00 },
 111         { PCM512x_DAC_CLKDIV,        0x00 },
 112         { PCM512x_NCP_CLKDIV,        0x00 },
 113         { PCM512x_OSR_CLKDIV,        0x00 },
 114         { PCM512x_MASTER_CLKDIV_1,   0x00 },
 115         { PCM512x_MASTER_CLKDIV_2,   0x00 },
 116         { PCM512x_FS_SPEED_MODE,     0x00 },
 117         { PCM512x_IDAC_1,            0x01 },
 118         { PCM512x_IDAC_2,            0x00 },
 119 };
 120 
 121 static bool pcm512x_readable(struct device *dev, unsigned int reg)
 122 {
 123         switch (reg) {
 124         case PCM512x_RESET:
 125         case PCM512x_POWER:
 126         case PCM512x_MUTE:
 127         case PCM512x_PLL_EN:
 128         case PCM512x_SPI_MISO_FUNCTION:
 129         case PCM512x_DSP:
 130         case PCM512x_GPIO_EN:
 131         case PCM512x_BCLK_LRCLK_CFG:
 132         case PCM512x_DSP_GPIO_INPUT:
 133         case PCM512x_MASTER_MODE:
 134         case PCM512x_PLL_REF:
 135         case PCM512x_DAC_REF:
 136         case PCM512x_GPIO_DACIN:
 137         case PCM512x_GPIO_PLLIN:
 138         case PCM512x_SYNCHRONIZE:
 139         case PCM512x_PLL_COEFF_0:
 140         case PCM512x_PLL_COEFF_1:
 141         case PCM512x_PLL_COEFF_2:
 142         case PCM512x_PLL_COEFF_3:
 143         case PCM512x_PLL_COEFF_4:
 144         case PCM512x_DSP_CLKDIV:
 145         case PCM512x_DAC_CLKDIV:
 146         case PCM512x_NCP_CLKDIV:
 147         case PCM512x_OSR_CLKDIV:
 148         case PCM512x_MASTER_CLKDIV_1:
 149         case PCM512x_MASTER_CLKDIV_2:
 150         case PCM512x_FS_SPEED_MODE:
 151         case PCM512x_IDAC_1:
 152         case PCM512x_IDAC_2:
 153         case PCM512x_ERROR_DETECT:
 154         case PCM512x_I2S_1:
 155         case PCM512x_I2S_2:
 156         case PCM512x_DAC_ROUTING:
 157         case PCM512x_DSP_PROGRAM:
 158         case PCM512x_CLKDET:
 159         case PCM512x_AUTO_MUTE:
 160         case PCM512x_DIGITAL_VOLUME_1:
 161         case PCM512x_DIGITAL_VOLUME_2:
 162         case PCM512x_DIGITAL_VOLUME_3:
 163         case PCM512x_DIGITAL_MUTE_1:
 164         case PCM512x_DIGITAL_MUTE_2:
 165         case PCM512x_DIGITAL_MUTE_3:
 166         case PCM512x_GPIO_OUTPUT_1:
 167         case PCM512x_GPIO_OUTPUT_2:
 168         case PCM512x_GPIO_OUTPUT_3:
 169         case PCM512x_GPIO_OUTPUT_4:
 170         case PCM512x_GPIO_OUTPUT_5:
 171         case PCM512x_GPIO_OUTPUT_6:
 172         case PCM512x_GPIO_CONTROL_1:
 173         case PCM512x_GPIO_CONTROL_2:
 174         case PCM512x_OVERFLOW:
 175         case PCM512x_RATE_DET_1:
 176         case PCM512x_RATE_DET_2:
 177         case PCM512x_RATE_DET_3:
 178         case PCM512x_RATE_DET_4:
 179         case PCM512x_CLOCK_STATUS:
 180         case PCM512x_ANALOG_MUTE_DET:
 181         case PCM512x_GPIN:
 182         case PCM512x_DIGITAL_MUTE_DET:
 183         case PCM512x_OUTPUT_AMPLITUDE:
 184         case PCM512x_ANALOG_GAIN_CTRL:
 185         case PCM512x_UNDERVOLTAGE_PROT:
 186         case PCM512x_ANALOG_MUTE_CTRL:
 187         case PCM512x_ANALOG_GAIN_BOOST:
 188         case PCM512x_VCOM_CTRL_1:
 189         case PCM512x_VCOM_CTRL_2:
 190         case PCM512x_CRAM_CTRL:
 191         case PCM512x_FLEX_A:
 192         case PCM512x_FLEX_B:
 193                 return true;
 194         default:
 195                 /* There are 256 raw register addresses */
 196                 return reg < 0xff;
 197         }
 198 }
 199 
 200 static bool pcm512x_volatile(struct device *dev, unsigned int reg)
 201 {
 202         switch (reg) {
 203         case PCM512x_PLL_EN:
 204         case PCM512x_OVERFLOW:
 205         case PCM512x_RATE_DET_1:
 206         case PCM512x_RATE_DET_2:
 207         case PCM512x_RATE_DET_3:
 208         case PCM512x_RATE_DET_4:
 209         case PCM512x_CLOCK_STATUS:
 210         case PCM512x_ANALOG_MUTE_DET:
 211         case PCM512x_GPIN:
 212         case PCM512x_DIGITAL_MUTE_DET:
 213         case PCM512x_CRAM_CTRL:
 214                 return true;
 215         default:
 216                 /* There are 256 raw register addresses */
 217                 return reg < 0xff;
 218         }
 219 }
 220 
 221 static int pcm512x_overclock_pll_get(struct snd_kcontrol *kcontrol,
 222                                      struct snd_ctl_elem_value *ucontrol)
 223 {
 224         struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 225         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
 226 
 227         ucontrol->value.integer.value[0] = pcm512x->overclock_pll;
 228         return 0;
 229 }
 230 
 231 static int pcm512x_overclock_pll_put(struct snd_kcontrol *kcontrol,
 232                                      struct snd_ctl_elem_value *ucontrol)
 233 {
 234         struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 235         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
 236 
 237         switch (snd_soc_component_get_bias_level(component)) {
 238         case SND_SOC_BIAS_OFF:
 239         case SND_SOC_BIAS_STANDBY:
 240                 break;
 241         default:
 242                 return -EBUSY;
 243         }
 244 
 245         pcm512x->overclock_pll = ucontrol->value.integer.value[0];
 246         return 0;
 247 }
 248 
 249 static int pcm512x_overclock_dsp_get(struct snd_kcontrol *kcontrol,
 250                                      struct snd_ctl_elem_value *ucontrol)
 251 {
 252         struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 253         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
 254 
 255         ucontrol->value.integer.value[0] = pcm512x->overclock_dsp;
 256         return 0;
 257 }
 258 
 259 static int pcm512x_overclock_dsp_put(struct snd_kcontrol *kcontrol,
 260                                      struct snd_ctl_elem_value *ucontrol)
 261 {
 262         struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 263         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
 264 
 265         switch (snd_soc_component_get_bias_level(component)) {
 266         case SND_SOC_BIAS_OFF:
 267         case SND_SOC_BIAS_STANDBY:
 268                 break;
 269         default:
 270                 return -EBUSY;
 271         }
 272 
 273         pcm512x->overclock_dsp = ucontrol->value.integer.value[0];
 274         return 0;
 275 }
 276 
 277 static int pcm512x_overclock_dac_get(struct snd_kcontrol *kcontrol,
 278                                      struct snd_ctl_elem_value *ucontrol)
 279 {
 280         struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 281         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
 282 
 283         ucontrol->value.integer.value[0] = pcm512x->overclock_dac;
 284         return 0;
 285 }
 286 
 287 static int pcm512x_overclock_dac_put(struct snd_kcontrol *kcontrol,
 288                                      struct snd_ctl_elem_value *ucontrol)
 289 {
 290         struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 291         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
 292 
 293         switch (snd_soc_component_get_bias_level(component)) {
 294         case SND_SOC_BIAS_OFF:
 295         case SND_SOC_BIAS_STANDBY:
 296                 break;
 297         default:
 298                 return -EBUSY;
 299         }
 300 
 301         pcm512x->overclock_dac = ucontrol->value.integer.value[0];
 302         return 0;
 303 }
 304 
 305 static const DECLARE_TLV_DB_SCALE(digital_tlv, -10350, 50, 1);
 306 static const DECLARE_TLV_DB_SCALE(analog_tlv, -600, 600, 0);
 307 static const DECLARE_TLV_DB_SCALE(boost_tlv, 0, 80, 0);
 308 
 309 static const char * const pcm512x_dsp_program_texts[] = {
 310         "FIR interpolation with de-emphasis",
 311         "Low latency IIR with de-emphasis",
 312         "High attenuation with de-emphasis",
 313         "Fixed process flow",
 314         "Ringing-less low latency FIR",
 315 };
 316 
 317 static const unsigned int pcm512x_dsp_program_values[] = {
 318         1,
 319         2,
 320         3,
 321         5,
 322         7,
 323 };
 324 
 325 static SOC_VALUE_ENUM_SINGLE_DECL(pcm512x_dsp_program,
 326                                   PCM512x_DSP_PROGRAM, 0, 0x1f,
 327                                   pcm512x_dsp_program_texts,
 328                                   pcm512x_dsp_program_values);
 329 
 330 static const char * const pcm512x_clk_missing_text[] = {
 331         "1s", "2s", "3s", "4s", "5s", "6s", "7s", "8s"
 332 };
 333 
 334 static const struct soc_enum pcm512x_clk_missing =
 335         SOC_ENUM_SINGLE(PCM512x_CLKDET, 0,  8, pcm512x_clk_missing_text);
 336 
 337 static const char * const pcm512x_autom_text[] = {
 338         "21ms", "106ms", "213ms", "533ms", "1.07s", "2.13s", "5.33s", "10.66s"
 339 };
 340 
 341 static const struct soc_enum pcm512x_autom_l =
 342         SOC_ENUM_SINGLE(PCM512x_AUTO_MUTE, PCM512x_ATML_SHIFT, 8,
 343                         pcm512x_autom_text);
 344 
 345 static const struct soc_enum pcm512x_autom_r =
 346         SOC_ENUM_SINGLE(PCM512x_AUTO_MUTE, PCM512x_ATMR_SHIFT, 8,
 347                         pcm512x_autom_text);
 348 
 349 static const char * const pcm512x_ramp_rate_text[] = {
 350         "1 sample/update", "2 samples/update", "4 samples/update",
 351         "Immediate"
 352 };
 353 
 354 static const struct soc_enum pcm512x_vndf =
 355         SOC_ENUM_SINGLE(PCM512x_DIGITAL_MUTE_1, PCM512x_VNDF_SHIFT, 4,
 356                         pcm512x_ramp_rate_text);
 357 
 358 static const struct soc_enum pcm512x_vnuf =
 359         SOC_ENUM_SINGLE(PCM512x_DIGITAL_MUTE_1, PCM512x_VNUF_SHIFT, 4,
 360                         pcm512x_ramp_rate_text);
 361 
 362 static const struct soc_enum pcm512x_vedf =
 363         SOC_ENUM_SINGLE(PCM512x_DIGITAL_MUTE_2, PCM512x_VEDF_SHIFT, 4,
 364                         pcm512x_ramp_rate_text);
 365 
 366 static const char * const pcm512x_ramp_step_text[] = {
 367         "4dB/step", "2dB/step", "1dB/step", "0.5dB/step"
 368 };
 369 
 370 static const struct soc_enum pcm512x_vnds =
 371         SOC_ENUM_SINGLE(PCM512x_DIGITAL_MUTE_1, PCM512x_VNDS_SHIFT, 4,
 372                         pcm512x_ramp_step_text);
 373 
 374 static const struct soc_enum pcm512x_vnus =
 375         SOC_ENUM_SINGLE(PCM512x_DIGITAL_MUTE_1, PCM512x_VNUS_SHIFT, 4,
 376                         pcm512x_ramp_step_text);
 377 
 378 static const struct soc_enum pcm512x_veds =
 379         SOC_ENUM_SINGLE(PCM512x_DIGITAL_MUTE_2, PCM512x_VEDS_SHIFT, 4,
 380                         pcm512x_ramp_step_text);
 381 
 382 static int pcm512x_update_mute(struct pcm512x_priv *pcm512x)
 383 {
 384         return regmap_update_bits(
 385                 pcm512x->regmap, PCM512x_MUTE, PCM512x_RQML | PCM512x_RQMR,
 386                 (!!(pcm512x->mute & 0x5) << PCM512x_RQML_SHIFT)
 387                 | (!!(pcm512x->mute & 0x3) << PCM512x_RQMR_SHIFT));
 388 }
 389 
 390 static int pcm512x_digital_playback_switch_get(struct snd_kcontrol *kcontrol,
 391                                                struct snd_ctl_elem_value *ucontrol)
 392 {
 393         struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 394         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
 395 
 396         mutex_lock(&pcm512x->mutex);
 397         ucontrol->value.integer.value[0] = !(pcm512x->mute & 0x4);
 398         ucontrol->value.integer.value[1] = !(pcm512x->mute & 0x2);
 399         mutex_unlock(&pcm512x->mutex);
 400 
 401         return 0;
 402 }
 403 
 404 static int pcm512x_digital_playback_switch_put(struct snd_kcontrol *kcontrol,
 405                                                struct snd_ctl_elem_value *ucontrol)
 406 {
 407         struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 408         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
 409         int ret, changed = 0;
 410 
 411         mutex_lock(&pcm512x->mutex);
 412 
 413         if ((pcm512x->mute & 0x4) == (ucontrol->value.integer.value[0] << 2)) {
 414                 pcm512x->mute ^= 0x4;
 415                 changed = 1;
 416         }
 417         if ((pcm512x->mute & 0x2) == (ucontrol->value.integer.value[1] << 1)) {
 418                 pcm512x->mute ^= 0x2;
 419                 changed = 1;
 420         }
 421 
 422         if (changed) {
 423                 ret = pcm512x_update_mute(pcm512x);
 424                 if (ret != 0) {
 425                         dev_err(component->dev,
 426                                 "Failed to update digital mute: %d\n", ret);
 427                         mutex_unlock(&pcm512x->mutex);
 428                         return ret;
 429                 }
 430         }
 431 
 432         mutex_unlock(&pcm512x->mutex);
 433 
 434         return changed;
 435 }
 436 
 437 static const struct snd_kcontrol_new pcm512x_controls[] = {
 438 SOC_DOUBLE_R_TLV("Digital Playback Volume", PCM512x_DIGITAL_VOLUME_2,
 439                  PCM512x_DIGITAL_VOLUME_3, 0, 255, 1, digital_tlv),
 440 SOC_DOUBLE_TLV("Analogue Playback Volume", PCM512x_ANALOG_GAIN_CTRL,
 441                PCM512x_LAGN_SHIFT, PCM512x_RAGN_SHIFT, 1, 1, analog_tlv),
 442 SOC_DOUBLE_TLV("Analogue Playback Boost Volume", PCM512x_ANALOG_GAIN_BOOST,
 443                PCM512x_AGBL_SHIFT, PCM512x_AGBR_SHIFT, 1, 0, boost_tlv),
 444 {
 445         .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
 446         .name = "Digital Playback Switch",
 447         .index = 0,
 448         .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
 449         .info = snd_ctl_boolean_stereo_info,
 450         .get = pcm512x_digital_playback_switch_get,
 451         .put = pcm512x_digital_playback_switch_put
 452 },
 453 
 454 SOC_SINGLE("Deemphasis Switch", PCM512x_DSP, PCM512x_DEMP_SHIFT, 1, 1),
 455 SOC_ENUM("DSP Program", pcm512x_dsp_program),
 456 
 457 SOC_ENUM("Clock Missing Period", pcm512x_clk_missing),
 458 SOC_ENUM("Auto Mute Time Left", pcm512x_autom_l),
 459 SOC_ENUM("Auto Mute Time Right", pcm512x_autom_r),
 460 SOC_SINGLE("Auto Mute Mono Switch", PCM512x_DIGITAL_MUTE_3,
 461            PCM512x_ACTL_SHIFT, 1, 0),
 462 SOC_DOUBLE("Auto Mute Switch", PCM512x_DIGITAL_MUTE_3, PCM512x_AMLE_SHIFT,
 463            PCM512x_AMRE_SHIFT, 1, 0),
 464 
 465 SOC_ENUM("Volume Ramp Down Rate", pcm512x_vndf),
 466 SOC_ENUM("Volume Ramp Down Step", pcm512x_vnds),
 467 SOC_ENUM("Volume Ramp Up Rate", pcm512x_vnuf),
 468 SOC_ENUM("Volume Ramp Up Step", pcm512x_vnus),
 469 SOC_ENUM("Volume Ramp Down Emergency Rate", pcm512x_vedf),
 470 SOC_ENUM("Volume Ramp Down Emergency Step", pcm512x_veds),
 471 
 472 SOC_SINGLE_EXT("Max Overclock PLL", SND_SOC_NOPM, 0, 20, 0,
 473                pcm512x_overclock_pll_get, pcm512x_overclock_pll_put),
 474 SOC_SINGLE_EXT("Max Overclock DSP", SND_SOC_NOPM, 0, 40, 0,
 475                pcm512x_overclock_dsp_get, pcm512x_overclock_dsp_put),
 476 SOC_SINGLE_EXT("Max Overclock DAC", SND_SOC_NOPM, 0, 40, 0,
 477                pcm512x_overclock_dac_get, pcm512x_overclock_dac_put),
 478 };
 479 
 480 static const struct snd_soc_dapm_widget pcm512x_dapm_widgets[] = {
 481 SND_SOC_DAPM_DAC("DACL", NULL, SND_SOC_NOPM, 0, 0),
 482 SND_SOC_DAPM_DAC("DACR", NULL, SND_SOC_NOPM, 0, 0),
 483 
 484 SND_SOC_DAPM_OUTPUT("OUTL"),
 485 SND_SOC_DAPM_OUTPUT("OUTR"),
 486 };
 487 
 488 static const struct snd_soc_dapm_route pcm512x_dapm_routes[] = {
 489         { "DACL", NULL, "Playback" },
 490         { "DACR", NULL, "Playback" },
 491 
 492         { "OUTL", NULL, "DACL" },
 493         { "OUTR", NULL, "DACR" },
 494 };
 495 
 496 static unsigned long pcm512x_pll_max(struct pcm512x_priv *pcm512x)
 497 {
 498         return 25000000 + 25000000 * pcm512x->overclock_pll / 100;
 499 }
 500 
 501 static unsigned long pcm512x_dsp_max(struct pcm512x_priv *pcm512x)
 502 {
 503         return 50000000 + 50000000 * pcm512x->overclock_dsp / 100;
 504 }
 505 
 506 static unsigned long pcm512x_dac_max(struct pcm512x_priv *pcm512x,
 507                                      unsigned long rate)
 508 {
 509         return rate + rate * pcm512x->overclock_dac / 100;
 510 }
 511 
 512 static unsigned long pcm512x_sck_max(struct pcm512x_priv *pcm512x)
 513 {
 514         if (!pcm512x->pll_out)
 515                 return 25000000;
 516         return pcm512x_pll_max(pcm512x);
 517 }
 518 
 519 static unsigned long pcm512x_ncp_target(struct pcm512x_priv *pcm512x,
 520                                         unsigned long dac_rate)
 521 {
 522         /*
 523          * If the DAC is not actually overclocked, use the good old
 524          * NCP target rate...
 525          */
 526         if (dac_rate <= 6144000)
 527                 return 1536000;
 528         /*
 529          * ...but if the DAC is in fact overclocked, bump the NCP target
 530          * rate to get the recommended dividers even when overclocking.
 531          */
 532         return pcm512x_dac_max(pcm512x, 1536000);
 533 }
 534 
 535 static const u32 pcm512x_dai_rates[] = {
 536         8000, 11025, 16000, 22050, 32000, 44100, 48000, 64000,
 537         88200, 96000, 176400, 192000, 384000,
 538 };
 539 
 540 static const struct snd_pcm_hw_constraint_list constraints_slave = {
 541         .count = ARRAY_SIZE(pcm512x_dai_rates),
 542         .list  = pcm512x_dai_rates,
 543 };
 544 
 545 static int pcm512x_hw_rule_rate(struct snd_pcm_hw_params *params,
 546                                 struct snd_pcm_hw_rule *rule)
 547 {
 548         struct pcm512x_priv *pcm512x = rule->private;
 549         struct snd_interval ranges[2];
 550         int frame_size;
 551 
 552         frame_size = snd_soc_params_to_frame_size(params);
 553         if (frame_size < 0)
 554                 return frame_size;
 555 
 556         switch (frame_size) {
 557         case 32:
 558                 /* No hole when the frame size is 32. */
 559                 return 0;
 560         case 48:
 561         case 64:
 562                 /* There is only one hole in the range of supported
 563                  * rates, but it moves with the frame size.
 564                  */
 565                 memset(ranges, 0, sizeof(ranges));
 566                 ranges[0].min = 8000;
 567                 ranges[0].max = pcm512x_sck_max(pcm512x) / frame_size / 2;
 568                 ranges[1].min = DIV_ROUND_UP(16000000, frame_size);
 569                 ranges[1].max = 384000;
 570                 break;
 571         default:
 572                 return -EINVAL;
 573         }
 574 
 575         return snd_interval_ranges(hw_param_interval(params, rule->var),
 576                                    ARRAY_SIZE(ranges), ranges, 0);
 577 }
 578 
 579 static int pcm512x_dai_startup_master(struct snd_pcm_substream *substream,
 580                                       struct snd_soc_dai *dai)
 581 {
 582         struct snd_soc_component *component = dai->component;
 583         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
 584         struct device *dev = dai->dev;
 585         struct snd_pcm_hw_constraint_ratnums *constraints_no_pll;
 586         struct snd_ratnum *rats_no_pll;
 587 
 588         if (IS_ERR(pcm512x->sclk)) {
 589                 dev_err(dev, "Need SCLK for master mode: %ld\n",
 590                         PTR_ERR(pcm512x->sclk));
 591                 return PTR_ERR(pcm512x->sclk);
 592         }
 593 
 594         if (pcm512x->pll_out)
 595                 return snd_pcm_hw_rule_add(substream->runtime, 0,
 596                                            SNDRV_PCM_HW_PARAM_RATE,
 597                                            pcm512x_hw_rule_rate,
 598                                            pcm512x,
 599                                            SNDRV_PCM_HW_PARAM_FRAME_BITS,
 600                                            SNDRV_PCM_HW_PARAM_CHANNELS, -1);
 601 
 602         constraints_no_pll = devm_kzalloc(dev, sizeof(*constraints_no_pll),
 603                                           GFP_KERNEL);
 604         if (!constraints_no_pll)
 605                 return -ENOMEM;
 606         constraints_no_pll->nrats = 1;
 607         rats_no_pll = devm_kzalloc(dev, sizeof(*rats_no_pll), GFP_KERNEL);
 608         if (!rats_no_pll)
 609                 return -ENOMEM;
 610         constraints_no_pll->rats = rats_no_pll;
 611         rats_no_pll->num = clk_get_rate(pcm512x->sclk) / 64;
 612         rats_no_pll->den_min = 1;
 613         rats_no_pll->den_max = 128;
 614         rats_no_pll->den_step = 1;
 615 
 616         return snd_pcm_hw_constraint_ratnums(substream->runtime, 0,
 617                                              SNDRV_PCM_HW_PARAM_RATE,
 618                                              constraints_no_pll);
 619 }
 620 
 621 static int pcm512x_dai_startup_slave(struct snd_pcm_substream *substream,
 622                                      struct snd_soc_dai *dai)
 623 {
 624         struct snd_soc_component *component = dai->component;
 625         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
 626         struct device *dev = dai->dev;
 627         struct regmap *regmap = pcm512x->regmap;
 628 
 629         if (IS_ERR(pcm512x->sclk)) {
 630                 dev_info(dev, "No SCLK, using BCLK: %ld\n",
 631                          PTR_ERR(pcm512x->sclk));
 632 
 633                 /* Disable reporting of missing SCLK as an error */
 634                 regmap_update_bits(regmap, PCM512x_ERROR_DETECT,
 635                                    PCM512x_IDCH, PCM512x_IDCH);
 636 
 637                 /* Switch PLL input to BCLK */
 638                 regmap_update_bits(regmap, PCM512x_PLL_REF,
 639                                    PCM512x_SREF, PCM512x_SREF_BCK);
 640         }
 641 
 642         return snd_pcm_hw_constraint_list(substream->runtime, 0,
 643                                           SNDRV_PCM_HW_PARAM_RATE,
 644                                           &constraints_slave);
 645 }
 646 
 647 static int pcm512x_dai_startup(struct snd_pcm_substream *substream,
 648                                struct snd_soc_dai *dai)
 649 {
 650         struct snd_soc_component *component = dai->component;
 651         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
 652 
 653         switch (pcm512x->fmt & SND_SOC_DAIFMT_MASTER_MASK) {
 654         case SND_SOC_DAIFMT_CBM_CFM:
 655         case SND_SOC_DAIFMT_CBM_CFS:
 656                 return pcm512x_dai_startup_master(substream, dai);
 657 
 658         case SND_SOC_DAIFMT_CBS_CFS:
 659                 return pcm512x_dai_startup_slave(substream, dai);
 660 
 661         default:
 662                 return -EINVAL;
 663         }
 664 }
 665 
 666 static int pcm512x_set_bias_level(struct snd_soc_component *component,
 667                                   enum snd_soc_bias_level level)
 668 {
 669         struct pcm512x_priv *pcm512x = dev_get_drvdata(component->dev);
 670         int ret;
 671 
 672         switch (level) {
 673         case SND_SOC_BIAS_ON:
 674         case SND_SOC_BIAS_PREPARE:
 675                 break;
 676 
 677         case SND_SOC_BIAS_STANDBY:
 678                 ret = regmap_update_bits(pcm512x->regmap, PCM512x_POWER,
 679                                          PCM512x_RQST, 0);
 680                 if (ret != 0) {
 681                         dev_err(component->dev, "Failed to remove standby: %d\n",
 682                                 ret);
 683                         return ret;
 684                 }
 685                 break;
 686 
 687         case SND_SOC_BIAS_OFF:
 688                 ret = regmap_update_bits(pcm512x->regmap, PCM512x_POWER,
 689                                          PCM512x_RQST, PCM512x_RQST);
 690                 if (ret != 0) {
 691                         dev_err(component->dev, "Failed to request standby: %d\n",
 692                                 ret);
 693                         return ret;
 694                 }
 695                 break;
 696         }
 697 
 698         return 0;
 699 }
 700 
 701 static unsigned long pcm512x_find_sck(struct snd_soc_dai *dai,
 702                                       unsigned long bclk_rate)
 703 {
 704         struct device *dev = dai->dev;
 705         struct snd_soc_component *component = dai->component;
 706         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
 707         unsigned long sck_rate;
 708         int pow2;
 709 
 710         /* 64 MHz <= pll_rate <= 100 MHz, VREF mode */
 711         /* 16 MHz <= sck_rate <=  25 MHz, VREF mode */
 712 
 713         /* select sck_rate as a multiple of bclk_rate but still with
 714          * as many factors of 2 as possible, as that makes it easier
 715          * to find a fast DAC rate
 716          */
 717         pow2 = 1 << fls((pcm512x_pll_max(pcm512x) - 16000000) / bclk_rate);
 718         for (; pow2; pow2 >>= 1) {
 719                 sck_rate = rounddown(pcm512x_pll_max(pcm512x),
 720                                      bclk_rate * pow2);
 721                 if (sck_rate >= 16000000)
 722                         break;
 723         }
 724         if (!pow2) {
 725                 dev_err(dev, "Impossible to generate a suitable SCK\n");
 726                 return 0;
 727         }
 728 
 729         dev_dbg(dev, "sck_rate %lu\n", sck_rate);
 730         return sck_rate;
 731 }
 732 
 733 /* pll_rate = pllin_rate * R * J.D / P
 734  * 1 <= R <= 16
 735  * 1 <= J <= 63
 736  * 0 <= D <= 9999
 737  * 1 <= P <= 15
 738  * 64 MHz <= pll_rate <= 100 MHz
 739  * if D == 0
 740  *     1 MHz <= pllin_rate / P <= 20 MHz
 741  * else if D > 0
 742  *     6.667 MHz <= pllin_rate / P <= 20 MHz
 743  *     4 <= J <= 11
 744  *     R = 1
 745  */
 746 static int pcm512x_find_pll_coeff(struct snd_soc_dai *dai,
 747                                   unsigned long pllin_rate,
 748                                   unsigned long pll_rate)
 749 {
 750         struct device *dev = dai->dev;
 751         struct snd_soc_component *component = dai->component;
 752         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
 753         unsigned long common;
 754         int R, J, D, P;
 755         unsigned long K; /* 10000 * J.D */
 756         unsigned long num;
 757         unsigned long den;
 758 
 759         common = gcd(pll_rate, pllin_rate);
 760         dev_dbg(dev, "pll %lu pllin %lu common %lu\n",
 761                 pll_rate, pllin_rate, common);
 762         num = pll_rate / common;
 763         den = pllin_rate / common;
 764 
 765         /* pllin_rate / P (or here, den) cannot be greater than 20 MHz */
 766         if (pllin_rate / den > 20000000 && num < 8) {
 767                 num *= DIV_ROUND_UP(pllin_rate / den, 20000000);
 768                 den *= DIV_ROUND_UP(pllin_rate / den, 20000000);
 769         }
 770         dev_dbg(dev, "num / den = %lu / %lu\n", num, den);
 771 
 772         P = den;
 773         if (den <= 15 && num <= 16 * 63
 774             && 1000000 <= pllin_rate / P && pllin_rate / P <= 20000000) {
 775                 /* Try the case with D = 0 */
 776                 D = 0;
 777                 /* factor 'num' into J and R, such that R <= 16 and J <= 63 */
 778                 for (R = 16; R; R--) {
 779                         if (num % R)
 780                                 continue;
 781                         J = num / R;
 782                         if (J == 0 || J > 63)
 783                                 continue;
 784 
 785                         dev_dbg(dev, "R * J / P = %d * %d / %d\n", R, J, P);
 786                         pcm512x->real_pll = pll_rate;
 787                         goto done;
 788                 }
 789                 /* no luck */
 790         }
 791 
 792         R = 1;
 793 
 794         if (num > 0xffffffffUL / 10000)
 795                 goto fallback;
 796 
 797         /* Try to find an exact pll_rate using the D > 0 case */
 798         common = gcd(10000 * num, den);
 799         num = 10000 * num / common;
 800         den /= common;
 801         dev_dbg(dev, "num %lu den %lu common %lu\n", num, den, common);
 802 
 803         for (P = den; P <= 15; P++) {
 804                 if (pllin_rate / P < 6667000 || 200000000 < pllin_rate / P)
 805                         continue;
 806                 if (num * P % den)
 807                         continue;
 808                 K = num * P / den;
 809                 /* J == 12 is ok if D == 0 */
 810                 if (K < 40000 || K > 120000)
 811                         continue;
 812 
 813                 J = K / 10000;
 814                 D = K % 10000;
 815                 dev_dbg(dev, "J.D / P = %d.%04d / %d\n", J, D, P);
 816                 pcm512x->real_pll = pll_rate;
 817                 goto done;
 818         }
 819 
 820         /* Fall back to an approximate pll_rate */
 821 
 822 fallback:
 823         /* find smallest possible P */
 824         P = DIV_ROUND_UP(pllin_rate, 20000000);
 825         if (!P)
 826                 P = 1;
 827         else if (P > 15) {
 828                 dev_err(dev, "Need a slower clock as pll-input\n");
 829                 return -EINVAL;
 830         }
 831         if (pllin_rate / P < 6667000) {
 832                 dev_err(dev, "Need a faster clock as pll-input\n");
 833                 return -EINVAL;
 834         }
 835         K = DIV_ROUND_CLOSEST_ULL(10000ULL * pll_rate * P, pllin_rate);
 836         if (K < 40000)
 837                 K = 40000;
 838         /* J == 12 is ok if D == 0 */
 839         if (K > 120000)
 840                 K = 120000;
 841         J = K / 10000;
 842         D = K % 10000;
 843         dev_dbg(dev, "J.D / P ~ %d.%04d / %d\n", J, D, P);
 844         pcm512x->real_pll = DIV_ROUND_DOWN_ULL((u64)K * pllin_rate, 10000 * P);
 845 
 846 done:
 847         pcm512x->pll_r = R;
 848         pcm512x->pll_j = J;
 849         pcm512x->pll_d = D;
 850         pcm512x->pll_p = P;
 851         return 0;
 852 }
 853 
 854 static unsigned long pcm512x_pllin_dac_rate(struct snd_soc_dai *dai,
 855                                             unsigned long osr_rate,
 856                                             unsigned long pllin_rate)
 857 {
 858         struct snd_soc_component *component = dai->component;
 859         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
 860         unsigned long dac_rate;
 861 
 862         if (!pcm512x->pll_out)
 863                 return 0; /* no PLL to bypass, force SCK as DAC input */
 864 
 865         if (pllin_rate % osr_rate)
 866                 return 0; /* futile, quit early */
 867 
 868         /* run DAC no faster than 6144000 Hz */
 869         for (dac_rate = rounddown(pcm512x_dac_max(pcm512x, 6144000), osr_rate);
 870              dac_rate;
 871              dac_rate -= osr_rate) {
 872 
 873                 if (pllin_rate / dac_rate > 128)
 874                         return 0; /* DAC divider would be too big */
 875 
 876                 if (!(pllin_rate % dac_rate))
 877                         return dac_rate;
 878 
 879                 dac_rate -= osr_rate;
 880         }
 881 
 882         return 0;
 883 }
 884 
 885 static int pcm512x_set_dividers(struct snd_soc_dai *dai,
 886                                 struct snd_pcm_hw_params *params)
 887 {
 888         struct device *dev = dai->dev;
 889         struct snd_soc_component *component = dai->component;
 890         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
 891         unsigned long pllin_rate = 0;
 892         unsigned long pll_rate;
 893         unsigned long sck_rate;
 894         unsigned long mck_rate;
 895         unsigned long bclk_rate;
 896         unsigned long sample_rate;
 897         unsigned long osr_rate;
 898         unsigned long dacsrc_rate;
 899         int bclk_div;
 900         int lrclk_div;
 901         int dsp_div;
 902         int dac_div;
 903         unsigned long dac_rate;
 904         int ncp_div;
 905         int osr_div;
 906         int ret;
 907         int idac;
 908         int fssp;
 909         int gpio;
 910 
 911         if (pcm512x->bclk_ratio > 0) {
 912                 lrclk_div = pcm512x->bclk_ratio;
 913         } else {
 914                 lrclk_div = snd_soc_params_to_frame_size(params);
 915 
 916                 if (lrclk_div == 0) {
 917                         dev_err(dev, "No LRCLK?\n");
 918                         return -EINVAL;
 919                 }
 920         }
 921 
 922         if (!pcm512x->pll_out) {
 923                 sck_rate = clk_get_rate(pcm512x->sclk);
 924                 bclk_rate = params_rate(params) * lrclk_div;
 925                 bclk_div = DIV_ROUND_CLOSEST(sck_rate, bclk_rate);
 926 
 927                 mck_rate = sck_rate;
 928         } else {
 929                 ret = snd_soc_params_to_bclk(params);
 930                 if (ret < 0) {
 931                         dev_err(dev, "Failed to find suitable BCLK: %d\n", ret);
 932                         return ret;
 933                 }
 934                 if (ret == 0) {
 935                         dev_err(dev, "No BCLK?\n");
 936                         return -EINVAL;
 937                 }
 938                 bclk_rate = ret;
 939 
 940                 pllin_rate = clk_get_rate(pcm512x->sclk);
 941 
 942                 sck_rate = pcm512x_find_sck(dai, bclk_rate);
 943                 if (!sck_rate)
 944                         return -EINVAL;
 945                 pll_rate = 4 * sck_rate;
 946 
 947                 ret = pcm512x_find_pll_coeff(dai, pllin_rate, pll_rate);
 948                 if (ret != 0)
 949                         return ret;
 950 
 951                 ret = regmap_write(pcm512x->regmap,
 952                                    PCM512x_PLL_COEFF_0, pcm512x->pll_p - 1);
 953                 if (ret != 0) {
 954                         dev_err(dev, "Failed to write PLL P: %d\n", ret);
 955                         return ret;
 956                 }
 957 
 958                 ret = regmap_write(pcm512x->regmap,
 959                                    PCM512x_PLL_COEFF_1, pcm512x->pll_j);
 960                 if (ret != 0) {
 961                         dev_err(dev, "Failed to write PLL J: %d\n", ret);
 962                         return ret;
 963                 }
 964 
 965                 ret = regmap_write(pcm512x->regmap,
 966                                    PCM512x_PLL_COEFF_2, pcm512x->pll_d >> 8);
 967                 if (ret != 0) {
 968                         dev_err(dev, "Failed to write PLL D msb: %d\n", ret);
 969                         return ret;
 970                 }
 971 
 972                 ret = regmap_write(pcm512x->regmap,
 973                                    PCM512x_PLL_COEFF_3, pcm512x->pll_d & 0xff);
 974                 if (ret != 0) {
 975                         dev_err(dev, "Failed to write PLL D lsb: %d\n", ret);
 976                         return ret;
 977                 }
 978 
 979                 ret = regmap_write(pcm512x->regmap,
 980                                    PCM512x_PLL_COEFF_4, pcm512x->pll_r - 1);
 981                 if (ret != 0) {
 982                         dev_err(dev, "Failed to write PLL R: %d\n", ret);
 983                         return ret;
 984                 }
 985 
 986                 mck_rate = pcm512x->real_pll;
 987 
 988                 bclk_div = DIV_ROUND_CLOSEST(sck_rate, bclk_rate);
 989         }
 990 
 991         if (bclk_div > 128) {
 992                 dev_err(dev, "Failed to find BCLK divider\n");
 993                 return -EINVAL;
 994         }
 995 
 996         /* the actual rate */
 997         sample_rate = sck_rate / bclk_div / lrclk_div;
 998         osr_rate = 16 * sample_rate;
 999 
1000         /* run DSP no faster than 50 MHz */
1001         dsp_div = mck_rate > pcm512x_dsp_max(pcm512x) ? 2 : 1;
1002 
1003         dac_rate = pcm512x_pllin_dac_rate(dai, osr_rate, pllin_rate);
1004         if (dac_rate) {
1005                 /* the desired clock rate is "compatible" with the pll input
1006                  * clock, so use that clock as dac input instead of the pll
1007                  * output clock since the pll will introduce jitter and thus
1008                  * noise.
1009                  */
1010                 dev_dbg(dev, "using pll input as dac input\n");
1011                 ret = regmap_update_bits(pcm512x->regmap, PCM512x_DAC_REF,
1012                                          PCM512x_SDAC, PCM512x_SDAC_GPIO);
1013                 if (ret != 0) {
1014                         dev_err(component->dev,
1015                                 "Failed to set gpio as dacref: %d\n", ret);
1016                         return ret;
1017                 }
1018 
1019                 gpio = PCM512x_GREF_GPIO1 + pcm512x->pll_in - 1;
1020                 ret = regmap_update_bits(pcm512x->regmap, PCM512x_GPIO_DACIN,
1021                                          PCM512x_GREF, gpio);
1022                 if (ret != 0) {
1023                         dev_err(component->dev,
1024                                 "Failed to set gpio %d as dacin: %d\n",
1025                                 pcm512x->pll_in, ret);
1026                         return ret;
1027                 }
1028 
1029                 dacsrc_rate = pllin_rate;
1030         } else {
1031                 /* run DAC no faster than 6144000 Hz */
1032                 unsigned long dac_mul = pcm512x_dac_max(pcm512x, 6144000)
1033                         / osr_rate;
1034                 unsigned long sck_mul = sck_rate / osr_rate;
1035 
1036                 for (; dac_mul; dac_mul--) {
1037                         if (!(sck_mul % dac_mul))
1038                                 break;
1039                 }
1040                 if (!dac_mul) {
1041                         dev_err(dev, "Failed to find DAC rate\n");
1042                         return -EINVAL;
1043                 }
1044 
1045                 dac_rate = dac_mul * osr_rate;
1046                 dev_dbg(dev, "dac_rate %lu sample_rate %lu\n",
1047                         dac_rate, sample_rate);
1048 
1049                 ret = regmap_update_bits(pcm512x->regmap, PCM512x_DAC_REF,
1050                                          PCM512x_SDAC, PCM512x_SDAC_SCK);
1051                 if (ret != 0) {
1052                         dev_err(component->dev,
1053                                 "Failed to set sck as dacref: %d\n", ret);
1054                         return ret;
1055                 }
1056 
1057                 dacsrc_rate = sck_rate;
1058         }
1059 
1060         osr_div = DIV_ROUND_CLOSEST(dac_rate, osr_rate);
1061         if (osr_div > 128) {
1062                 dev_err(dev, "Failed to find OSR divider\n");
1063                 return -EINVAL;
1064         }
1065 
1066         dac_div = DIV_ROUND_CLOSEST(dacsrc_rate, dac_rate);
1067         if (dac_div > 128) {
1068                 dev_err(dev, "Failed to find DAC divider\n");
1069                 return -EINVAL;
1070         }
1071         dac_rate = dacsrc_rate / dac_div;
1072 
1073         ncp_div = DIV_ROUND_CLOSEST(dac_rate,
1074                                     pcm512x_ncp_target(pcm512x, dac_rate));
1075         if (ncp_div > 128 || dac_rate / ncp_div > 2048000) {
1076                 /* run NCP no faster than 2048000 Hz, but why? */
1077                 ncp_div = DIV_ROUND_UP(dac_rate, 2048000);
1078                 if (ncp_div > 128) {
1079                         dev_err(dev, "Failed to find NCP divider\n");
1080                         return -EINVAL;
1081                 }
1082         }
1083 
1084         idac = mck_rate / (dsp_div * sample_rate);
1085 
1086         ret = regmap_write(pcm512x->regmap, PCM512x_DSP_CLKDIV, dsp_div - 1);
1087         if (ret != 0) {
1088                 dev_err(dev, "Failed to write DSP divider: %d\n", ret);
1089                 return ret;
1090         }
1091 
1092         ret = regmap_write(pcm512x->regmap, PCM512x_DAC_CLKDIV, dac_div - 1);
1093         if (ret != 0) {
1094                 dev_err(dev, "Failed to write DAC divider: %d\n", ret);
1095                 return ret;
1096         }
1097 
1098         ret = regmap_write(pcm512x->regmap, PCM512x_NCP_CLKDIV, ncp_div - 1);
1099         if (ret != 0) {
1100                 dev_err(dev, "Failed to write NCP divider: %d\n", ret);
1101                 return ret;
1102         }
1103 
1104         ret = regmap_write(pcm512x->regmap, PCM512x_OSR_CLKDIV, osr_div - 1);
1105         if (ret != 0) {
1106                 dev_err(dev, "Failed to write OSR divider: %d\n", ret);
1107                 return ret;
1108         }
1109 
1110         ret = regmap_write(pcm512x->regmap,
1111                            PCM512x_MASTER_CLKDIV_1, bclk_div - 1);
1112         if (ret != 0) {
1113                 dev_err(dev, "Failed to write BCLK divider: %d\n", ret);
1114                 return ret;
1115         }
1116 
1117         ret = regmap_write(pcm512x->regmap,
1118                            PCM512x_MASTER_CLKDIV_2, lrclk_div - 1);
1119         if (ret != 0) {
1120                 dev_err(dev, "Failed to write LRCLK divider: %d\n", ret);
1121                 return ret;
1122         }
1123 
1124         ret = regmap_write(pcm512x->regmap, PCM512x_IDAC_1, idac >> 8);
1125         if (ret != 0) {
1126                 dev_err(dev, "Failed to write IDAC msb divider: %d\n", ret);
1127                 return ret;
1128         }
1129 
1130         ret = regmap_write(pcm512x->regmap, PCM512x_IDAC_2, idac & 0xff);
1131         if (ret != 0) {
1132                 dev_err(dev, "Failed to write IDAC lsb divider: %d\n", ret);
1133                 return ret;
1134         }
1135 
1136         if (sample_rate <= pcm512x_dac_max(pcm512x, 48000))
1137                 fssp = PCM512x_FSSP_48KHZ;
1138         else if (sample_rate <= pcm512x_dac_max(pcm512x, 96000))
1139                 fssp = PCM512x_FSSP_96KHZ;
1140         else if (sample_rate <= pcm512x_dac_max(pcm512x, 192000))
1141                 fssp = PCM512x_FSSP_192KHZ;
1142         else
1143                 fssp = PCM512x_FSSP_384KHZ;
1144         ret = regmap_update_bits(pcm512x->regmap, PCM512x_FS_SPEED_MODE,
1145                                  PCM512x_FSSP, fssp);
1146         if (ret != 0) {
1147                 dev_err(component->dev, "Failed to set fs speed: %d\n", ret);
1148                 return ret;
1149         }
1150 
1151         dev_dbg(component->dev, "DSP divider %d\n", dsp_div);
1152         dev_dbg(component->dev, "DAC divider %d\n", dac_div);
1153         dev_dbg(component->dev, "NCP divider %d\n", ncp_div);
1154         dev_dbg(component->dev, "OSR divider %d\n", osr_div);
1155         dev_dbg(component->dev, "BCK divider %d\n", bclk_div);
1156         dev_dbg(component->dev, "LRCK divider %d\n", lrclk_div);
1157         dev_dbg(component->dev, "IDAC %d\n", idac);
1158         dev_dbg(component->dev, "1<<FSSP %d\n", 1 << fssp);
1159 
1160         return 0;
1161 }
1162 
1163 static int pcm512x_hw_params(struct snd_pcm_substream *substream,
1164                              struct snd_pcm_hw_params *params,
1165                              struct snd_soc_dai *dai)
1166 {
1167         struct snd_soc_component *component = dai->component;
1168         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
1169         int alen;
1170         int gpio;
1171         int clock_output;
1172         int master_mode;
1173         int ret;
1174 
1175         dev_dbg(component->dev, "hw_params %u Hz, %u channels\n",
1176                 params_rate(params),
1177                 params_channels(params));
1178 
1179         switch (params_width(params)) {
1180         case 16:
1181                 alen = PCM512x_ALEN_16;
1182                 break;
1183         case 20:
1184                 alen = PCM512x_ALEN_20;
1185                 break;
1186         case 24:
1187                 alen = PCM512x_ALEN_24;
1188                 break;
1189         case 32:
1190                 alen = PCM512x_ALEN_32;
1191                 break;
1192         default:
1193                 dev_err(component->dev, "Bad frame size: %d\n",
1194                         params_width(params));
1195                 return -EINVAL;
1196         }
1197 
1198         switch (pcm512x->fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1199         case SND_SOC_DAIFMT_CBS_CFS:
1200                 ret = regmap_update_bits(pcm512x->regmap,
1201                                          PCM512x_BCLK_LRCLK_CFG,
1202                                          PCM512x_BCKP
1203                                          | PCM512x_BCKO | PCM512x_LRKO,
1204                                          0);
1205                 if (ret != 0) {
1206                         dev_err(component->dev,
1207                                 "Failed to enable slave mode: %d\n", ret);
1208                         return ret;
1209                 }
1210 
1211                 ret = regmap_update_bits(pcm512x->regmap, PCM512x_ERROR_DETECT,
1212                                          PCM512x_DCAS, 0);
1213                 if (ret != 0) {
1214                         dev_err(component->dev,
1215                                 "Failed to enable clock divider autoset: %d\n",
1216                                 ret);
1217                         return ret;
1218                 }
1219                 return 0;
1220         case SND_SOC_DAIFMT_CBM_CFM:
1221                 clock_output = PCM512x_BCKO | PCM512x_LRKO;
1222                 master_mode = PCM512x_RLRK | PCM512x_RBCK;
1223                 break;
1224         case SND_SOC_DAIFMT_CBM_CFS:
1225                 clock_output = PCM512x_BCKO;
1226                 master_mode = PCM512x_RBCK;
1227                 break;
1228         default:
1229                 return -EINVAL;
1230         }
1231 
1232         ret = regmap_update_bits(pcm512x->regmap, PCM512x_I2S_1,
1233                                  PCM512x_ALEN, alen);
1234         if (ret != 0) {
1235                 dev_err(component->dev, "Failed to set frame size: %d\n", ret);
1236                 return ret;
1237         }
1238 
1239         if (pcm512x->pll_out) {
1240                 ret = regmap_write(pcm512x->regmap, PCM512x_FLEX_A, 0x11);
1241                 if (ret != 0) {
1242                         dev_err(component->dev, "Failed to set FLEX_A: %d\n", ret);
1243                         return ret;
1244                 }
1245 
1246                 ret = regmap_write(pcm512x->regmap, PCM512x_FLEX_B, 0xff);
1247                 if (ret != 0) {
1248                         dev_err(component->dev, "Failed to set FLEX_B: %d\n", ret);
1249                         return ret;
1250                 }
1251 
1252                 ret = regmap_update_bits(pcm512x->regmap, PCM512x_ERROR_DETECT,
1253                                          PCM512x_IDFS | PCM512x_IDBK
1254                                          | PCM512x_IDSK | PCM512x_IDCH
1255                                          | PCM512x_IDCM | PCM512x_DCAS
1256                                          | PCM512x_IPLK,
1257                                          PCM512x_IDFS | PCM512x_IDBK
1258                                          | PCM512x_IDSK | PCM512x_IDCH
1259                                          | PCM512x_DCAS);
1260                 if (ret != 0) {
1261                         dev_err(component->dev,
1262                                 "Failed to ignore auto-clock failures: %d\n",
1263                                 ret);
1264                         return ret;
1265                 }
1266         } else {
1267                 ret = regmap_update_bits(pcm512x->regmap, PCM512x_ERROR_DETECT,
1268                                          PCM512x_IDFS | PCM512x_IDBK
1269                                          | PCM512x_IDSK | PCM512x_IDCH
1270                                          | PCM512x_IDCM | PCM512x_DCAS
1271                                          | PCM512x_IPLK,
1272                                          PCM512x_IDFS | PCM512x_IDBK
1273                                          | PCM512x_IDSK | PCM512x_IDCH
1274                                          | PCM512x_DCAS | PCM512x_IPLK);
1275                 if (ret != 0) {
1276                         dev_err(component->dev,
1277                                 "Failed to ignore auto-clock failures: %d\n",
1278                                 ret);
1279                         return ret;
1280                 }
1281 
1282                 ret = regmap_update_bits(pcm512x->regmap, PCM512x_PLL_EN,
1283                                          PCM512x_PLLE, 0);
1284                 if (ret != 0) {
1285                         dev_err(component->dev, "Failed to disable pll: %d\n", ret);
1286                         return ret;
1287                 }
1288         }
1289 
1290         ret = pcm512x_set_dividers(dai, params);
1291         if (ret != 0)
1292                 return ret;
1293 
1294         if (pcm512x->pll_out) {
1295                 ret = regmap_update_bits(pcm512x->regmap, PCM512x_PLL_REF,
1296                                          PCM512x_SREF, PCM512x_SREF_GPIO);
1297                 if (ret != 0) {
1298                         dev_err(component->dev,
1299                                 "Failed to set gpio as pllref: %d\n", ret);
1300                         return ret;
1301                 }
1302 
1303                 gpio = PCM512x_GREF_GPIO1 + pcm512x->pll_in - 1;
1304                 ret = regmap_update_bits(pcm512x->regmap, PCM512x_GPIO_PLLIN,
1305                                          PCM512x_GREF, gpio);
1306                 if (ret != 0) {
1307                         dev_err(component->dev,
1308                                 "Failed to set gpio %d as pllin: %d\n",
1309                                 pcm512x->pll_in, ret);
1310                         return ret;
1311                 }
1312 
1313                 ret = regmap_update_bits(pcm512x->regmap, PCM512x_PLL_EN,
1314                                          PCM512x_PLLE, PCM512x_PLLE);
1315                 if (ret != 0) {
1316                         dev_err(component->dev, "Failed to enable pll: %d\n", ret);
1317                         return ret;
1318                 }
1319         }
1320 
1321         ret = regmap_update_bits(pcm512x->regmap, PCM512x_BCLK_LRCLK_CFG,
1322                                  PCM512x_BCKP | PCM512x_BCKO | PCM512x_LRKO,
1323                                  clock_output);
1324         if (ret != 0) {
1325                 dev_err(component->dev, "Failed to enable clock output: %d\n", ret);
1326                 return ret;
1327         }
1328 
1329         ret = regmap_update_bits(pcm512x->regmap, PCM512x_MASTER_MODE,
1330                                  PCM512x_RLRK | PCM512x_RBCK,
1331                                  master_mode);
1332         if (ret != 0) {
1333                 dev_err(component->dev, "Failed to enable master mode: %d\n", ret);
1334                 return ret;
1335         }
1336 
1337         if (pcm512x->pll_out) {
1338                 gpio = PCM512x_G1OE << (pcm512x->pll_out - 1);
1339                 ret = regmap_update_bits(pcm512x->regmap, PCM512x_GPIO_EN,
1340                                          gpio, gpio);
1341                 if (ret != 0) {
1342                         dev_err(component->dev, "Failed to enable gpio %d: %d\n",
1343                                 pcm512x->pll_out, ret);
1344                         return ret;
1345                 }
1346 
1347                 gpio = PCM512x_GPIO_OUTPUT_1 + pcm512x->pll_out - 1;
1348                 ret = regmap_update_bits(pcm512x->regmap, gpio,
1349                                          PCM512x_GxSL, PCM512x_GxSL_PLLCK);
1350                 if (ret != 0) {
1351                         dev_err(component->dev, "Failed to output pll on %d: %d\n",
1352                                 ret, pcm512x->pll_out);
1353                         return ret;
1354                 }
1355         }
1356 
1357         ret = regmap_update_bits(pcm512x->regmap, PCM512x_SYNCHRONIZE,
1358                                  PCM512x_RQSY, PCM512x_RQSY_HALT);
1359         if (ret != 0) {
1360                 dev_err(component->dev, "Failed to halt clocks: %d\n", ret);
1361                 return ret;
1362         }
1363 
1364         ret = regmap_update_bits(pcm512x->regmap, PCM512x_SYNCHRONIZE,
1365                                  PCM512x_RQSY, PCM512x_RQSY_RESUME);
1366         if (ret != 0) {
1367                 dev_err(component->dev, "Failed to resume clocks: %d\n", ret);
1368                 return ret;
1369         }
1370 
1371         return 0;
1372 }
1373 
1374 static int pcm512x_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
1375 {
1376         struct snd_soc_component *component = dai->component;
1377         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
1378 
1379         pcm512x->fmt = fmt;
1380 
1381         return 0;
1382 }
1383 
1384 static int pcm512x_set_bclk_ratio(struct snd_soc_dai *dai, unsigned int ratio)
1385 {
1386         struct snd_soc_component *component = dai->component;
1387         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
1388 
1389         if (ratio > 256)
1390                 return -EINVAL;
1391 
1392         pcm512x->bclk_ratio = ratio;
1393 
1394         return 0;
1395 }
1396 
1397 static int pcm512x_digital_mute(struct snd_soc_dai *dai, int mute)
1398 {
1399         struct snd_soc_component *component = dai->component;
1400         struct pcm512x_priv *pcm512x = snd_soc_component_get_drvdata(component);
1401         int ret;
1402         unsigned int mute_det;
1403 
1404         mutex_lock(&pcm512x->mutex);
1405 
1406         if (mute) {
1407                 pcm512x->mute |= 0x1;
1408                 ret = regmap_update_bits(pcm512x->regmap, PCM512x_MUTE,
1409                                          PCM512x_RQML | PCM512x_RQMR,
1410                                          PCM512x_RQML | PCM512x_RQMR);
1411                 if (ret != 0) {
1412                         dev_err(component->dev,
1413                                 "Failed to set digital mute: %d\n", ret);
1414                         goto unlock;
1415                 }
1416 
1417                 regmap_read_poll_timeout(pcm512x->regmap,
1418                                          PCM512x_ANALOG_MUTE_DET,
1419                                          mute_det, (mute_det & 0x3) == 0,
1420                                          200, 10000);
1421         } else {
1422                 pcm512x->mute &= ~0x1;
1423                 ret = pcm512x_update_mute(pcm512x);
1424                 if (ret != 0) {
1425                         dev_err(component->dev,
1426                                 "Failed to update digital mute: %d\n", ret);
1427                         goto unlock;
1428                 }
1429 
1430                 regmap_read_poll_timeout(pcm512x->regmap,
1431                                          PCM512x_ANALOG_MUTE_DET,
1432                                          mute_det,
1433                                          (mute_det & 0x3)
1434                                          == ((~pcm512x->mute >> 1) & 0x3),
1435                                          200, 10000);
1436         }
1437 
1438 unlock:
1439         mutex_unlock(&pcm512x->mutex);
1440 
1441         return ret;
1442 }
1443 
1444 static const struct snd_soc_dai_ops pcm512x_dai_ops = {
1445         .startup = pcm512x_dai_startup,
1446         .hw_params = pcm512x_hw_params,
1447         .set_fmt = pcm512x_set_fmt,
1448         .digital_mute = pcm512x_digital_mute,
1449         .set_bclk_ratio = pcm512x_set_bclk_ratio,
1450 };
1451 
1452 static struct snd_soc_dai_driver pcm512x_dai = {
1453         .name = "pcm512x-hifi",
1454         .playback = {
1455                 .stream_name = "Playback",
1456                 .channels_min = 2,
1457                 .channels_max = 2,
1458                 .rates = SNDRV_PCM_RATE_CONTINUOUS,
1459                 .rate_min = 8000,
1460                 .rate_max = 384000,
1461                 .formats = SNDRV_PCM_FMTBIT_S16_LE |
1462                            SNDRV_PCM_FMTBIT_S24_LE |
1463                            SNDRV_PCM_FMTBIT_S32_LE
1464         },
1465         .ops = &pcm512x_dai_ops,
1466 };
1467 
1468 static const struct snd_soc_component_driver pcm512x_component_driver = {
1469         .set_bias_level         = pcm512x_set_bias_level,
1470         .controls               = pcm512x_controls,
1471         .num_controls           = ARRAY_SIZE(pcm512x_controls),
1472         .dapm_widgets           = pcm512x_dapm_widgets,
1473         .num_dapm_widgets       = ARRAY_SIZE(pcm512x_dapm_widgets),
1474         .dapm_routes            = pcm512x_dapm_routes,
1475         .num_dapm_routes        = ARRAY_SIZE(pcm512x_dapm_routes),
1476         .use_pmdown_time        = 1,
1477         .endianness             = 1,
1478         .non_legacy_dai_naming  = 1,
1479 };
1480 
1481 static const struct regmap_range_cfg pcm512x_range = {
1482         .name = "Pages", .range_min = PCM512x_VIRT_BASE,
1483         .range_max = PCM512x_MAX_REGISTER,
1484         .selector_reg = PCM512x_PAGE,
1485         .selector_mask = 0xff,
1486         .window_start = 0, .window_len = 0x100,
1487 };
1488 
1489 const struct regmap_config pcm512x_regmap = {
1490         .reg_bits = 8,
1491         .val_bits = 8,
1492 
1493         .readable_reg = pcm512x_readable,
1494         .volatile_reg = pcm512x_volatile,
1495 
1496         .ranges = &pcm512x_range,
1497         .num_ranges = 1,
1498 
1499         .max_register = PCM512x_MAX_REGISTER,
1500         .reg_defaults = pcm512x_reg_defaults,
1501         .num_reg_defaults = ARRAY_SIZE(pcm512x_reg_defaults),
1502         .cache_type = REGCACHE_RBTREE,
1503 };
1504 EXPORT_SYMBOL_GPL(pcm512x_regmap);
1505 
1506 int pcm512x_probe(struct device *dev, struct regmap *regmap)
1507 {
1508         struct pcm512x_priv *pcm512x;
1509         int i, ret;
1510 
1511         pcm512x = devm_kzalloc(dev, sizeof(struct pcm512x_priv), GFP_KERNEL);
1512         if (!pcm512x)
1513                 return -ENOMEM;
1514 
1515         mutex_init(&pcm512x->mutex);
1516 
1517         dev_set_drvdata(dev, pcm512x);
1518         pcm512x->regmap = regmap;
1519 
1520         for (i = 0; i < ARRAY_SIZE(pcm512x->supplies); i++)
1521                 pcm512x->supplies[i].supply = pcm512x_supply_names[i];
1522 
1523         ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(pcm512x->supplies),
1524                                       pcm512x->supplies);
1525         if (ret != 0) {
1526                 dev_err(dev, "Failed to get supplies: %d\n", ret);
1527                 return ret;
1528         }
1529 
1530         pcm512x->supply_nb[0].notifier_call = pcm512x_regulator_event_0;
1531         pcm512x->supply_nb[1].notifier_call = pcm512x_regulator_event_1;
1532         pcm512x->supply_nb[2].notifier_call = pcm512x_regulator_event_2;
1533 
1534         for (i = 0; i < ARRAY_SIZE(pcm512x->supplies); i++) {
1535                 ret = devm_regulator_register_notifier(
1536                                                 pcm512x->supplies[i].consumer,
1537                                                 &pcm512x->supply_nb[i]);
1538                 if (ret != 0) {
1539                         dev_err(dev,
1540                                 "Failed to register regulator notifier: %d\n",
1541                                 ret);
1542                 }
1543         }
1544 
1545         ret = regulator_bulk_enable(ARRAY_SIZE(pcm512x->supplies),
1546                                     pcm512x->supplies);
1547         if (ret != 0) {
1548                 dev_err(dev, "Failed to enable supplies: %d\n", ret);
1549                 return ret;
1550         }
1551 
1552         /* Reset the device, verifying I/O in the process for I2C */
1553         ret = regmap_write(regmap, PCM512x_RESET,
1554                            PCM512x_RSTM | PCM512x_RSTR);
1555         if (ret != 0) {
1556                 dev_err(dev, "Failed to reset device: %d\n", ret);
1557                 goto err;
1558         }
1559 
1560         ret = regmap_write(regmap, PCM512x_RESET, 0);
1561         if (ret != 0) {
1562                 dev_err(dev, "Failed to reset device: %d\n", ret);
1563                 goto err;
1564         }
1565 
1566         pcm512x->sclk = devm_clk_get(dev, NULL);
1567         if (PTR_ERR(pcm512x->sclk) == -EPROBE_DEFER) {
1568                 ret = -EPROBE_DEFER;
1569                 goto err;
1570         }
1571         if (!IS_ERR(pcm512x->sclk)) {
1572                 ret = clk_prepare_enable(pcm512x->sclk);
1573                 if (ret != 0) {
1574                         dev_err(dev, "Failed to enable SCLK: %d\n", ret);
1575                         goto err;
1576                 }
1577         }
1578 
1579         /* Default to standby mode */
1580         ret = regmap_update_bits(pcm512x->regmap, PCM512x_POWER,
1581                                  PCM512x_RQST, PCM512x_RQST);
1582         if (ret != 0) {
1583                 dev_err(dev, "Failed to request standby: %d\n",
1584                         ret);
1585                 goto err_clk;
1586         }
1587 
1588         pm_runtime_set_active(dev);
1589         pm_runtime_enable(dev);
1590         pm_runtime_idle(dev);
1591 
1592 #ifdef CONFIG_OF
1593         if (dev->of_node) {
1594                 const struct device_node *np = dev->of_node;
1595                 u32 val;
1596 
1597                 if (of_property_read_u32(np, "pll-in", &val) >= 0) {
1598                         if (val > 6) {
1599                                 dev_err(dev, "Invalid pll-in\n");
1600                                 ret = -EINVAL;
1601                                 goto err_clk;
1602                         }
1603                         pcm512x->pll_in = val;
1604                 }
1605 
1606                 if (of_property_read_u32(np, "pll-out", &val) >= 0) {
1607                         if (val > 6) {
1608                                 dev_err(dev, "Invalid pll-out\n");
1609                                 ret = -EINVAL;
1610                                 goto err_clk;
1611                         }
1612                         pcm512x->pll_out = val;
1613                 }
1614 
1615                 if (!pcm512x->pll_in != !pcm512x->pll_out) {
1616                         dev_err(dev,
1617                                 "Error: both pll-in and pll-out, or none\n");
1618                         ret = -EINVAL;
1619                         goto err_clk;
1620                 }
1621                 if (pcm512x->pll_in && pcm512x->pll_in == pcm512x->pll_out) {
1622                         dev_err(dev, "Error: pll-in == pll-out\n");
1623                         ret = -EINVAL;
1624                         goto err_clk;
1625                 }
1626         }
1627 #endif
1628 
1629         ret = devm_snd_soc_register_component(dev, &pcm512x_component_driver,
1630                                     &pcm512x_dai, 1);
1631         if (ret != 0) {
1632                 dev_err(dev, "Failed to register CODEC: %d\n", ret);
1633                 goto err_pm;
1634         }
1635 
1636         return 0;
1637 
1638 err_pm:
1639         pm_runtime_disable(dev);
1640 err_clk:
1641         if (!IS_ERR(pcm512x->sclk))
1642                 clk_disable_unprepare(pcm512x->sclk);
1643 err:
1644         regulator_bulk_disable(ARRAY_SIZE(pcm512x->supplies),
1645                                      pcm512x->supplies);
1646         return ret;
1647 }
1648 EXPORT_SYMBOL_GPL(pcm512x_probe);
1649 
1650 void pcm512x_remove(struct device *dev)
1651 {
1652         struct pcm512x_priv *pcm512x = dev_get_drvdata(dev);
1653 
1654         pm_runtime_disable(dev);
1655         if (!IS_ERR(pcm512x->sclk))
1656                 clk_disable_unprepare(pcm512x->sclk);
1657         regulator_bulk_disable(ARRAY_SIZE(pcm512x->supplies),
1658                                pcm512x->supplies);
1659 }
1660 EXPORT_SYMBOL_GPL(pcm512x_remove);
1661 
1662 #ifdef CONFIG_PM
1663 static int pcm512x_suspend(struct device *dev)
1664 {
1665         struct pcm512x_priv *pcm512x = dev_get_drvdata(dev);
1666         int ret;
1667 
1668         ret = regmap_update_bits(pcm512x->regmap, PCM512x_POWER,
1669                                  PCM512x_RQPD, PCM512x_RQPD);
1670         if (ret != 0) {
1671                 dev_err(dev, "Failed to request power down: %d\n", ret);
1672                 return ret;
1673         }
1674 
1675         ret = regulator_bulk_disable(ARRAY_SIZE(pcm512x->supplies),
1676                                      pcm512x->supplies);
1677         if (ret != 0) {
1678                 dev_err(dev, "Failed to disable supplies: %d\n", ret);
1679                 return ret;
1680         }
1681 
1682         if (!IS_ERR(pcm512x->sclk))
1683                 clk_disable_unprepare(pcm512x->sclk);
1684 
1685         return 0;
1686 }
1687 
1688 static int pcm512x_resume(struct device *dev)
1689 {
1690         struct pcm512x_priv *pcm512x = dev_get_drvdata(dev);
1691         int ret;
1692 
1693         if (!IS_ERR(pcm512x->sclk)) {
1694                 ret = clk_prepare_enable(pcm512x->sclk);
1695                 if (ret != 0) {
1696                         dev_err(dev, "Failed to enable SCLK: %d\n", ret);
1697                         return ret;
1698                 }
1699         }
1700 
1701         ret = regulator_bulk_enable(ARRAY_SIZE(pcm512x->supplies),
1702                                     pcm512x->supplies);
1703         if (ret != 0) {
1704                 dev_err(dev, "Failed to enable supplies: %d\n", ret);
1705                 return ret;
1706         }
1707 
1708         regcache_cache_only(pcm512x->regmap, false);
1709         ret = regcache_sync(pcm512x->regmap);
1710         if (ret != 0) {
1711                 dev_err(dev, "Failed to sync cache: %d\n", ret);
1712                 return ret;
1713         }
1714 
1715         ret = regmap_update_bits(pcm512x->regmap, PCM512x_POWER,
1716                                  PCM512x_RQPD, 0);
1717         if (ret != 0) {
1718                 dev_err(dev, "Failed to remove power down: %d\n", ret);
1719                 return ret;
1720         }
1721 
1722         return 0;
1723 }
1724 #endif
1725 
1726 const struct dev_pm_ops pcm512x_pm_ops = {
1727         SET_RUNTIME_PM_OPS(pcm512x_suspend, pcm512x_resume, NULL)
1728 };
1729 EXPORT_SYMBOL_GPL(pcm512x_pm_ops);
1730 
1731 MODULE_DESCRIPTION("ASoC PCM512x codec driver");
1732 MODULE_AUTHOR("Mark Brown <broonie@kernel.org>");
1733 MODULE_LICENSE("GPL v2");

/* [<][>][^][v][top][bottom][index][help] */