wm8731.c 16.9 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20
/*
 * wm8731.c  --  WM8731 ALSA SoC Audio driver
 *
 * Copyright 2005 Openedhand Ltd.
 *
 * Author: Richard Purdie <richard@openedhand.com>
 *
 * Based on wm8753.c by Liam Girdwood
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/pm.h>
#include <linux/i2c.h>
21
#include <linux/slab.h>
22
#include <linux/platform_device.h>
23
#include <linux/regulator/consumer.h>
24
#include <linux/spi/spi.h>
25 26 27 28 29 30
#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
#include <sound/soc.h>
#include <sound/soc-dapm.h>
#include <sound/initval.h>
31
#include <sound/tlv.h>
32 33 34

#include "wm8731.h"

35 36 37 38 39 40 41 42
#define WM8731_NUM_SUPPLIES 4
static const char *wm8731_supply_names[WM8731_NUM_SUPPLIES] = {
	"AVDD",
	"HPVDD",
	"DCVDD",
	"DBVDD",
};

43 44
/* codec private data */
struct wm8731_priv {
45
	enum snd_soc_control_type control_type;
46
	struct regulator_bulk_data supplies[WM8731_NUM_SUPPLIES];
47
	u16 reg_cache[WM8731_CACHEREGNUM];
48
	unsigned int sysclk;
49
	int sysclk_type;
50 51
};

52

53 54 55 56 57 58 59
/*
 * wm8731 register cache
 * We can't read the WM8731 register space when we are
 * using 2 wire for device control, so we cache them instead.
 * There is no point in caching the reset register
 */
static const u16 wm8731_reg[WM8731_CACHEREGNUM] = {
60 61 62
	0x0097, 0x0097, 0x0079, 0x0079,
	0x000a, 0x0008, 0x009f, 0x000a,
	0x0000, 0x0000
63 64
};

65
#define wm8731_reset(c)	snd_soc_write(c, WM8731_RESET, 0)
66 67 68 69 70 71 72 73 74

static const char *wm8731_input_select[] = {"Line In", "Mic"};
static const char *wm8731_deemph[] = {"None", "32Khz", "44.1Khz", "48Khz"};

static const struct soc_enum wm8731_enum[] = {
	SOC_ENUM_SINGLE(WM8731_APANA, 2, 2, wm8731_input_select),
	SOC_ENUM_SINGLE(WM8731_APDIGI, 1, 4, wm8731_deemph),
};

75 76 77 78
static const DECLARE_TLV_DB_SCALE(in_tlv, -3450, 150, 0);
static const DECLARE_TLV_DB_SCALE(sidetone_tlv, -1500, 300, 0);
static const DECLARE_TLV_DB_SCALE(out_tlv, -12100, 100, 1);

79 80
static const struct snd_kcontrol_new wm8731_snd_controls[] = {

81 82
SOC_DOUBLE_R_TLV("Master Playback Volume", WM8731_LOUT1V, WM8731_ROUT1V,
		 0, 127, 0, out_tlv),
83 84
SOC_DOUBLE_R("Master Playback ZC Switch", WM8731_LOUT1V, WM8731_ROUT1V,
	7, 1, 0),
85

86 87
SOC_DOUBLE_R_TLV("Capture Volume", WM8731_LINVOL, WM8731_RINVOL, 0, 31, 0,
		 in_tlv),
88 89 90
SOC_DOUBLE_R("Line Capture Switch", WM8731_LINVOL, WM8731_RINVOL, 7, 1, 1),

SOC_SINGLE("Mic Boost (+20dB)", WM8731_APANA, 0, 1, 0),
91
SOC_SINGLE("Mic Capture Switch", WM8731_APANA, 1, 1, 1),
92

93 94
SOC_SINGLE_TLV("Sidetone Playback Volume", WM8731_APANA, 6, 3, 1,
	       sidetone_tlv),
95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113

SOC_SINGLE("ADC High Pass Filter Switch", WM8731_APDIGI, 0, 1, 1),
SOC_SINGLE("Store DC Offset Switch", WM8731_APDIGI, 4, 1, 0),

SOC_ENUM("Playback De-emphasis", wm8731_enum[1]),
};

