linux/sound/soc/codecs/wm8776.c
<<
>>
Prefs
   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
  33static struct snd_soc_codec *wm8776_codec;
  34struct snd_soc_codec_device soc_codec_dev_wm8776;
  35
  36/* codec private data */
  37struct 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
  44static int wm8776_spi_write(struct spi_device *spi, const char *data, int len);
  45#endif
  46
  47static 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
  55static int wm8776_reset(struct snd_soc_codec *codec)
  56{
  57        return snd_soc_write(codec, WM8776_RESET, 0);
  58}
  59
  60static const DECLARE_TLV_DB_SCALE(hp_tlv, -12100, 100, 1);
  61static const DECLARE_TLV_DB_SCALE(dac_tlv, -12750, 50, 1);
  62static const DECLARE_TLV_DB_SCALE(adc_tlv, -10350, 50, 1);
  63
  64static const struct snd_kcontrol_new wm8776_snd_controls[] = {
  65SOC_DOUBLE_R_TLV("Headphone Playback Volume", WM8776_HPLVOL, WM8776_HPRVOL,
  66                 0, 127, 0, hp_tlv),
  67SOC_DOUBLE_R_TLV("Digital Playback Volume", WM8776_DACLVOL, WM8776_DACRVOL,
  68                 0, 255, 0, dac_tlv),
  69SOC_SINGLE("Digital Playback ZC Switch", WM8776_DACCTRL1, 0, 1, 0),
  70
  71SOC_SINGLE("Deemphasis Switch", WM8776_DACCTRL2, 0, 1, 0),
  72
  73SOC_DOUBLE_R_TLV("Capture Volume", WM8776_ADCLVOL, WM8776_ADCRVOL,
  74                 0, 255, 0, adc_tlv),
  75SOC_DOUBLE("Capture Switch", WM8776_ADCMUX, 7, 6, 1, 1),
  76SOC_DOUBLE_R("Capture ZC Switch", WM8776_ADCLVOL, WM8776_ADCRVOL, 8, 1, 0),
  77SOC_SINGLE("Capture HPF Switch", WM8776_ADCIFCTRL, 8, 1, 1),
  78};
  79
  80static const struct snd_kcontrol_new inmix_controls[] = {
  81SOC_DAPM_SINGLE("AIN1 Switch", WM8776_ADCMUX, 0, 1, 0),
  82SOC_DAPM_SINGLE("AIN2 Switch", WM8776_ADCMUX, 1, 1, 0),
  83SOC_DAPM_SINGLE("AIN3 Switch", WM8776_ADCMUX, 2, 1, 0),
  84SOC_DAPM_SINGLE("AIN4 Switch", WM8776_ADCMUX, 3, 1, 0),
  85SOC_DAPM_SINGLE("AIN5 Switch", WM8776_ADCMUX, 4, 1, 0),
  86};
  87
  88static const struct snd_kcontrol_new outmix_controls[] = {
  89SOC_DAPM_SINGLE("DAC Switch", WM8776_OUTMUX, 0, 1, 0),
  90SOC_DAPM_SINGLE("AUX Switch", WM8776_OUTMUX, 1, 1, 0),
  91SOC_DAPM_SINGLE("Bypass Switch", WM8776_OUTMUX, 2, 1, 0),
  92};
  93
  94static const struct snd_soc_dapm_widget wm8776_dapm_widgets[] = {
  95SND_SOC_DAPM_INPUT("AUX"),
  96SND_SOC_DAPM_INPUT("AUX"),
  97
  98SND_SOC_DAPM_INPUT("AIN1"),
  99SND_SOC_DAPM_INPUT("AIN2"),
 100SND_SOC_DAPM_INPUT("AIN3"),
 101SND_SOC_DAPM_INPUT("AIN4"),
 102SND_SOC_DAPM_INPUT("AIN5"),
 103
 104SND_SOC_DAPM_MIXER("Input Mixer", WM8776_PWRDOWN, 6, 1,
 105                   inmix_controls, ARRAY_SIZE(inmix_controls)),
 106
 107SND_SOC_DAPM_ADC("ADC", "Capture", WM8776_PWRDOWN, 1, 1),
 108SND_SOC_DAPM_DAC("DAC", "Playback", WM8776_PWRDOWN, 2, 1),
 109
 110SND_SOC_DAPM_MIXER("Output Mixer", SND_SOC_NOPM, 0, 0,
 111                   outmix_controls, ARRAY_SIZE(outmix_controls)),
 112
 113SND_SOC_DAPM_PGA("Headphone PGA", WM8776_PWRDOWN, 3, 1, NULL, 0),
 114
 115SND_SOC_DAPM_OUTPUT("VOUT"),
 116
 117SND_SOC_DAPM_OUTPUT("HPOUTL"),
 118SND_SOC_DAPM_OUTPUT("HPOUTR"),
 119};
 120
 121static 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
 142static 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
 215static int mclk_ratios[] = {
 216        128,
 217        192,
 218        256,
 219        384,
 220        512,
 221        768,
 222};
 223
 224static 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
 295static 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
 302static 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
 315static 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
 347static 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
 354static 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
 360struct 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};
 386EXPORT_SYMBOL_GPL(wm8776_dai);
 387
 388#ifdef CONFIG_PM
 389static 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
 399static 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
 423static 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
 458card_err:
 459        snd_soc_free_pcms(socdev);
 460        snd_soc_dapm_free(socdev);
 461pcm_err:
 462        return ret;
 463}
 464
 465/* power down chip */
 466static 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
 476struct 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};
 482EXPORT_SYMBOL_GPL(soc_codec_dev_wm8776);
 483
 484static 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
 550err_codec:
 551        snd_soc_unregister_codec(codec);
 552err:
 553        kfree(wm8776);
 554        return ret;
 555}
 556
 557static 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)
 567static 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
 591static 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
 610static 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
 620static int wm8776_spi_suspend(struct spi_device *spi, pm_message_t msg)
 621{
 622        return snd_soc_suspend_device(&spi->dev);
 623}
 624
 625static 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
 634static 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)
 648static __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
 669static __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
 677static int wm8776_i2c_suspend(struct i2c_client *i2c, pm_message_t msg)
 678{
 679        return snd_soc_suspend_device(&i2c->dev);
 680}
 681
 682static 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
 691static const struct i2c_device_id wm8776_i2c_id[] = {
 692        { "wm8776", 0 },
 693        { }
 694};
 695MODULE_DEVICE_TABLE(i2c, wm8776_i2c_id);
 696
 697static 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
 710static 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}
 729module_init(wm8776_modinit);
 730
 731static 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}
 740module_exit(wm8776_exit);
 741
 742MODULE_DESCRIPTION("ASoC WM8776 driver");
 743MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
 744MODULE_LICENSE("GPL");
 745