1 /* 2 * cs4265.c -- CS4265 ALSA SoC audio driver 3 * 4 * Copyright 2014 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/gpio/consumer.h> 18 #include <linux/init.h> 19 #include <linux/delay.h> 20 #include <linux/i2c.h> 21 #include <linux/input.h> 22 #include <linux/regmap.h> 23 #include <linux/slab.h> 24 #include <linux/platform_device.h> 25 #include <sound/core.h> 26 #include <sound/pcm.h> 27 #include <sound/pcm_params.h> 28 #include <sound/soc.h> 29 #include <sound/soc-dapm.h> 30 #include <sound/initval.h> 31 #include <sound/tlv.h> 32 #include "cs4265.h" 33 34 struct cs4265_private { 35 struct regmap *regmap; 36 struct gpio_desc *reset_gpio; 37 u8 format; 38 u32 sysclk; 39 }; 40 41 static const struct reg_default cs4265_reg_defaults[] = { 42 { CS4265_PWRCTL, 0x0F }, 43 { CS4265_DAC_CTL, 0x08 }, 44 { CS4265_ADC_CTL, 0x00 }, 45 { CS4265_MCLK_FREQ, 0x00 }, 46 { CS4265_SIG_SEL, 0x40 }, 47 { CS4265_CHB_PGA_CTL, 0x00 }, 48 { CS4265_CHA_PGA_CTL, 0x00 }, 49 { CS4265_ADC_CTL2, 0x19 }, 50 { CS4265_DAC_CHA_VOL, 0x00 }, 51 { CS4265_DAC_CHB_VOL, 0x00 }, 52 { CS4265_DAC_CTL2, 0xC0 }, 53 { CS4265_SPDIF_CTL1, 0x00 }, 54 { CS4265_SPDIF_CTL2, 0x00 }, 55 { CS4265_INT_MASK, 0x00 }, 56 { CS4265_STATUS_MODE_MSB, 0x00 }, 57 { CS4265_STATUS_MODE_LSB, 0x00 }, 58 }; 59 60 static bool cs4265_readable_register(struct device *dev, unsigned int reg) 61 { 62 switch (reg) { 63 case CS4265_CHIP_ID ... CS4265_SPDIF_CTL2: 64 return true; 65 default: 66 return false; 67 } 68 } 69 70 static bool cs4265_volatile_register(struct device *dev, unsigned int reg) 71 { 72 switch (reg) { 73 case CS4265_INT_STATUS: 74 return true; 75 default: 76 return false; 77 } 78 } 79 80 static DECLARE_TLV_DB_SCALE(pga_tlv, -1200, 50, 0); 81 82 static DECLARE_TLV_DB_SCALE(dac_tlv, -12750, 50, 0); 83 84 static const char * const digital_input_mux_text[] = { 85 "SDIN1", "SDIN2" 86 }; 87 88 static SOC_ENUM_SINGLE_DECL(digital_input_mux_enum, CS4265_SIG_SEL, 7, 89 digital_input_mux_text); 90 91 static const struct snd_kcontrol_new digital_input_mux = 92 SOC_DAPM_ENUM("Digital Input Mux", digital_input_mux_enum); 93 94 static const char * const mic_linein_text[] = { 95 "MIC", "LINEIN" 96 }; 97 98 static SOC_ENUM_SINGLE_DECL(mic_linein_enum, CS4265_ADC_CTL2, 0, 99 mic_linein_text); 100 101 static const char * const cam_mode_text[] = { 102 "One Byte", "Two Byte" 103 }; 104 105 static SOC_ENUM_SINGLE_DECL(cam_mode_enum, CS4265_SPDIF_CTL1, 5, 106 cam_mode_text); 107 108 static const char * const cam_mono_stereo_text[] = { 109 "Stereo", "Mono" 110 }; 111 112 static SOC_ENUM_SINGLE_DECL(spdif_mono_stereo_enum, CS4265_SPDIF_CTL2, 2, 113 cam_mono_stereo_text); 114 115 static const char * const mono_select_text[] = { 116 "Channel A", "Channel B" 117 }; 118 119 static SOC_ENUM_SINGLE_DECL(spdif_mono_select_enum, CS4265_SPDIF_CTL2, 0, 120 mono_select_text); 121 122 static const struct snd_kcontrol_new mic_linein_mux = 123 SOC_DAPM_ENUM("ADC Input Capture Mux", mic_linein_enum); 124 125 static const struct snd_kcontrol_new loopback_ctl = 126 SOC_DAPM_SINGLE("Switch", CS4265_SIG_SEL, 1, 1, 0); 127 128 static const struct snd_kcontrol_new spdif_switch = 129 SOC_DAPM_SINGLE("Switch", SND_SOC_NOPM, 0, 0, 0); 130 131 static const struct snd_kcontrol_new dac_switch = 132 SOC_DAPM_SINGLE("Switch", CS4265_PWRCTL, 1, 1, 0); 133 134 static const struct snd_kcontrol_new cs4265_snd_controls[] = { 135 136 SOC_DOUBLE_R_SX_TLV("PGA Volume", CS4265_CHA_PGA_CTL, 137 CS4265_CHB_PGA_CTL, 0, 0x28, 0x30, pga_tlv), 138 SOC_DOUBLE_R_TLV("DAC Volume", CS4265_DAC_CHA_VOL, 139 CS4265_DAC_CHB_VOL, 0, 0xFF, 1, dac_tlv), 140 SOC_SINGLE("De-emp 44.1kHz Switch", CS4265_DAC_CTL, 1, 141 1, 0), 142 SOC_SINGLE("DAC INV Switch", CS4265_DAC_CTL2, 5, 143 1, 0), 144 SOC_SINGLE("DAC Zero Cross Switch", CS4265_DAC_CTL2, 6, 145 1, 0), 146 SOC_SINGLE("DAC Soft Ramp Switch", CS4265_DAC_CTL2, 7, 147 1, 0), 148 SOC_SINGLE("ADC HPF Switch", CS4265_ADC_CTL, 1, 149 1, 0), 150 SOC_SINGLE("ADC Zero Cross Switch", CS4265_ADC_CTL2, 3, 151 1, 1), 152 SOC_SINGLE("ADC Soft Ramp Switch", CS4265_ADC_CTL2, 7, 153 1, 0), 154 SOC_SINGLE("E to F Buffer Disable Switch", CS4265_SPDIF_CTL1, 155 6, 1, 0), 156 SOC_ENUM("C Data Access", cam_mode_enum), 157 SOC_SINGLE("Validity Bit Control Switch", CS4265_SPDIF_CTL2, 158 3, 1, 0), 159 SOC_ENUM("SPDIF Mono/Stereo", spdif_mono_stereo_enum), 160 SOC_SINGLE("MMTLR Data Switch", 0, 161 1, 1, 0), 162 SOC_ENUM("Mono Channel Select", spdif_mono_select_enum), 163 SND_SOC_BYTES("C Data Buffer", CS4265_C_DATA_BUFF, 24), 164 }; 165 166 static const struct snd_soc_dapm_widget cs4265_dapm_widgets[] = { 167 168 SND_SOC_DAPM_INPUT("LINEINL"), 169 SND_SOC_DAPM_INPUT("LINEINR"), 170 SND_SOC_DAPM_INPUT("MICL"), 171 SND_SOC_DAPM_INPUT("MICR"), 172 173 SND_SOC_DAPM_AIF_OUT("DOUT", NULL, 0, 174 SND_SOC_NOPM, 0, 0), 175 SND_SOC_DAPM_AIF_OUT("SPDIFOUT", NULL, 0, 176 SND_SOC_NOPM, 0, 0), 177 178 SND_SOC_DAPM_MUX("ADC Mux", SND_SOC_NOPM, 0, 0, &mic_linein_mux), 179 180 SND_SOC_DAPM_ADC("ADC", NULL, CS4265_PWRCTL, 2, 1), 181 SND_SOC_DAPM_PGA("Pre-amp MIC", CS4265_PWRCTL, 3, 182 1, NULL, 0), 183 184 SND_SOC_DAPM_MUX("Input Mux", SND_SOC_NOPM, 185 0, 0, &digital_input_mux), 186 187 SND_SOC_DAPM_MIXER("SDIN1 Input Mixer", SND_SOC_NOPM, 0, 0, NULL, 0), 188 SND_SOC_DAPM_MIXER("SDIN2 Input Mixer", SND_SOC_NOPM, 0, 0, NULL, 0), 189 SND_SOC_DAPM_MIXER("SPDIF Transmitter", SND_SOC_NOPM, 0, 0, NULL, 0), 190 191 SND_SOC_DAPM_SWITCH("Loopback", SND_SOC_NOPM, 0, 0, 192 &loopback_ctl), 193 SND_SOC_DAPM_SWITCH("SPDIF", SND_SOC_NOPM, 0, 0, 194 &spdif_switch), 195 SND_SOC_DAPM_SWITCH("DAC", CS4265_PWRCTL, 1, 1, 196 &dac_switch), 197 198 SND_SOC_DAPM_AIF_IN("DIN1", NULL, 0, 199 SND_SOC_NOPM, 0, 0), 200 SND_SOC_DAPM_AIF_IN("DIN2", NULL, 0, 201 SND_SOC_NOPM, 0, 0), 202 SND_SOC_DAPM_AIF_IN("TXIN", NULL, 0, 203 CS4265_SPDIF_CTL2, 5, 1), 204 205 SND_SOC_DAPM_OUTPUT("LINEOUTL"), 206 SND_SOC_DAPM_OUTPUT("LINEOUTR"), 207 208 }; 209 210 static const struct snd_soc_dapm_route cs4265_audio_map[] = { 211 212 {"DIN1", NULL, "DAI1 Playback"}, 213 {"DIN2", NULL, "DAI2 Playback"}, 214 {"SDIN1 Input Mixer", NULL, "DIN1"}, 215 {"SDIN2 Input Mixer", NULL, "DIN2"}, 216 {"Input Mux", "SDIN1", "SDIN1 Input Mixer"}, 217 {"Input Mux", "SDIN2", "SDIN2 Input Mixer"}, 218 {"DAC", "Switch", "Input Mux"}, 219 {"SPDIF", "Switch", "Input Mux"}, 220 {"LINEOUTL", NULL, "DAC"}, 221 {"LINEOUTR", NULL, "DAC"}, 222 {"SPDIFOUT", NULL, "SPDIF"}, 223 224 {"ADC Mux", "LINEIN", "LINEINL"}, 225 {"ADC Mux", "LINEIN", "LINEINR"}, 226 {"ADC Mux", "MIC", "MICL"}, 227 {"ADC Mux", "MIC", "MICR"}, 228 {"ADC", NULL, "ADC Mux"}, 229 {"DOUT", NULL, "ADC"}, 230 {"DAI1 Capture", NULL, "DOUT"}, 231 {"DAI2 Capture", NULL, "DOUT"}, 232 233 /* Loopback */ 234 {"Loopback", "Switch", "ADC"}, 235 {"DAC", NULL, "Loopback"}, 236 }; 237 238 struct cs4265_clk_para { 239 u32 mclk; 240 u32 rate; 241 u8 fm_mode; /* values 1, 2, or 4 */ 242 u8 mclkdiv; 243 }; 244 245 static const struct cs4265_clk_para clk_map_table[] = { 246 /*32k*/ 247 {8192000, 32000, 0, 0}, 248 {12288000, 32000, 0, 1}, 249 {16384000, 32000, 0, 2}, 250 {24576000, 32000, 0, 3}, 251 {32768000, 32000, 0, 4}, 252 253 /*44.1k*/ 254 {11289600, 44100, 0, 0}, 255 {16934400, 44100, 0, 1}, 256 {22579200, 44100, 0, 2}, 257 {33868000, 44100, 0, 3}, 258 {45158400, 44100, 0, 4}, 259 260 /*48k*/ 261 {12288000, 48000, 0, 0}, 262 {18432000, 48000, 0, 1}, 263 {24576000, 48000, 0, 2}, 264 {36864000, 48000, 0, 3}, 265 {49152000, 48000, 0, 4}, 266 267 /*64k*/ 268 {8192000, 64000, 1, 0}, 269 {12288000, 64000, 1, 1}, 270 {16934400, 64000, 1, 2}, 271 {24576000, 64000, 1, 3}, 272 {32768000, 64000, 1, 4}, 273 274 /* 88.2k */ 275 {11289600, 88200, 1, 0}, 276 {16934400, 88200, 1, 1}, 277 {22579200, 88200, 1, 2}, 278 {33868000, 88200, 1, 3}, 279 {45158400, 88200, 1, 4}, 280 281 /* 96k */ 282 {12288000, 96000, 1, 0}, 283 {18432000, 96000, 1, 1}, 284 {24576000, 96000, 1, 2}, 285 {36864000, 96000, 1, 3}, 286 {49152000, 96000, 1, 4}, 287 288 /* 128k */ 289 {8192000, 128000, 2, 0}, 290 {12288000, 128000, 2, 1}, 291 {16934400, 128000, 2, 2}, 292 {24576000, 128000, 2, 3}, 293 {32768000, 128000, 2, 4}, 294 295 /* 176.4k */ 296 {11289600, 176400, 2, 0}, 297 {16934400, 176400, 2, 1}, 298 {22579200, 176400, 2, 2}, 299 {33868000, 176400, 2, 3}, 300 {49152000, 176400, 2, 4}, 301 302 /* 192k */ 303 {12288000, 192000, 2, 0}, 304 {18432000, 192000, 2, 1}, 305 {24576000, 192000, 2, 2}, 306 {36864000, 192000, 2, 3}, 307 {49152000, 192000, 2, 4}, 308 }; 309 310 static int cs4265_get_clk_index(int mclk, int rate) 311 { 312 int i; 313 314 for (i = 0; i < ARRAY_SIZE(clk_map_table); i++) { 315 if (clk_map_table[i].rate == rate && 316 clk_map_table[i].mclk == mclk) 317 return i; 318 } 319 return -EINVAL; 320 } 321 322 static int cs4265_set_sysclk(struct snd_soc_dai *codec_dai, int clk_id, 323 unsigned int freq, int dir) 324 { 325 struct snd_soc_component *component = codec_dai->component; 326 struct cs4265_private *cs4265 = snd_soc_component_get_drvdata(component); 327 int i; 328 329 if (clk_id != 0) { 330 dev_err(component->dev, "Invalid clk_id %d\n", clk_id); 331 return -EINVAL; 332 } 333 for (i = 0; i < ARRAY_SIZE(clk_map_table); i++) { 334 if (clk_map_table[i].mclk == freq) { 335 cs4265->sysclk = freq; 336 return 0; 337 } 338 } 339 cs4265->sysclk = 0; 340 dev_err(component->dev, "Invalid freq parameter %d\n", freq); 341 return -EINVAL; 342 } 343 344 static int cs4265_set_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt) 345 { 346 struct snd_soc_component *component = codec_dai->component; 347 struct cs4265_private *cs4265 = snd_soc_component_get_drvdata(component); 348 u8 iface = 0; 349 350 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { 351 case SND_SOC_DAIFMT_CBM_CFM: 352 snd_soc_component_update_bits(component, CS4265_ADC_CTL, 353 CS4265_ADC_MASTER, 354 CS4265_ADC_MASTER); 355 break; 356 case SND_SOC_DAIFMT_CBS_CFS: 357 snd_soc_component_update_bits(component, CS4265_ADC_CTL, 358 CS4265_ADC_MASTER, 359 0); 360 break; 361 default: 362 return -EINVAL; 363 } 364 365 /* interface format */ 366 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { 367 case SND_SOC_DAIFMT_I2S: 368 iface |= SND_SOC_DAIFMT_I2S; 369 break; 370 case SND_SOC_DAIFMT_RIGHT_J: 371 iface |= SND_SOC_DAIFMT_RIGHT_J; 372 break; 373 case SND_SOC_DAIFMT_LEFT_J: 374 iface |= SND_SOC_DAIFMT_LEFT_J; 375 break; 376 default: 377 return -EINVAL; 378 } 379 380 cs4265->format = iface; 381 return 0; 382 } 383 384 static int cs4265_digital_mute(struct snd_soc_dai *dai, int mute) 385 { 386 struct snd_soc_component *component = dai->component; 387 388 if (mute) { 389 snd_soc_component_update_bits(component, CS4265_DAC_CTL, 390 CS4265_DAC_CTL_MUTE, 391 CS4265_DAC_CTL_MUTE); 392 snd_soc_component_update_bits(component, CS4265_SPDIF_CTL2, 393 CS4265_SPDIF_CTL2_MUTE, 394 CS4265_SPDIF_CTL2_MUTE); 395 } else { 396 snd_soc_component_update_bits(component, CS4265_DAC_CTL, 397 CS4265_DAC_CTL_MUTE, 398 0); 399 snd_soc_component_update_bits(component, CS4265_SPDIF_CTL2, 400 CS4265_SPDIF_CTL2_MUTE, 401 0); 402 } 403 return 0; 404 } 405 406 static int cs4265_pcm_hw_params(struct snd_pcm_substream *substream, 407 struct snd_pcm_hw_params *params, 408 struct snd_soc_dai *dai) 409 { 410 struct snd_soc_component *component = dai->component; 411 struct cs4265_private *cs4265 = snd_soc_component_get_drvdata(component); 412 int index; 413 414 if (substream->stream == SNDRV_PCM_STREAM_CAPTURE && 415 ((cs4265->format & SND_SOC_DAIFMT_FORMAT_MASK) 416 == SND_SOC_DAIFMT_RIGHT_J)) 417 return -EINVAL; 418 419 index = cs4265_get_clk_index(cs4265->sysclk, params_rate(params)); 420 if (index >= 0) { 421 snd_soc_component_update_bits(component, CS4265_ADC_CTL, 422 CS4265_ADC_FM, clk_map_table[index].fm_mode << 6); 423 snd_soc_component_update_bits(component, CS4265_MCLK_FREQ, 424 CS4265_MCLK_FREQ_MASK, 425 clk_map_table[index].mclkdiv << 4); 426 427 } else { 428 dev_err(component->dev, "can't get correct mclk\n"); 429 return -EINVAL; 430 } 431 432 switch (cs4265->format & SND_SOC_DAIFMT_FORMAT_MASK) { 433 case SND_SOC_DAIFMT_I2S: 434 snd_soc_component_update_bits(component, CS4265_DAC_CTL, 435 CS4265_DAC_CTL_DIF, (1 << 4)); 436 snd_soc_component_update_bits(component, CS4265_ADC_CTL, 437 CS4265_ADC_DIF, (1 << 4)); 438 snd_soc_component_update_bits(component, CS4265_SPDIF_CTL2, 439 CS4265_SPDIF_CTL2_DIF, (1 << 6)); 440 break; 441 case SND_SOC_DAIFMT_RIGHT_J: 442 if (params_width(params) == 16) { 443 snd_soc_component_update_bits(component, CS4265_DAC_CTL, 444 CS4265_DAC_CTL_DIF, (2 << 4)); 445 snd_soc_component_update_bits(component, CS4265_SPDIF_CTL2, 446 CS4265_SPDIF_CTL2_DIF, (2 << 6)); 447 } else { 448 snd_soc_component_update_bits(component, CS4265_DAC_CTL, 449 CS4265_DAC_CTL_DIF, (3 << 4)); 450 snd_soc_component_update_bits(component, CS4265_SPDIF_CTL2, 451 CS4265_SPDIF_CTL2_DIF, (3 << 6)); 452 } 453 break; 454 case SND_SOC_DAIFMT_LEFT_J: 455 snd_soc_component_update_bits(component, CS4265_DAC_CTL, 456 CS4265_DAC_CTL_DIF, 0); 457 snd_soc_component_update_bits(component, CS4265_ADC_CTL, 458 CS4265_ADC_DIF, 0); 459 snd_soc_component_update_bits(component, CS4265_SPDIF_CTL2, 460 CS4265_SPDIF_CTL2_DIF, 0); 461 462 break; 463 default: 464 return -EINVAL; 465 } 466 return 0; 467 } 468 469 static int cs4265_set_bias_level(struct snd_soc_component *component, 470 enum snd_soc_bias_level level) 471 { 472 switch (level) { 473 case SND_SOC_BIAS_ON: 474 break; 475 case SND_SOC_BIAS_PREPARE: 476 snd_soc_component_update_bits(component, CS4265_PWRCTL, 477 CS4265_PWRCTL_PDN, 0); 478 break; 479 case SND_SOC_BIAS_STANDBY: 480 snd_soc_component_update_bits(component, CS4265_PWRCTL, 481 CS4265_PWRCTL_PDN, 482 CS4265_PWRCTL_PDN); 483 break; 484 case SND_SOC_BIAS_OFF: 485 snd_soc_component_update_bits(component, CS4265_PWRCTL, 486 CS4265_PWRCTL_PDN, 487 CS4265_PWRCTL_PDN); 488 break; 489 } 490 return 0; 491 } 492 493 #define CS4265_RATES (SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 | \ 494 SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_64000 | \ 495 SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000 | \ 496 SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_192000) 497 498 #define CS4265_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_U16_LE | \ 499 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_U24_LE) 500 501 static const struct snd_soc_dai_ops cs4265_ops = { 502 .hw_params = cs4265_pcm_hw_params, 503 .digital_mute = cs4265_digital_mute, 504 .set_fmt = cs4265_set_fmt, 505 .set_sysclk = cs4265_set_sysclk, 506 }; 507 508 static struct snd_soc_dai_driver cs4265_dai[] = { 509 { 510 .name = "cs4265-dai1", 511 .playback = { 512 .stream_name = "DAI1 Playback", 513 .channels_min = 1, 514 .channels_max = 2, 515 .rates = CS4265_RATES, 516 .formats = CS4265_FORMATS, 517 }, 518 .capture = { 519 .stream_name = "DAI1 Capture", 520 .channels_min = 1, 521 .channels_max = 2, 522 .rates = CS4265_RATES, 523 .formats = CS4265_FORMATS, 524 }, 525 .ops = &cs4265_ops, 526 }, 527 { 528 .name = "cs4265-dai2", 529 .playback = { 530 .stream_name = "DAI2 Playback", 531 .channels_min = 1, 532 .channels_max = 2, 533 .rates = CS4265_RATES, 534 .formats = CS4265_FORMATS, 535 }, 536 .capture = { 537 .stream_name = "DAI2 Capture", 538 .channels_min = 1, 539 .channels_max = 2, 540 .rates = CS4265_RATES, 541 .formats = CS4265_FORMATS, 542 }, 543 .ops = &cs4265_ops, 544 }, 545 }; 546 547 static const struct snd_soc_component_driver soc_component_cs4265 = { 548 .set_bias_level = cs4265_set_bias_level, 549 .controls = cs4265_snd_controls, 550 .num_controls = ARRAY_SIZE(cs4265_snd_controls), 551 .dapm_widgets = cs4265_dapm_widgets, 552 .num_dapm_widgets = ARRAY_SIZE(cs4265_dapm_widgets), 553 .dapm_routes = cs4265_audio_map, 554 .num_dapm_routes = ARRAY_SIZE(cs4265_audio_map), 555 .idle_bias_on = 1, 556 .use_pmdown_time = 1, 557 .endianness = 1, 558 .non_legacy_dai_naming = 1, 559 }; 560 561 static const struct regmap_config cs4265_regmap = { 562 .reg_bits = 8, 563 .val_bits = 8, 564 565 .max_register = CS4265_MAX_REGISTER, 566 .reg_defaults = cs4265_reg_defaults, 567 .num_reg_defaults = ARRAY_SIZE(cs4265_reg_defaults), 568 .readable_reg = cs4265_readable_register, 569 .volatile_reg = cs4265_volatile_register, 570 .cache_type = REGCACHE_RBTREE, 571 }; 572 573 static int cs4265_i2c_probe(struct i2c_client *i2c_client, 574 const struct i2c_device_id *id) 575 { 576 struct cs4265_private *cs4265; 577 int ret = 0; 578 unsigned int devid = 0; 579 unsigned int reg; 580 581 cs4265 = devm_kzalloc(&i2c_client->dev, sizeof(struct cs4265_private), 582 GFP_KERNEL); 583 if (cs4265 == NULL) 584 return -ENOMEM; 585 586 cs4265->regmap = devm_regmap_init_i2c(i2c_client, &cs4265_regmap); 587 if (IS_ERR(cs4265->regmap)) { 588 ret = PTR_ERR(cs4265->regmap); 589 dev_err(&i2c_client->dev, "regmap_init() failed: %d\n", ret); 590 return ret; 591 } 592 593 cs4265->reset_gpio = devm_gpiod_get_optional(&i2c_client->dev, 594 "reset", GPIOD_OUT_LOW); 595 if (IS_ERR(cs4265->reset_gpio)) 596 return PTR_ERR(cs4265->reset_gpio); 597 598 if (cs4265->reset_gpio) { 599 mdelay(1); 600 gpiod_set_value_cansleep(cs4265->reset_gpio, 1); 601 } 602 603 i2c_set_clientdata(i2c_client, cs4265); 604 605 ret = regmap_read(cs4265->regmap, CS4265_CHIP_ID, ®); 606 devid = reg & CS4265_CHIP_ID_MASK; 607 if (devid != CS4265_CHIP_ID_VAL) { 608 ret = -ENODEV; 609 dev_err(&i2c_client->dev, 610 "CS4265 Device ID (%X). Expected %X\n", 611 devid, CS4265_CHIP_ID); 612 return ret; 613 } 614 dev_info(&i2c_client->dev, 615 "CS4265 Version %x\n", 616 reg & CS4265_REV_ID_MASK); 617 618 regmap_write(cs4265->regmap, CS4265_PWRCTL, 0x0F); 619 620 ret = devm_snd_soc_register_component(&i2c_client->dev, 621 &soc_component_cs4265, cs4265_dai, 622 ARRAY_SIZE(cs4265_dai)); 623 return ret; 624 } 625 626 static const struct of_device_id cs4265_of_match[] = { 627 { .compatible = "cirrus,cs4265", }, 628 { } 629 }; 630 MODULE_DEVICE_TABLE(of, cs4265_of_match); 631 632 static const struct i2c_device_id cs4265_id[] = { 633 { "cs4265", 0 }, 634 { } 635 }; 636 MODULE_DEVICE_TABLE(i2c, cs4265_id); 637 638 static struct i2c_driver cs4265_i2c_driver = { 639 .driver = { 640 .name = "cs4265", 641 .of_match_table = cs4265_of_match, 642 }, 643 .id_table = cs4265_id, 644 .probe = cs4265_i2c_probe, 645 }; 646 647 module_i2c_driver(cs4265_i2c_driver); 648 649 MODULE_DESCRIPTION("ASoC CS4265 driver"); 650 MODULE_AUTHOR("Paul Handrigan, Cirrus Logic Inc, <paul.handrigan@cirrus.com>"); 651 MODULE_LICENSE("GPL"); 652