/* Output Mixer */
static const struct snd_kcontrol_new wm8731_output_mixer_controls[] = {
SOC_DAPM_SINGLE("Line Bypass Switch", WM8731_APANA, 3, 1, 0),
SOC_DAPM_SINGLE("Mic Sidetone Switch", WM8731_APANA, 5, 1, 0),
SOC_DAPM_SINGLE("HiFi Playback Switch", WM8731_APANA, 4, 1, 0),
};

/* Input mux */
static const struct snd_kcontrol_new wm8731_input_mux_controls =
SOC_DAPM_ENUM("Input Select", wm8731_enum[0]);

static const struct snd_soc_dapm_widget wm8731_dapm_widgets[] = {
114
SND_SOC_DAPM_SUPPLY("OSC", WM8731_PWR, 5, 1, NULL, 0),
115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131
SND_SOC_DAPM_MIXER("Output Mixer", WM8731_PWR, 4, 1,
	&wm8731_output_mixer_controls[0],
	ARRAY_SIZE(wm8731_output_mixer_controls)),
SND_SOC_DAPM_DAC("DAC", "HiFi Playback", WM8731_PWR, 3, 1),
SND_SOC_DAPM_OUTPUT("LOUT"),
SND_SOC_DAPM_OUTPUT("LHPOUT"),
SND_SOC_DAPM_OUTPUT("ROUT"),
SND_SOC_DAPM_OUTPUT("RHPOUT"),
SND_SOC_DAPM_ADC("ADC", "HiFi Capture", WM8731_PWR, 2, 1),
SND_SOC_DAPM_MUX("Input Mux", SND_SOC_NOPM, 0, 0, &wm8731_input_mux_controls),
SND_SOC_DAPM_PGA("Line Input", WM8731_PWR, 0, 1, NULL, 0),
SND_SOC_DAPM_MICBIAS("Mic Bias", WM8731_PWR, 1, 1),
SND_SOC_DAPM_INPUT("MICIN"),
SND_SOC_DAPM_INPUT("RLINEIN"),
SND_SOC_DAPM_INPUT("LLINEIN"),
};

132 133 134 135 136 137 138 139
static int wm8731_check_osc(struct snd_soc_dapm_widget *source,
			    struct snd_soc_dapm_widget *sink)
{
	struct wm8731_priv *wm8731 = snd_soc_codec_get_drvdata(source->codec);

	return wm8731->sysclk_type == WM8731_SYSCLK_MCLK;
}

140
static const struct snd_soc_dapm_route intercon[] = {
141 142 143
	{"DAC", NULL, "OSC", wm8731_check_osc},
	{"ADC", NULL, "OSC", wm8731_check_osc},

144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167
	/* output mixer */
	{"Output Mixer", "Line Bypass Switch", "Line Input"},
	{"Output Mixer", "HiFi Playback Switch", "DAC"},
	{"Output Mixer", "Mic Sidetone Switch", "Mic Bias"},

	/* outputs */
	{"RHPOUT", NULL, "Output Mixer"},
	{"ROUT", NULL, "Output Mixer"},
	{"LHPOUT", NULL, "Output Mixer"},
	{"LOUT", NULL, "Output Mixer"},

	/* input mux */
	{"Input Mux", "Line In", "Line Input"},
	{"Input Mux", "Mic", "Mic Bias"},
	{"ADC", NULL, "Input Mux"},

	/* inputs */
	{"Line Input", NULL, "LLINEIN"},
	{"Line Input", NULL, "RLINEIN"},
	{"Mic Bias", NULL, "MICIN"},
};

