1/* 2 * wm8711.c -- WM8711 ALSA SoC Audio driver 3 * 4 * Copyright 2006 Wolfson Microelectronics 5 * 6 * Author: Mike Arthur <linux@wolfsonmicro.com> 7 * 8 * Based on wm8731.c by Richard Purdie 9 * 10 * This program is free software; you can redistribute it and/or modify 11 * it under the terms of the GNU General Public License version 2 as 12 * published by the Free Software Foundation. 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 <linux/slab.h> 24#include <sound/core.h> 25#include <sound/pcm.h> 26#include <sound/pcm_params.h> 27#include <sound/soc.h> 28#include <sound/soc-dapm.h> 29#include <sound/tlv.h> 30#include <sound/initval.h> 31 32#include "wm8711.h" 33 34static struct snd_soc_codec *wm8711_codec; 35 36/* codec private data */ 37struct wm8711_priv { 38 struct snd_soc_codec codec; 39 u16 reg_cache[WM8711_CACHEREGNUM]; 40 unsigned int sysclk; 41}; 42 43/* 44 * wm8711 register cache 45 * We can't read the WM8711 register space when we are 46 * using 2 wire for device control, so we cache them instead. 47 * There is no point in caching the reset register 48 */ 49static const u16 wm8711_reg[WM8711_CACHEREGNUM] = { 50 0x0079, 0x0079, 0x000a, 0x0008, 51 0x009f, 0x000a, 0x0000, 0x0000 52}; 53 54#define wm8711_reset(c) snd_soc_write(c, WM8711_RESET, 0) 55 56static const DECLARE_TLV_DB_SCALE(out_tlv, -12100, 100, 1); 57 58static const struct snd_kcontrol_new wm8711_snd_controls[] = { 59 60SOC_DOUBLE_R_TLV("Master Playback Volume", WM8711_LOUT1V, WM8711_ROUT1V, 61 0, 127, 0, out_tlv), 62SOC_DOUBLE_R("Master Playback ZC Switch", WM8711_LOUT1V, WM8711_ROUT1V, 63 7, 1, 0), 64 65}; 66 67/* Output Mixer */ 68static const struct snd_kcontrol_new wm8711_output_mixer_controls[] = { 69SOC_DAPM_SINGLE("Line Bypass Switch", WM8711_APANA, 3, 1, 0), 70SOC_DAPM_SINGLE("HiFi Playback Switch", WM8711_APANA, 4, 1, 0), 71}; 72 73static const struct snd_soc_dapm_widget wm8711_dapm_widgets[] = { 74SND_SOC_DAPM_MIXER("Output Mixer", WM8711_PWR, 4, 1, 75 &wm8711_output_mixer_controls[0], 76 ARRAY_SIZE(wm8711_output_mixer_controls)), 77SND_SOC_DAPM_DAC("DAC", "HiFi Playback", WM8711_PWR, 3, 1), 78SND_SOC_DAPM_OUTPUT("LOUT"), 79SND_SOC_DAPM_OUTPUT("LHPOUT"), 80SND_SOC_DAPM_OUTPUT("ROUT"), 81SND_SOC_DAPM_OUTPUT("RHPOUT"), 82}; 83 84static const struct snd_soc_dapm_route intercon[] = { 85 /* output mixer */ 86 {"Output Mixer", "Line Bypass Switch", "Line Input"}, 87 {"Output Mixer", "HiFi Playback Switch", "DAC"}, 88 89 /* outputs */ 90 {"RHPOUT", NULL, "Output Mixer"}, 91 {"ROUT", NULL, "Output Mixer"}, 92 {"LHPOUT", NULL, "Output Mixer"}, 93 {"LOUT", NULL, "Output Mixer"}, 94}; 95 96static int wm8711_add_widgets(struct snd_soc_codec *codec) 97{ 98 snd_soc_dapm_new_controls(codec, wm8711_dapm_widgets, 99 ARRAY_SIZE(wm8711_dapm_widgets)); 100 101 snd_soc_dapm_add_routes(codec, intercon, ARRAY_SIZE(intercon)); 102 103 return 0; 104} 105 106struct _coeff_div { 107 u32 mclk; 108 u32 rate; 109 u16 fs; 110 u8 sr:4; 111 u8 bosr:1; 112 u8 usb:1; 113}; 114 115/* codec mclk clock divider coefficients */ 116static const struct _coeff_div coeff_div[] = { 117 /* 48k */ 118 {12288000, 48000, 256, 0x0, 0x0, 0x0}, 119 {18432000, 48000, 384, 0x0, 0x1, 0x0}, 120 {12000000, 48000, 250, 0x0, 0x0, 0x1}, 121 122 /* 32k */ 123 {12288000, 32000, 384, 0x6, 0x0, 0x0}, 124 {18432000, 32000, 576, 0x6, 0x1, 0x0}, 125 {12000000, 32000, 375, 0x6, 0x0, 0x1}, 126 127 /* 8k */ 128 {12288000, 8000, 1536, 0x3, 0x0, 0x0}, 129 {18432000, 8000, 2304, 0x3, 0x1, 0x0}, 130 {11289600, 8000, 1408, 0xb, 0x0, 0x0}, 131 {16934400, 8000, 2112, 0xb, 0x1, 0x0}, 132 {12000000, 8000, 1500, 0x3, 0x0, 0x1}, 133 134 /* 96k */ 135 {12288000, 96000, 128, 0x7, 0x0, 0x0}, 136 {18432000, 96000, 192, 0x7, 0x1, 0x0}, 137 {12000000, 96000, 125, 0x7, 0x0, 0x1}, 138 139 /* 44.1k */ 140 {11289600, 44100, 256, 0x8, 0x0, 0x0}, 141 {16934400, 44100, 384, 0x8, 0x1, 0x0}, 142 {12000000, 44100, 272, 0x8, 0x1, 0x1}, 143 144 /* 88.2k */ 145 {11289600, 88200, 128, 0xf, 0x0, 0x0}, 146 {16934400, 88200, 192, 0xf, 0x1, 0x0}, 147 {12000000, 88200, 136, 0xf, 0x1, 0x1}, 148}; 149 150static inline int get_coeff(int mclk, int rate) 151{ 152 int i; 153 154 for (i = 0; i < ARRAY_SIZE(coeff_div); i++) { 155 if (coeff_div[i].rate == rate && coeff_div[i].mclk == mclk) 156 return i; 157 } 158 return 0; 159} 160 161static int wm8711_hw_params(struct snd_pcm_substream *substream, 162 struct snd_pcm_hw_params *params, 163 struct snd_soc_dai *dai) 164{ 165 struct snd_soc_codec *codec = dai->codec; 166 struct wm8711_priv *wm8711 = snd_soc_codec_get_drvdata(codec); 167 u16 iface = snd_soc_read(codec, WM8711_IFACE) & 0xfffc; 168 int i = get_coeff(wm8711->sysclk, params_rate(params)); 169 u16 srate = (coeff_div[i].sr << 2) | 170 (coeff_div[i].bosr << 1) | coeff_div[i].usb; 171 172 snd_soc_write(codec, WM8711_SRATE, srate); 173 174 /* bit size */ 175 switch (params_format(params)) { 176 case SNDRV_PCM_FORMAT_S16_LE: 177 break; 178 case SNDRV_PCM_FORMAT_S20_3LE: 179 iface |= 0x0004; 180 break; 181 case SNDRV_PCM_FORMAT_S24_LE: 182 iface |= 0x0008; 183 break; 184 } 185 186 snd_soc_write(codec, WM8711_IFACE, iface); 187 return 0; 188} 189 190static int wm8711_pcm_prepare(struct snd_pcm_substream *substream, 191 struct snd_soc_dai *dai) 192{ 193 struct snd_soc_codec *codec = dai->codec; 194 195 /* set active */ 196 snd_soc_write(codec, WM8711_ACTIVE, 0x0001); 197 198 return 0; 199} 200 201static void wm8711_shutdown(struct snd_pcm_substream *substream, 202 struct snd_soc_dai *dai) 203{ 204 struct snd_soc_codec *codec = dai->codec; 205 206 /* deactivate */ 207 if (!codec->active) { 208 udelay(50); 209 snd_soc_write(codec, WM8711_ACTIVE, 0x0); 210 } 211} 212 213static int wm8711_mute(struct snd_soc_dai *dai, int mute) 214{ 215 struct snd_soc_codec *codec = dai->codec; 216 u16 mute_reg = snd_soc_read(codec, WM8711_APDIGI) & 0xfff7; 217 218 if (mute) 219 snd_soc_write(codec, WM8711_APDIGI, mute_reg | 0x8); 220 else 221 snd_soc_write(codec, WM8711_APDIGI, mute_reg); 222 223 return 0; 224} 225 226static int wm8711_set_dai_sysclk(struct snd_soc_dai *codec_dai, 227 int clk_id, unsigned int freq, int dir) 228{ 229 struct snd_soc_codec *codec = codec_dai->codec; 230 struct wm8711_priv *wm8711 = snd_soc_codec_get_drvdata(codec); 231 232 switch (freq) { 233 case 11289600: 234 case 12000000: 235 case 12288000: 236 case 16934400: 237 case 18432000: 238 wm8711->sysclk = freq; 239 return 0; 240 } 241 return -EINVAL; 242} 243 244static int wm8711_set_dai_fmt(struct snd_soc_dai *codec_dai, 245 unsigned int fmt) 246{ 247 struct snd_soc_codec *codec = codec_dai->codec; 248 u16 iface = 0; 249 250 /* set master/slave audio interface */ 251 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { 252 case SND_SOC_DAIFMT_CBM_CFM: 253 iface |= 0x0040; 254 break; 255 case SND_SOC_DAIFMT_CBS_CFS: 256 break; 257 default: 258 return -EINVAL; 259 } 260 261 /* interface format */ 262 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { 263 case SND_SOC_DAIFMT_I2S: 264 iface |= 0x0002; 265 break; 266 case SND_SOC_DAIFMT_RIGHT_J: 267 break; 268 case SND_SOC_DAIFMT_LEFT_J: 269 iface |= 0x0001; 270 break; 271 case SND_SOC_DAIFMT_DSP_A: 272 iface |= 0x0003; 273 break; 274 case SND_SOC_DAIFMT_DSP_B: 275 iface |= 0x0013; 276 break; 277 default: 278 return -EINVAL; 279 } 280 281 /* clock inversion */ 282 switch (fmt & SND_SOC_DAIFMT_INV_MASK) { 283 case SND_SOC_DAIFMT_NB_NF: 284 break; 285 case SND_SOC_DAIFMT_IB_IF: 286 iface |= 0x0090; 287 break; 288 case SND_SOC_DAIFMT_IB_NF: 289 iface |= 0x0080; 290 break; 291 case SND_SOC_DAIFMT_NB_IF: 292 iface |= 0x0010; 293 break; 294 default: 295 return -EINVAL; 296 } 297 298 /* set iface */ 299 snd_soc_write(codec, WM8711_IFACE, iface); 300 return 0; 301} 302 303 304static int wm8711_set_bias_level(struct snd_soc_codec *codec, 305 enum snd_soc_bias_level level) 306{ 307 u16 reg = snd_soc_read(codec, WM8711_PWR) & 0xff7f; 308 309 switch (level) { 310 case SND_SOC_BIAS_ON: 311 snd_soc_write(codec, WM8711_PWR, reg); 312 break; 313 case SND_SOC_BIAS_PREPARE: 314 break; 315 case SND_SOC_BIAS_STANDBY: 316 snd_soc_write(codec, WM8711_PWR, reg | 0x0040); 317 break; 318 case SND_SOC_BIAS_OFF: 319 snd_soc_write(codec, WM8711_ACTIVE, 0x0); 320 snd_soc_write(codec, WM8711_PWR, 0xffff); 321 break; 322 } 323 codec->bias_level = level; 324 return 0; 325} 326 327#define WM8711_RATES SNDRV_PCM_RATE_8000_96000 328 329#define WM8711_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\ 330 SNDRV_PCM_FMTBIT_S24_LE) 331 332static struct snd_soc_dai_ops wm8711_ops = { 333 .prepare = wm8711_pcm_prepare, 334 .hw_params = wm8711_hw_params, 335 .shutdown = wm8711_shutdown, 336 .digital_mute = wm8711_mute, 337 .set_sysclk = wm8711_set_dai_sysclk, 338 .set_fmt = wm8711_set_dai_fmt, 339}; 340 341struct snd_soc_dai wm8711_dai = { 342 .name = "WM8711", 343 .playback = { 344 .stream_name = "Playback", 345 .channels_min = 1, 346 .channels_max = 2, 347 .rates = WM8711_RATES, 348 .formats = WM8711_FORMATS, 349 }, 350 .ops = &wm8711_ops, 351}; 352EXPORT_SYMBOL_GPL(wm8711_dai); 353 354static int wm8711_suspend(struct platform_device *pdev, pm_message_t state) 355{ 356 struct snd_soc_device *socdev = platform_get_drvdata(pdev); 357 struct snd_soc_codec *codec = socdev->card->codec; 358 359 snd_soc_write(codec, WM8711_ACTIVE, 0x0); 360 wm8711_set_bias_level(codec, SND_SOC_BIAS_OFF); 361 return 0; 362} 363 364static int wm8711_resume(struct platform_device *pdev) 365{ 366 struct snd_soc_device *socdev = platform_get_drvdata(pdev); 367 struct snd_soc_codec *codec = socdev->card->codec; 368 int i; 369 u8 data[2]; 370 u16 *cache = codec->reg_cache; 371 372 /* Sync reg_cache with the hardware */ 373 for (i = 0; i < ARRAY_SIZE(wm8711_reg); i++) { 374 data[0] = (i << 1) | ((cache[i] >> 8) & 0x0001); 375 data[1] = cache[i] & 0x00ff; 376 codec->hw_write(codec->control_data, data, 2); 377 } 378 wm8711_set_bias_level(codec, SND_SOC_BIAS_STANDBY); 379 380 return 0; 381} 382 383static int wm8711_probe(struct platform_device *pdev) 384{ 385 struct snd_soc_device *socdev = platform_get_drvdata(pdev); 386 struct snd_soc_codec *codec; 387 int ret = 0; 388 389 if (wm8711_codec == NULL) { 390 dev_err(&pdev->dev, "Codec device not registered\n"); 391 return -ENODEV; 392 } 393 394 socdev->card->codec = wm8711_codec; 395 codec = wm8711_codec; 396 397 /* register pcms */ 398 ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1); 399 if (ret < 0) { 400 dev_err(codec->dev, "failed to create pcms: %d\n", ret); 401 goto pcm_err; 402 } 403 404 snd_soc_add_controls(codec, wm8711_snd_controls, 405 ARRAY_SIZE(wm8711_snd_controls)); 406 wm8711_add_widgets(codec); 407 408 return ret; 409 410pcm_err: 411 return ret; 412} 413 414/* power down chip */ 415static int wm8711_remove(struct platform_device *pdev) 416{ 417 struct snd_soc_device *socdev = platform_get_drvdata(pdev); 418 419 snd_soc_free_pcms(socdev); 420 snd_soc_dapm_free(socdev); 421 422 return 0; 423} 424 425struct snd_soc_codec_device soc_codec_dev_wm8711 = { 426 .probe = wm8711_probe, 427 .remove = wm8711_remove, 428 .suspend = wm8711_suspend, 429 .resume = wm8711_resume, 430}; 431EXPORT_SYMBOL_GPL(soc_codec_dev_wm8711); 432 433static int wm8711_register(struct wm8711_priv *wm8711, 434 enum snd_soc_control_type control) 435{ 436 int ret; 437 struct snd_soc_codec *codec = &wm8711->codec; 438 u16 reg; 439 440 if (wm8711_codec) { 441 dev_err(codec->dev, "Another WM8711 is registered\n"); 442 ret = -EINVAL; 443 goto err; 444 } 445 446 mutex_init(&codec->mutex); 447 INIT_LIST_HEAD(&codec->dapm_widgets); 448 INIT_LIST_HEAD(&codec->dapm_paths); 449 450 snd_soc_codec_set_drvdata(codec, wm8711); 451 codec->name = "WM8711"; 452 codec->owner = THIS_MODULE; 453 codec->bias_level = SND_SOC_BIAS_OFF; 454 codec->set_bias_level = wm8711_set_bias_level; 455 codec->dai = &wm8711_dai; 456 codec->num_dai = 1; 457 codec->reg_cache_size = WM8711_CACHEREGNUM; 458 codec->reg_cache = &wm8711->reg_cache; 459 460 memcpy(codec->reg_cache, wm8711_reg, sizeof(wm8711_reg)); 461 462 ret = snd_soc_codec_set_cache_io(codec, 7, 9, control); 463 if (ret < 0) { 464 dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret); 465 goto err; 466 } 467 468 ret = wm8711_reset(codec); 469 if (ret < 0) { 470 dev_err(codec->dev, "Failed to issue reset\n"); 471 goto err; 472 } 473 474 wm8711_dai.dev = codec->dev; 475 476 wm8711_set_bias_level(codec, SND_SOC_BIAS_STANDBY); 477 478 /* Latch the update bits */ 479 reg = snd_soc_read(codec, WM8711_LOUT1V); 480 snd_soc_write(codec, WM8711_LOUT1V, reg | 0x0100); 481 reg = snd_soc_read(codec, WM8711_ROUT1V); 482 snd_soc_write(codec, WM8711_ROUT1V, reg | 0x0100); 483 484 wm8711_codec = codec; 485 486 ret = snd_soc_register_codec(codec); 487 if (ret != 0) { 488 dev_err(codec->dev, "Failed to register codec: %d\n", ret); 489 goto err; 490 } 491 492 ret = snd_soc_register_dai(&wm8711_dai); 493 if (ret != 0) { 494 dev_err(codec->dev, "Failed to register DAI: %d\n", ret); 495 goto err_codec; 496 } 497 498 return 0; 499 500err_codec: 501 snd_soc_unregister_codec(codec); 502err: 503 kfree(wm8711); 504 return ret; 505} 506 507static void wm8711_unregister(struct wm8711_priv *wm8711) 508{ 509 wm8711_set_bias_level(&wm8711->codec, SND_SOC_BIAS_OFF); 510 snd_soc_unregister_dai(&wm8711_dai); 511 snd_soc_unregister_codec(&wm8711->codec); 512 kfree(wm8711); 513 wm8711_codec = NULL; 514} 515 516#if defined(CONFIG_SPI_MASTER) 517static int __devinit wm8711_spi_probe(struct spi_device *spi) 518{ 519 struct snd_soc_codec *codec; 520 struct wm8711_priv *wm8711; 521 522 wm8711 = kzalloc(sizeof(struct wm8711_priv), GFP_KERNEL); 523 if (wm8711 == NULL) 524 return -ENOMEM; 525 526 codec = &wm8711->codec; 527 codec->control_data = spi; 528 codec->dev = &spi->dev; 529 530 dev_set_drvdata(&spi->dev, wm8711); 531 532 return wm8711_register(wm8711, SND_SOC_SPI); 533} 534 535static int __devexit wm8711_spi_remove(struct spi_device *spi) 536{ 537 struct wm8711_priv *wm8711 = dev_get_drvdata(&spi->dev); 538 539 wm8711_unregister(wm8711); 540 541 return 0; 542} 543 544static struct spi_driver wm8711_spi_driver = { 545 .driver = { 546 .name = "wm8711", 547 .bus = &spi_bus_type, 548 .owner = THIS_MODULE, 549 }, 550 .probe = wm8711_spi_probe, 551 .remove = __devexit_p(wm8711_spi_remove), 552}; 553#endif /* CONFIG_SPI_MASTER */ 554 555#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) 556static __devinit int wm8711_i2c_probe(struct i2c_client *i2c, 557 const struct i2c_device_id *id) 558{ 559 struct wm8711_priv *wm8711; 560 struct snd_soc_codec *codec; 561 562 wm8711 = kzalloc(sizeof(struct wm8711_priv), GFP_KERNEL); 563 if (wm8711 == NULL) 564 return -ENOMEM; 565 566 codec = &wm8711->codec; 567 codec->hw_write = (hw_write_t)i2c_master_send; 568 569 i2c_set_clientdata(i2c, wm8711); 570 codec->control_data = i2c; 571 572 codec->dev = &i2c->dev; 573 574 return wm8711_register(wm8711, SND_SOC_I2C); 575} 576 577static __devexit int wm8711_i2c_remove(struct i2c_client *client) 578{ 579 struct wm8711_priv *wm8711 = i2c_get_clientdata(client); 580 wm8711_unregister(wm8711); 581 return 0; 582} 583 584static const struct i2c_device_id wm8711_i2c_id[] = { 585 { "wm8711", 0 }, 586 { } 587}; 588MODULE_DEVICE_TABLE(i2c, wm8711_i2c_id); 589 590static struct i2c_driver wm8711_i2c_driver = { 591 .driver = { 592 .name = "WM8711 I2C Codec", 593 .owner = THIS_MODULE, 594 }, 595 .probe = wm8711_i2c_probe, 596 .remove = __devexit_p(wm8711_i2c_remove), 597 .id_table = wm8711_i2c_id, 598}; 599#endif 600 601static int __init wm8711_modinit(void) 602{ 603 int ret; 604#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) 605 ret = i2c_add_driver(&wm8711_i2c_driver); 606 if (ret != 0) { 607 printk(KERN_ERR "Failed to register WM8711 I2C driver: %d\n", 608 ret); 609 } 610#endif 611#if defined(CONFIG_SPI_MASTER) 612 ret = spi_register_driver(&wm8711_spi_driver); 613 if (ret != 0) { 614 printk(KERN_ERR "Failed to register WM8711 SPI driver: %d\n", 615 ret); 616 } 617#endif 618 return 0; 619} 620module_init(wm8711_modinit); 621 622static void __exit wm8711_exit(void) 623{ 624#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) 625 i2c_del_driver(&wm8711_i2c_driver); 626#endif 627#if defined(CONFIG_SPI_MASTER) 628 spi_unregister_driver(&wm8711_spi_driver); 629#endif 630} 631module_exit(wm8711_exit); 632 633MODULE_DESCRIPTION("ASoC WM8711 driver"); 634MODULE_AUTHOR("Mike Arthur"); 635MODULE_LICENSE("GPL"); 636