1 /* 2 * wm8776.c -- WM8776 ALSA SoC Audio driver 3 * 4 * Copyright 2009 Wolfson Microelectronics plc 5 * 6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.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 * TODO: Input ALC/limiter support 13 */ 14 15 #include <linux/module.h> 16 #include <linux/moduleparam.h> 17 #include <linux/init.h> 18 #include <linux/delay.h> 19 #include <linux/pm.h> 20 #include <linux/i2c.h> 21 #include <linux/platform_device.h> 22 #include <linux/spi/spi.h> 23 #include <sound/core.h> 24 #include <sound/pcm.h> 25 #include <sound/pcm_params.h> 26 #include <sound/soc.h> 27 #include <sound/soc-dapm.h> 28 #include <sound/initval.h> 29 #include <sound/tlv.h> 30 31 #include "wm8776.h" 32 33 static struct snd_soc_codec *wm8776_codec; 34 struct snd_soc_codec_device soc_codec_dev_wm8776; 35 36 /* codec private data */ 37 struct wm8776_priv { 38 struct snd_soc_codec codec; 39 u16 reg_cache[WM8776_CACHEREGNUM]; 40 int sysclk[2]; 41 }; 42 43 #ifdef CONFIG_SPI_MASTER 44 static int wm8776_spi_write(struct spi_device *spi, const char *data, int len); 45 #endif 46 47 static const u16 wm8776_reg[WM8776_CACHEREGNUM] = { 48 0x79, 0x79, 0x79, 0xff, 0xff, /* 4 */ 49 0xff, 0x00, 0x90, 0x00, 0x00, /* 9 */ 50 0x22, 0x22, 0x22, 0x08, 0xcf, /* 14 */ 51 0xcf, 0x7b, 0x00, 0x32, 0x00, /* 19 */ 52 0xa6, 0x01, 0x01 53 }; 54 55 static int wm8776_reset(struct snd_soc_codec *codec) 56 { 57 return snd_soc_write(codec, WM8776_RESET, 0); 58 } 59 60 static const DECLARE_TLV_DB_SCALE(hp_tlv, -12100, 100, 1); 61 static const DECLARE_TLV_DB_SCALE(dac_tlv, -12750, 50, 1); 62 static const DECLARE_TLV_DB_SCALE(adc_tlv, -10350, 50, 1); 63 64 static const struct snd_kcontrol_new wm8776_snd_controls[] = { 65 SOC_DOUBLE_R_TLV("Headphone Playback Volume", WM8776_HPLVOL, WM8776_HPRVOL, 66 0, 127, 0, hp_tlv), 67 SOC_DOUBLE_R_TLV("Digital Playback Volume", WM8776_DACLVOL, WM8776_DACRVOL, 68 0, 255, 0, dac_tlv), 69 SOC_SINGLE("Digital Playback ZC Switch", WM8776_DACCTRL1, 0, 1, 0), 70 71 SOC_SINGLE("Deemphasis Switch", WM8776_DACCTRL2, 0, 1, 0), 72 73 SOC_DOUBLE_R_TLV("Capture Volume", WM8776_ADCLVOL, WM8776_ADCRVOL, 74 0, 255, 0, adc_tlv), 75 SOC_DOUBLE("Capture Switch", WM8776_ADCMUX, 7, 6, 1, 1), 76 SOC_DOUBLE_R("Capture ZC Switch", WM8776_ADCLVOL, WM8776_ADCRVOL, 8, 1, 0), 77 SOC_SINGLE("Capture HPF Switch", WM8776_ADCIFCTRL, 8, 1, 1), 78 }; 79 80 static const struct snd_kcontrol_new inmix_controls[] = { 81 SOC_DAPM_SINGLE("AIN1 Switch", WM8776_ADCMUX, 0, 1, 0), 82 SOC_DAPM_SINGLE("AIN2 Switch", WM8776_ADCMUX, 1, 1, 0), 83 SOC_DAPM_SINGLE("AIN3 Switch", WM8776_ADCMUX, 2, 1, 0), 84 SOC_DAPM_SINGLE("AIN4 Switch", WM8776_ADCMUX, 3, 1, 0), 85 SOC_DAPM_SINGLE("AIN5 Switch", WM8776_ADCMUX, 4, 1, 0), 86 }; 87 88 static const struct snd_kcontrol_new outmix_controls[] = { 89 SOC_DAPM_SINGLE("DAC Switch", WM8776_OUTMUX, 0, 1, 0), 90 SOC_DAPM_SINGLE("AUX Switch", WM8776_OUTMUX, 1, 1, 0), 91 SOC_DAPM_SINGLE("Bypass Switch", WM8776_OUTMUX, 2, 1, 0), 92 }; 93 94 static const struct snd_soc_dapm_widget wm8776_dapm_widgets[] = { 95 SND_SOC_DAPM_INPUT("AUX"), 96 SND_SOC_DAPM_INPUT("AUX"), 97 98 SND_SOC_DAPM_INPUT("AIN1"), 99 SND_SOC_DAPM_INPUT("AIN2"), 100 SND_SOC_DAPM_INPUT("AIN3"), 101 SND_SOC_DAPM_INPUT("AIN4"), 102 SND_SOC_DAPM_INPUT("AIN5"), 103 104 SND_SOC_DAPM_MIXER("Input Mixer", WM8776_PWRDOWN, 6, 1, 105 inmix_controls, ARRAY_SIZE(inmix_controls)), 106 107 SND_SOC_DAPM_ADC("ADC", "Capture", WM8776_PWRDOWN, 1, 1), 108 SND_SOC_DAPM_DAC("DAC", "Playback", WM8776_PWRDOWN, 2, 1), 109 110 SND_SOC_DAPM_MIXER("Output Mixer", SND_SOC_NOPM, 0, 0, 111 outmix_controls, ARRAY_SIZE(outmix_controls)), 112 113 SND_SOC_DAPM_PGA("Headphone PGA", WM8776_PWRDOWN, 3, 1, NULL, 0), 114 115 SND_SOC_DAPM_OUTPUT("VOUT"), 116 117 SND_SOC_DAPM_OUTPUT("HPOUTL"), 118 SND_SOC_DAPM_OUTPUT("HPOUTR"), 119 }; 120 121 static const struct snd_soc_dapm_route routes[] = { 122 { "Input Mixer", "AIN1 Switch", "AIN1" }, 123 { "Input Mixer", "AIN2 Switch", "AIN2" }, 124 { "Input Mixer", "AIN3 Switch", "AIN3" }, 125 { "Input Mixer", "AIN4 Switch", "AIN4" }, 126 { "Input Mixer", "AIN5 Switch", "AIN5" }, 127 128 { "ADC", NULL, "Input Mixer" }, 129 130 { "Output Mixer", "DAC Switch", "DAC" }, 131 { "Output Mixer", "AUX Switch", "AUX" }, 132 { "Output Mixer", "Bypass Switch", "Input Mixer" }, 133 134 { "VOUT", NULL, "Output Mixer" }, 135 136 { "Headphone PGA", NULL, "Output Mixer" }, 137 138 { "HPOUTL", NULL, "Headphone PGA" }, 139 { "HPOUTR", NULL, "Headphone PGA" }, 140 }; 141 142 static int wm8776_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) 143 { 144 struct snd_soc_codec *codec = dai->codec; 145 int reg, iface, master; 146 147 switch (dai->id) { 148 case WM8776_DAI_DAC: 149 reg = WM8776_DACIFCTRL; 150 master = 0x80; 151 break; 152 case WM8776_DAI_ADC: 153 reg = WM8776_ADCIFCTRL; 154 master = 0x100; 155 break; 156 default: 157 return -EINVAL; 158 } 159 160 iface = 0; 161 162 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { 163 case SND_SOC_DAIFMT_CBM_CFM: 164 break; 165 case SND_SOC_DAIFMT_CBS_CFS: 166 master = 0; 167 break; 168 default: 169 return -EINVAL; 170 } 171 172 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { 173 case SND_SOC_DAIFMT_I2S: 174 iface |= 0x0002; 175 break; 176 case SND_SOC_DAIFMT_RIGHT_J: 177 break; 178 case SND_SOC_DAIFMT_LEFT_J: 179 iface |= 0x0001; 180 break; 181 /* FIXME: CHECK A/B */ 182 case SND_SOC_DAIFMT_DSP_A: 183 iface |= 0x0003; 184 break; 185 case SND_SOC_DAIFMT_DSP_B: 186 iface |= 0x0007; 187 break; 188 default: 189 return -EINVAL; 190 } 191 192 switch (fmt & SND_SOC_DAIFMT_INV_MASK) { 193 case SND_SOC_DAIFMT_NB_NF: 194 break; 195 case SND_SOC_DAIFMT_IB_IF: 196 iface |= 0x00c; 197 break; 198 case SND_SOC_DAIFMT_IB_NF: 199 iface |= 0x008; 200 break; 201 case SND_SOC_DAIFMT_NB_IF: 202 iface |= 0x004; 203 break; 204 default: 205 return -EINVAL; 206 } 207 208 /* Finally, write out the values */ 209 snd_soc_update_bits(codec, reg, 0xf, iface); 210 snd_soc_update_bits(codec, WM8776_MSTRCTRL, 0x180, master); 211 212 return 0; 213 } 214 215 static int mclk_ratios[] = { 216 128, 217 192, 218 256, 219 384, 220 512, 221 768, 222 }; 223 224 static int wm8776_hw_params(struct snd_pcm_substream *substream, 225 struct snd_pcm_hw_params *params, 226 struct snd_soc_dai *dai) 227 { 228 struct snd_soc_codec *codec = dai->codec; 229 struct wm8776_priv *wm8776 = codec->private_data; 230 int iface_reg, iface; 231 int ratio_shift, master; 232 int i; 233 234 iface = 0; 235 236 switch (dai->id) { 237 case WM8776_DAI_DAC: 238 iface_reg = WM8776_DACIFCTRL; 239 master = 0x80; 240 ratio_shift = 4; 241 break; 242 case WM8776_DAI_ADC: 243 iface_reg = WM8776_ADCIFCTRL; 244 master = 0x100; 245 ratio_shift = 0; 246 break; 247 default: 248 return -EINVAL; 249 } 250 251 252 /* Set word length */ 253 switch (params_format(params)) { 254 case SNDRV_PCM_FORMAT_S16_LE: 255 break; 256 case SNDRV_PCM_FORMAT_S20_3LE: 257 iface |= 0x10; 258 break; 259 case SNDRV_PCM_FORMAT_S24_LE: 260 iface |= 0x20; 261 break; 262 case SNDRV_PCM_FORMAT_S32_LE: 263 iface |= 0x30; 264 break; 265 } 266 267 /* Only need to set MCLK/LRCLK ratio if we're master */ 268 if (snd_soc_read(codec, WM8776_MSTRCTRL) & master) { 269 for (i = 0; i < ARRAY_SIZE(mclk_ratios); i++) { 270 if (wm8776->sysclk[dai->id] / params_rate(params) 271 == mclk_ratios[i]) 272 break; 273 } 274 275 if (i == ARRAY_SIZE(mclk_ratios)) { 276 dev_err(codec->dev, 277 "Unable to configure MCLK ratio %d/%d\n", 278 wm8776->sysclk[dai->id], params_rate(params)); 279 return -EINVAL; 280 } 281 282 dev_dbg(codec->dev, "MCLK is %dfs\n", mclk_ratios[i]); 283 284 snd_soc_update_bits(codec, WM8776_MSTRCTRL, 285 0x7 << ratio_shift, i << ratio_shift); 286 } else { 287 dev_dbg(codec->dev, "DAI in slave mode\n"); 288 } 289 290 snd_soc_update_bits(codec, iface_reg, 0x30, iface); 291 292 return 0; 293 } 294 295 static int wm8776_mute(struct snd_soc_dai *dai, int mute) 296 { 297 struct snd_soc_codec *codec = dai->codec; 298 299 return snd_soc_write(codec, WM8776_DACMUTE, !!mute); 300 } 301 302 static int wm8776_set_sysclk(struct snd_soc_dai *dai, 303 int clk_id, unsigned int freq, int dir) 304 { 305 struct snd_soc_codec *codec = dai->codec; 306 struct wm8776_priv *wm8776 = codec->private_data; 307 308 BUG_ON(dai->id >= ARRAY_SIZE(wm8776->sysclk)); 309 310 wm8776->sysclk[dai->id] = freq; 311 312 return 0; 313 } 314 315 static int wm8776_set_bias_level(struct snd_soc_codec *codec, 316 enum snd_soc_bias_level level) 317 { 318 switch (level) { 319 case SND_SOC_BIAS_ON: 320 break; 321 case SND_SOC_BIAS_PREPARE: 322 break; 323 case SND_SOC_BIAS_STANDBY: 324 if (codec->bias_level == SND_SOC_BIAS_OFF) { 325 /* Disable the global powerdown; DAPM does the rest */ 326 snd_soc_update_bits(codec, WM8776_PWRDOWN, 1, 0); 327 } 328 329 break; 330 case SND_SOC_BIAS_OFF: 331 snd_soc_update_bits(codec, WM8776_PWRDOWN, 1, 1); 332 break; 333 } 334 335 codec->bias_level = level; 336 return 0; 337 } 338 339 #define WM8776_RATES (SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |\ 340 SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |\ 341 SNDRV_PCM_RATE_96000) 342 343 344 #define WM8776_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\ 345 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE) 346 347 static struct snd_soc_dai_ops wm8776_dac_ops = { 348 .digital_mute = wm8776_mute, 349 .hw_params = wm8776_hw_params, 350 .set_fmt = wm8776_set_fmt, 351 .set_sysclk = wm8776_set_sysclk, 352 }; 353 354 static struct snd_soc_dai_ops wm8776_adc_ops = { 355 .hw_params = wm8776_hw_params, 356 .set_fmt = wm8776_set_fmt, 357 .set_sysclk = wm8776_set_sysclk, 358 }; 359 360 struct snd_soc_dai wm8776_dai[] = { 361 { 362 .name = "WM8776 Playback", 363 .id = WM8776_DAI_DAC, 364 .playback = { 365 .stream_name = "Playback", 366 .channels_min = 2, 367 .channels_max = 2, 368 .rates = WM8776_RATES, 369 .formats = WM8776_FORMATS, 370 }, 371 .ops = &wm8776_dac_ops, 372 }, 373 { 374 .name = "WM8776 Capture", 375 .id = WM8776_DAI_ADC, 376 .capture = { 377 .stream_name = "Capture", 378 .channels_min = 2, 379 .channels_max = 2, 380 .rates = WM8776_RATES, 381 .formats = WM8776_FORMATS, 382 }, 383 .ops = &wm8776_adc_ops, 384 }, 385 }; 386 EXPORT_SYMBOL_GPL(wm8776_dai); 387 388 #ifdef CONFIG_PM 389 static int wm8776_suspend(struct platform_device *pdev, pm_message_t state) 390 { 391 struct snd_soc_device *socdev = platform_get_drvdata(pdev); 392 struct snd_soc_codec *codec = socdev->card->codec; 393 394 wm8776_set_bias_level(codec, SND_SOC_BIAS_OFF); 395 396 return 0; 397 } 398 399 static int wm8776_resume(struct platform_device *pdev) 400 { 401 struct snd_soc_device *socdev = platform_get_drvdata(pdev); 402 struct snd_soc_codec *codec = socdev->card->codec; 403 int i; 404 u8 data[2]; 405 u16 *cache = codec->reg_cache; 406 407 /* Sync reg_cache with the hardware */ 408 for (i = 0; i < ARRAY_SIZE(wm8776_reg); i++) { 409 data[0] = (i << 1) | ((cache[i] >> 8) & 0x0001); 410 data[1] = cache[i] & 0x00ff; 411 codec->hw_write(codec->control_data, data, 2); 412 } 413 414 wm8776_set_bias_level(codec, SND_SOC_BIAS_STANDBY); 415 416 return 0; 417 } 418 #else 419 #define wm8776_suspend NULL 420 #define wm8776_resume NULL 421 #endif 422 423 static int wm8776_probe(struct platform_device *pdev) 424 { 425 struct snd_soc_device *socdev = platform_get_drvdata(pdev); 426 struct snd_soc_codec *codec; 427 int ret = 0; 428 429 if (wm8776_codec == NULL) { 430 dev_err(&pdev->dev, "Codec device not registered\n"); 431 return -ENODEV; 432 } 433 434 socdev->card->codec = wm8776_codec; 435 codec = wm8776_codec; 436 437 /* register pcms */ 438 ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1); 439 if (ret < 0) { 440 dev_err(codec->dev, "failed to create pcms: %d\n", ret); 441 goto pcm_err; 442 } 443 444 snd_soc_add_controls(codec, wm8776_snd_controls, 445 ARRAY_SIZE(wm8776_snd_controls)); 446 snd_soc_dapm_new_controls(codec, wm8776_dapm_widgets, 447 ARRAY_SIZE(wm8776_dapm_widgets)); 448 snd_soc_dapm_add_routes(codec, routes, ARRAY_SIZE(routes)); 449 450 ret = snd_soc_init_card(socdev); 451 if (ret < 0) { 452 dev_err(codec->dev, "failed to register card: %d\n", ret); 453 goto card_err; 454 } 455 456 return ret; 457 458 card_err: 459 snd_soc_free_pcms(socdev); 460 snd_soc_dapm_free(socdev); 461 pcm_err: 462 return ret; 463 } 464 465 /* power down chip */ 466 static int wm8776_remove(struct platform_device *pdev) 467 { 468 struct snd_soc_device *socdev = platform_get_drvdata(pdev); 469 470 snd_soc_free_pcms(socdev); 471 snd_soc_dapm_free(socdev); 472 473 return 0; 474 } 475 476 struct snd_soc_codec_device soc_codec_dev_wm8776 = { 477 .probe = wm8776_probe, 478 .remove = wm8776_remove, 479 .suspend = wm8776_suspend, 480 .resume = wm8776_resume, 481 }; 482 EXPORT_SYMBOL_GPL(soc_codec_dev_wm8776); 483 484 static int wm8776_register(struct wm8776_priv *wm8776, 485 enum snd_soc_control_type control) 486 { 487 int ret, i; 488 struct snd_soc_codec *codec = &wm8776->codec; 489 490 if (wm8776_codec) { 491 dev_err(codec->dev, "Another WM8776 is registered\n"); 492 ret = -EINVAL; 493 goto err; 494 } 495 496 mutex_init(&codec->mutex); 497 INIT_LIST_HEAD(&codec->dapm_widgets); 498 INIT_LIST_HEAD(&codec->dapm_paths); 499 500 codec->private_data = wm8776; 501 codec->name = "WM8776"; 502 codec->owner = THIS_MODULE; 503 codec->bias_level = SND_SOC_BIAS_OFF; 504 codec->set_bias_level = wm8776_set_bias_level; 505 codec->dai = wm8776_dai; 506 codec->num_dai = ARRAY_SIZE(wm8776_dai); 507 codec->reg_cache_size = WM8776_CACHEREGNUM; 508 codec->reg_cache = &wm8776->reg_cache; 509 510 memcpy(codec->reg_cache, wm8776_reg, sizeof(wm8776_reg)); 511 512 ret = snd_soc_codec_set_cache_io(codec, 7, 9, control); 513 if (ret < 0) { 514 dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret); 515 goto err; 516 } 517 518 for (i = 0; i < ARRAY_SIZE(wm8776_dai); i++) 519 wm8776_dai[i].dev = codec->dev; 520 521 ret = wm8776_reset(codec); 522 if (ret < 0) { 523 dev_err(codec->dev, "Failed to issue reset: %d\n", ret); 524 goto err; 525 } 526 527 wm8776_set_bias_level(codec, SND_SOC_BIAS_STANDBY); 528 529 /* Latch the update bits; right channel only since we always 530 * update both. */ 531 snd_soc_update_bits(codec, WM8776_HPRVOL, 0x100, 0x100); 532 snd_soc_update_bits(codec, WM8776_DACRVOL, 0x100, 0x100); 533 534 wm8776_codec = codec; 535 536 ret = snd_soc_register_codec(codec); 537 if (ret != 0) { 538 dev_err(codec->dev, "Failed to register codec: %d\n", ret); 539 goto err; 540 } 541 542 ret = snd_soc_register_dais(wm8776_dai, ARRAY_SIZE(wm8776_dai)); 543 if (ret != 0) { 544 dev_err(codec->dev, "Failed to register DAIs: %d\n", ret); 545 goto err_codec; 546 } 547 548 return 0; 549 550 err_codec: 551 snd_soc_unregister_codec(codec); 552 err: 553 kfree(wm8776); 554 return ret; 555 } 556 557 static void wm8776_unregister(struct wm8776_priv *wm8776) 558 { 559 wm8776_set_bias_level(&wm8776->codec, SND_SOC_BIAS_OFF); 560 snd_soc_unregister_dais(wm8776_dai, ARRAY_SIZE(wm8776_dai)); 561 snd_soc_unregister_codec(&wm8776->codec); 562 kfree(wm8776); 563 wm8776_codec = NULL; 564 } 565 566 #if defined(CONFIG_SPI_MASTER) 567 static int wm8776_spi_write(struct spi_device *spi, const char *data, int len) 568 { 569 struct spi_transfer t; 570 struct spi_message m; 571 u8 msg[2]; 572 573 if (len <= 0) 574 return 0; 575 576 msg[0] = data[0]; 577 msg[1] = data[1]; 578 579 spi_message_init(&m); 580 memset(&t, 0, (sizeof t)); 581 582 t.tx_buf = &msg[0]; 583 t.len = len; 584 585 spi_message_add_tail(&t, &m); 586 spi_sync(spi, &m); 587 588 return len; 589 } 590 591 static int __devinit wm8776_spi_probe(struct spi_device *spi) 592 { 593 struct snd_soc_codec *codec; 594 struct wm8776_priv *wm8776; 595 596 wm8776 = kzalloc(sizeof(struct wm8776_priv), GFP_KERNEL); 597 if (wm8776 == NULL) 598 return -ENOMEM; 599 600 codec = &wm8776->codec; 601 codec->control_data = spi; 602 codec->hw_write = (hw_write_t)wm8776_spi_write; 603 codec->dev = &spi->dev; 604 605 dev_set_drvdata(&spi->dev, wm8776); 606 607 return wm8776_register(wm8776, SND_SOC_SPI); 608 } 609 610 static int __devexit wm8776_spi_remove(struct spi_device *spi) 611 { 612 struct wm8776_priv *wm8776 = dev_get_drvdata(&spi->dev); 613 614 wm8776_unregister(wm8776); 615 616 return 0; 617 } 618 619 #ifdef CONFIG_PM 620 static int wm8776_spi_suspend(struct spi_device *spi, pm_message_t msg) 621 { 622 return snd_soc_suspend_device(&spi->dev); 623 } 624 625 static int wm8776_spi_resume(struct spi_device *spi) 626 { 627 return snd_soc_resume_device(&spi->dev); 628 } 629 #else 630 #define wm8776_spi_suspend NULL 631 #define wm8776_spi_resume NULL 632 #endif 633 634 static struct spi_driver wm8776_spi_driver = { 635 .driver = { 636 .name = "wm8776", 637 .bus = &spi_bus_type, 638 .owner = THIS_MODULE, 639 }, 640 .probe = wm8776_spi_probe, 641 .suspend = wm8776_spi_suspend, 642 .resume = wm8776_spi_resume, 643 .remove = __devexit_p(wm8776_spi_remove), 644 }; 645 #endif /* CONFIG_SPI_MASTER */ 646 647 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) 648 static __devinit int wm8776_i2c_probe(struct i2c_client *i2c, 649 const struct i2c_device_id *id) 650 { 651 struct wm8776_priv *wm8776; 652 struct snd_soc_codec *codec; 653 654 wm8776 = kzalloc(sizeof(struct wm8776_priv), GFP_KERNEL); 655 if (wm8776 == NULL) 656 return -ENOMEM; 657 658 codec = &wm8776->codec; 659 codec->hw_write = (hw_write_t)i2c_master_send; 660 661 i2c_set_clientdata(i2c, wm8776); 662 codec->control_data = i2c; 663 664 codec->dev = &i2c->dev; 665 666 return wm8776_register(wm8776, SND_SOC_I2C); 667 } 668 669 static __devexit int wm8776_i2c_remove(struct i2c_client *client) 670 { 671 struct wm8776_priv *wm8776 = i2c_get_clientdata(client); 672 wm8776_unregister(wm8776); 673 return 0; 674 } 675 676 #ifdef CONFIG_PM 677 static int wm8776_i2c_suspend(struct i2c_client *i2c, pm_message_t msg) 678 { 679 return snd_soc_suspend_device(&i2c->dev); 680 } 681 682 static int wm8776_i2c_resume(struct i2c_client *i2c) 683 { 684 return snd_soc_resume_device(&i2c->dev); 685 } 686 #else 687 #define wm8776_i2c_suspend NULL 688 #define wm8776_i2c_resume NULL 689 #endif 690 691 static const struct i2c_device_id wm8776_i2c_id[] = { 692 { "wm8776", 0 }, 693 { } 694 }; 695 MODULE_DEVICE_TABLE(i2c, wm8776_i2c_id); 696 697 static struct i2c_driver wm8776_i2c_driver = { 698 .driver = { 699 .name = "wm8776", 700 .owner = THIS_MODULE, 701 }, 702 .probe = wm8776_i2c_probe, 703 .remove = __devexit_p(wm8776_i2c_remove), 704 .suspend = wm8776_i2c_suspend, 705 .resume = wm8776_i2c_resume, 706 .id_table = wm8776_i2c_id, 707 }; 708 #endif 709 710 static int __init wm8776_modinit(void) 711 { 712 int ret; 713 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) 714 ret = i2c_add_driver(&wm8776_i2c_driver); 715 if (ret != 0) { 716 printk(KERN_ERR "Failed to register WM8776 I2C driver: %d\n", 717 ret); 718 } 719 #endif 720 #if defined(CONFIG_SPI_MASTER) 721 ret = spi_register_driver(&wm8776_spi_driver); 722 if (ret != 0) { 723 printk(KERN_ERR "Failed to register WM8776 SPI driver: %d\n", 724 ret); 725 } 726 #endif 727 return 0; 728 } 729 module_init(wm8776_modinit); 730 731 static void __exit wm8776_exit(void) 732 { 733 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) 734 i2c_del_driver(&wm8776_i2c_driver); 735 #endif 736 #if defined(CONFIG_SPI_MASTER) 737 spi_unregister_driver(&wm8776_spi_driver); 738 #endif 739 } 740 module_exit(wm8776_exit); 741 742 MODULE_DESCRIPTION("ASoC WM8776 driver"); 743 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>"); 744 MODULE_LICENSE("GPL"); 745