static int wm8731_add_widgets(struct snd_soc_codec *codec)
{
168 169
	snd_soc_dapm_new_controls(codec, wm8731_dapm_widgets,
				  ARRAY_SIZE(wm8731_dapm_widgets));
170

171
	snd_soc_dapm_add_routes(codec, intercon, ARRAY_SIZE(intercon));
172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194

	return 0;
}

struct _coeff_div {
	u32 mclk;
	u32 rate;
	u16 fs;
	u8 sr:4;
	u8 bosr:1;
	u8 usb:1;
};

/* codec mclk clock divider coefficients */
static const struct _coeff_div coeff_div[] = {
	/* 48k */
	{12288000, 48000, 256, 0x0, 0x0, 0x0},
	{18432000, 48000, 384, 0x0, 0x1, 0x0},
	{12000000, 48000, 250, 0x0, 0x0, 0x1},

	/* 32k */
	{12288000, 32000, 384, 0x6, 0x0, 0x0},
	{18432000, 32000, 576, 0x6, 0x1, 0x0},
195
	{12000000, 32000, 375, 0x6, 0x0, 0x1},
196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230

	/* 8k */
	{12288000, 8000, 1536, 0x3, 0x0, 0x0},
	{18432000, 8000, 2304, 0x3, 0x1, 0x0},
	{11289600, 8000, 1408, 0xb, 0x0, 0x0},
	{16934400, 8000, 2112, 0xb, 0x1, 0x0},
	{12000000, 8000, 1500, 0x3, 0x0, 0x1},

	/* 96k */
	{12288000, 96000, 128, 0x7, 0x0, 0x0},
	{18432000, 96000, 192, 0x7, 0x1, 0x0},
	{12000000, 96000, 125, 0x7, 0x0, 0x1},

	/* 44.1k */
	{11289600, 44100, 256, 0x8, 0x0, 0x0},
	{16934400, 44100, 384, 0x8, 0x1, 0x0},
	{12000000, 44100, 272, 0x8, 0x1, 0x1},

	/* 88.2k */
	{11289600, 88200, 128, 0xf, 0x0, 0x0},
	{16934400, 88200, 192, 0xf, 0x1, 0x0},
	{12000000, 88200, 136, 0xf, 0x1, 0x1},
};

static inline int get_coeff(int mclk, int rate)
{
	int i;

	for (i = 0; i < ARRAY_SIZE(coeff_div); i++) {
		if (coeff_div[i].rate == rate && coeff_div[i].mclk == mclk)
			return i;
	}
	return 0;
}

231
static int wm8731_hw_params(struct snd_pcm_substream *substream,
232 233
			    struct snd_pcm_hw_params *params,
			    struct snd_soc_dai *dai)
234
{
235
	struct snd_soc_codec *codec = dai->codec;
236
	struct wm8731_priv *wm8731 = snd_soc_codec_get_drvdata(codec);
237
	u16 iface = snd_soc_read(codec, WM8731_IFACE) & 0xfff3;
238 239 240
	int i = get_coeff(wm8731->sysclk, params_rate(params));
	u16 srate = (coeff_div[i].sr << 2) |
		(coeff_div[i].bosr << 1) | coeff_div[i].usb;
241

242
	snd_soc_write(codec, WM8731_SRATE, srate);
243 244 245 246 247 248 249 250 251 252 253 254

	/* bit size */
	switch (params_format(params)) {
	case SNDRV_PCM_FORMAT_S16_LE:
		break;
	case SNDRV_PCM_FORMAT_S20_3LE:
		iface |= 0x0004;
		break;
	case SNDRV_PCM_FORMAT_S24_LE:
		iface |= 0x0008;
		break;
	}
255

256
	snd_soc_write(codec, WM8731_IFACE, iface);
257
	return 0;
258 259
}

260 261
static int wm8731_pcm_prepare(struct snd_pcm_substream *substream,
			      struct snd_soc_dai *dai)
262
{
263
	struct snd_soc_codec *codec = dai->codec;
264 265

	/* set active */
266
	snd_soc_write(codec, WM8731_ACTIVE, 0x0001);
267 268 269 270

	return 0;
}

271 272
static void wm8731_shutdown(struct snd_pcm_substream *substream,
			    struct snd_soc_dai *dai)
273
{
274
	struct snd_soc_codec *codec = dai->codec;
275 276 277 278

	/* deactivate */
	if (!codec->active) {
		udelay(50);
279
		snd_soc_write(codec, WM8731_ACTIVE, 0x0);
280 281 282
	}
}

283
static int wm8731_mute(struct snd_soc_dai *dai, int mute)
284 285
{
	struct snd_soc_codec *codec = dai->codec;
286
	u16 mute_reg = snd_soc_read(codec, WM8731_APDIGI) & 0xfff7;
287 288

	if (mute)
289
		snd_soc_write(codec, WM8731_APDIGI, mute_reg | 0x8);
290
	else
291
		snd_soc_write(codec, WM8731_APDIGI, mute_reg);
292 293 294
	return 0;
}

295
static int wm8731_set_dai_sysclk(struct snd_soc_dai *codec_dai,
296 297 298
		int clk_id, unsigned int freq, int dir)
{
	struct snd_soc_codec *codec = codec_dai->codec;
299
	struct wm8731_priv *wm8731 = snd_soc_codec_get_drvdata(codec);
300

301 302 303 304 305 306 307 308 309
	switch (clk_id) {
	case WM8731_SYSCLK_XTAL:
	case WM8731_SYSCLK_MCLK:
		wm8731->sysclk_type = clk_id;
		break;
	default:
		return -EINVAL;
	}

310 311 312 313 314 315 316
	switch (freq) {
	case 11289600:
	case 12000000:
	case 12288000:
	case 16934400:
	case 18432000:
		wm8731->sysclk = freq;
317 318 319
		break;
	default:
		return -EINVAL;
320
	}
321 322 323 324

	snd_soc_dapm_sync(codec);

	return 0;
325 326 327
}


328
static int wm8731_set_dai_fmt(struct snd_soc_dai *codec_dai,
329 330 331 332
		unsigned int fmt)
{
	struct snd_soc_codec *codec = codec_dai->codec;
	u16 iface = 0;
333 334

	/* set master/slave audio interface */
335
	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
336 337 338 339 340
	case SND_SOC_DAIFMT_CBM_CFM:
		iface |= 0x0040;
		break;
	case SND_SOC_DAIFMT_CBS_CFS:
		break;
341 342
	default:
		return -EINVAL;
343 344 345
	}

	/* interface format */
346
	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
347 348 349 350 351 352 353 354 355 356 357 358 359 360
	case SND_SOC_DAIFMT_I2S:
		iface |= 0x0002;
		break;
	case SND_SOC_DAIFMT_RIGHT_J:
		break;
	case SND_SOC_DAIFMT_LEFT_J:
		iface |= 0x0001;
		break;
	case SND_SOC_DAIFMT_DSP_A:
		iface |= 0x0003;
		break;
	case SND_SOC_DAIFMT_DSP_B:
		iface |= 0x0013;
		break;
361 362
	default:
		return -EINVAL;
363 364 365
	}

	/* clock inversion */
366
	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
367 368 369 370 371 372 373 374 375 376 377
	case SND_SOC_DAIFMT_NB_NF:
		break;
	case SND_SOC_DAIFMT_IB_IF:
		iface |= 0x0090;
		break;
	case SND_SOC_DAIFMT_IB_NF:
		iface |= 0x0080;
		break;
	case SND_SOC_DAIFMT_NB_IF:
		iface |= 0x0010;
		break;
378 379
	default:
		return -EINVAL;
380 381 382
	}

	/* set iface */
383
	snd_soc_write(codec, WM8731_IFACE, iface);
384 385 386
	return 0;
}

387 388
static int wm8731_set_bias_level(struct snd_soc_codec *codec,
				 enum snd_soc_bias_level level)
389
{
390 391 392 393
	struct wm8731_priv *wm8731 = snd_soc_codec_get_drvdata(codec);
	int i, ret;
	u8 data[2];
	u16 *cache = codec->reg_cache;
394
	u16 reg;
395

396 397
	switch (level) {
	case SND_SOC_BIAS_ON:
398
		break;
399
	case SND_SOC_BIAS_PREPARE:
400
		break;
401
	case SND_SOC_BIAS_STANDBY:
402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419
		if (codec->bias_level == SND_SOC_BIAS_OFF) {
			ret = regulator_bulk_enable(ARRAY_SIZE(wm8731->supplies),
						    wm8731->supplies);
			if (ret != 0)
				return ret;

			/* Sync reg_cache with the hardware */
			for (i = 0; i < ARRAY_SIZE(wm8731_reg); i++) {
				if (cache[i] == wm8731_reg[i])
					continue;

				data[0] = (i << 1) | ((cache[i] >> 8)
						      & 0x0001);
				data[1] = cache[i] & 0x00ff;
				codec->hw_write(codec->control_data, data, 2);
			}
		}

420
		/* Clear PWROFF, gate CLKOUT, everything else as-is */
421 422
		reg = snd_soc_read(codec, WM8731_PWR) & 0xff7f;
		snd_soc_write(codec, WM8731_PWR, reg | 0x0040);
423
		break;
424
	case SND_SOC_BIAS_OFF:
425 426
		snd_soc_write(codec, WM8731_ACTIVE, 0x0);
		snd_soc_write(codec, WM8731_PWR, 0xffff);
427 428
		regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies),
				       wm8731->supplies);
429 430
		break;
	}
431
	codec->bias_level = level;
432 433 434
	return 0;
}

435
#define WM8731_RATES SNDRV_PCM_RATE_8000_96000
436 437 438 439

#define WM8731_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
	SNDRV_PCM_FMTBIT_S24_LE)

440 441 442 443 444 445 446 447 448
static struct snd_soc_dai_ops wm8731_dai_ops = {
	.prepare	= wm8731_pcm_prepare,
	.hw_params	= wm8731_hw_params,
	.shutdown	= wm8731_shutdown,
	.digital_mute	= wm8731_mute,
	.set_sysclk	= wm8731_set_dai_sysclk,
	.set_fmt	= wm8731_set_dai_fmt,
};

449 450
static struct snd_soc_dai_driver wm8731_dai = {
	.name = "wm8731-hifi",
451 452 453 454
	.playback = {
		.stream_name = "Playback",
		.channels_min = 1,
		.channels_max = 2,
455 456
		.rates = WM8731_RATES,
		.formats = WM8731_FORMATS,},
457 458 459 460
	.capture = {
		.stream_name = "Capture",
		.channels_min = 1,
		.channels_max = 2,
461 462
		.rates = WM8731_RATES,
		.formats = WM8731_FORMATS,},
463
	.ops = &wm8731_dai_ops,
464
	.symmetric_rates = 1,
465 466
};

467
#ifdef CONFIG_PM
468
static int wm8731_suspend(struct snd_soc_codec *codec, pm_message_t state)
469
{
470
	wm8731_set_bias_level(codec, SND_SOC_BIAS_OFF);
471

472 473 474
	return 0;
}

475
static int wm8731_resume(struct snd_soc_codec *codec)
476
{
477
	wm8731_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
478

479 480
	return 0;
}
481 482 483 484
#else
#define wm8731_suspend NULL
#define wm8731_resume NULL
#endif
485

486
static int wm8731_probe(struct snd_soc_codec *codec)
487
{
488 489
	struct wm8731_priv *wm8731 = snd_soc_codec_get_drvdata(codec);
	int ret = 0, i;
490

491
	codec->bias_level = SND_SOC_BIAS_OFF,
492

493
	ret = snd_soc_codec_set_cache_io(codec, 7, 9, wm8731->control_type);
494 495
	if (ret < 0) {
		dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
496
		return ret;
497 498
	}

499 500 501 502 503 504 505
	for (i = 0; i < ARRAY_SIZE(wm8731->supplies); i++)
		wm8731->supplies[i].supply = wm8731_supply_names[i];

	ret = regulator_bulk_get(codec->dev, ARRAY_SIZE(wm8731->supplies),
				 wm8731->supplies);
	if (ret != 0) {
		dev_err(codec->dev, "Failed to request supplies: %d\n", ret);
506
		return ret;
507 508 509 510 511 512 513 514 515
	}

	ret = regulator_bulk_enable(ARRAY_SIZE(wm8731->supplies),
				    wm8731->supplies);
	if (ret != 0) {
		dev_err(codec->dev, "Failed to enable supplies: %d\n", ret);
		goto err_regulator_get;
	}

516 517
	ret = wm8731_reset(codec);
	if (ret < 0) {
518
		dev_err(codec->dev, "Failed to issue reset: %d\n", ret);
519
		goto err_regulator_enable;
520 521
	}

522 523 524
	wm8731_set_bias_level(codec, SND_SOC_BIAS_STANDBY);

	/* Latch the update bits */
525 526 527 528
	snd_soc_update_bits(codec, WM8731_LOUT1V, 0x100, 0);
	snd_soc_update_bits(codec, WM8731_ROUT1V, 0x100, 0);
	snd_soc_update_bits(codec, WM8731_LINVOL, 0x100, 0);
	snd_soc_update_bits(codec, WM8731_RINVOL, 0x100, 0);
529

530
	/* Disable bypass path by default */
531
	snd_soc_update_bits(codec, WM8731_APANA, 0x4, 0);
532

533 534 535
	snd_soc_add_controls(codec, wm8731_snd_controls,
			     ARRAY_SIZE(wm8731_snd_controls));
	wm8731_add_widgets(codec);
536

537 538 539
	/* Regulators will have been enabled by bias management */
	regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies), wm8731->supplies);

540
	return 0;
541

542 543 544 545
err_regulator_enable:
	regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies), wm8731->supplies);
err_regulator_get:
	regulator_bulk_free(ARRAY_SIZE(wm8731->supplies), wm8731->supplies);
546

547 548
	kfree(wm8731);
	return ret;
549 550
}

551 552
/* power down chip */
static int wm8731_remove(struct snd_soc_codec *codec)
553
{
554 555 556 557 558
	struct wm8731_priv *wm8731 = snd_soc_codec_get_drvdata(codec);

	wm8731_set_bias_level(codec, SND_SOC_BIAS_OFF);

	regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies), wm8731->supplies);
559
	regulator_bulk_free(ARRAY_SIZE(wm8731->supplies), wm8731->supplies);
560 561

	return 0;
562
}
563

564 565 566 567 568 569 570 571 572 573 574
static struct snd_soc_codec_driver soc_codec_dev_wm8731 = {
	.probe =	wm8731_probe,
	.remove =	wm8731_remove,
	.suspend =	wm8731_suspend,
	.resume =	wm8731_resume,
	.set_bias_level = wm8731_set_bias_level,
	.reg_cache_size = sizeof(wm8731_reg),
	.reg_word_size = sizeof(u16),
	.reg_cache_default = wm8731_reg,
};

575 576 577 578
#if defined(CONFIG_SPI_MASTER)
static int __devinit wm8731_spi_probe(struct spi_device *spi)
{
	struct wm8731_priv *wm8731;
579
	int ret;
580 581 582 583 584

	wm8731 = kzalloc(sizeof(struct wm8731_priv), GFP_KERNEL);
	if (wm8731 == NULL)
		return -ENOMEM;

585 586
	wm8731->control_type = SND_SOC_SPI;
	spi_set_drvdata(spi, wm8731);
587

588 589 590 591 592
	ret = snd_soc_register_codec(&spi->dev,
			&soc_codec_dev_wm8731, &wm8731_dai, 1);
	if (ret < 0)
		kfree(wm8731);
	return ret;
593 594 595 596
}

static int __devexit wm8731_spi_remove(struct spi_device *spi)
{
597 598
	snd_soc_unregister_codec(&spi->dev);
	kfree(spi_get_drvdata(spi));
599 600 601 602 603
	return 0;
}

static struct spi_driver wm8731_spi_driver = {
	.driver = {
604
		.name	= "wm8731-codec",
605 606 607 608 609 610
		.bus	= &spi_bus_type,
		.owner	= THIS_MODULE,
	},
	.probe		= wm8731_spi_probe,
	.remove		= __devexit_p(wm8731_spi_remove),
};
611 612 613
#endif /* CONFIG_SPI_MASTER */

#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
614 615
static __devinit int wm8731_i2c_probe(struct i2c_client *i2c,
				      const struct i2c_device_id *id)
616
{
617
	struct wm8731_priv *wm8731;
618
	int ret;
619

620 621 622 623 624
	wm8731 = kzalloc(sizeof(struct wm8731_priv), GFP_KERNEL);
	if (wm8731 == NULL)
		return -ENOMEM;

	i2c_set_clientdata(i2c, wm8731);
625
	wm8731->control_type = SND_SOC_I2C;
626

627 628 629 630 631
	ret =  snd_soc_register_codec(&i2c->dev,
			&soc_codec_dev_wm8731, &wm8731_dai, 1);
	if (ret < 0)
		kfree(wm8731);
	return ret;
632 633
}

634
static __devexit int wm8731_i2c_remove(struct i2c_client *client)
635
{
636 637
	snd_soc_unregister_codec(&client->dev);
	kfree(i2c_get_clientdata(client));
638 639 640 641 642 643 644 645 646 647 648
	return 0;
}

static const struct i2c_device_id wm8731_i2c_id[] = {
	{ "wm8731", 0 },
	{ }
};
MODULE_DEVICE_TABLE(i2c, wm8731_i2c_id);

static struct i2c_driver wm8731_i2c_driver = {
	.driver = {
649
		.name = "wm8731-codec",
650 651 652
		.owner = THIS_MODULE,
	},
	.probe =    wm8731_i2c_probe,
653
	.remove =   __devexit_p(wm8731_i2c_remove),
654 655 656 657
	.id_table = wm8731_i2c_id,
};
#endif

658
static int __init wm8731_modinit(void)
M
Mark Brown 已提交
659
{
660
	int ret = 0;
661 662 663 664 665 666 667 668 669 670 671 672 673 674
#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
	ret = i2c_add_driver(&wm8731_i2c_driver);
	if (ret != 0) {
		printk(KERN_ERR "Failed to register WM8731 I2C driver: %d\n",
		       ret);
	}
#endif
#if defined(CONFIG_SPI_MASTER)
	ret = spi_register_driver(&wm8731_spi_driver);
	if (ret != 0) {
		printk(KERN_ERR "Failed to register WM8731 SPI driver: %d\n",
		       ret);
	}
#endif
675
	return ret;
M
Mark Brown 已提交
676 677 678 679 680
}
module_init(wm8731_modinit);

static void __exit wm8731_exit(void)
{
681 682 683 684 685 686
#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
	i2c_del_driver(&wm8731_i2c_driver);
#endif
#if defined(CONFIG_SPI_MASTER)
	spi_unregister_driver(&wm8731_spi_driver);
#endif
M
Mark Brown 已提交
687 688 689
}
module_exit(wm8731_exit);

690 691 692
MODULE_DESCRIPTION("ASoC WM8731 driver");
MODULE_AUTHOR("Richard Purdie");
MODULE_LICENSE("GPL");