wm8994-core.c 17.3 KB
Newer Older
M
Mark Brown 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
/*
 * wm8994-core.c  --  Device access for Wolfson WM8994
 *
 * Copyright 2009 Wolfson Microelectronics PLC.
 *
 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
 *
 *  This program is free software; you can redistribute  it and/or modify it
 *  under  the terms of  the GNU General  Public License as published by the
 *  Free Software Foundation;  either version 2 of the  License, or (at your
 *  option) any later version.
 *
 */

#include <linux/kernel.h>
#include <linux/module.h>
17
#include <linux/slab.h>
M
Mark Brown 已提交
18
#include <linux/i2c.h>
19
#include <linux/err.h>
M
Mark Brown 已提交
20 21
#include <linux/delay.h>
#include <linux/mfd/core.h>
22
#include <linux/pm_runtime.h>
23
#include <linux/regmap.h>
M
Mark Brown 已提交
24 25 26 27 28 29 30
#include <linux/regulator/consumer.h>
#include <linux/regulator/machine.h>

#include <linux/mfd/wm8994/core.h>
#include <linux/mfd/wm8994/pdata.h>
#include <linux/mfd/wm8994/registers.h>

31
#include "wm8994.h"
M
Mark Brown 已提交
32 33 34 35 36 37 38 39 40

/**
 * wm8994_reg_read: Read a single WM8994 register.
 *
 * @wm8994: Device to read from.
 * @reg: Register to read.
 */
int wm8994_reg_read(struct wm8994 *wm8994, unsigned short reg)
{
41
	unsigned int val;
M
Mark Brown 已提交
42 43
	int ret;

44
	ret = regmap_read(wm8994->regmap, reg, &val);
M
Mark Brown 已提交
45 46 47 48

	if (ret < 0)
		return ret;
	else
49
		return val;
M
Mark Brown 已提交
50 51 52 53 54 55 56 57 58
}
EXPORT_SYMBOL_GPL(wm8994_reg_read);

/**
 * wm8994_bulk_read: Read multiple WM8994 registers
 *
 * @wm8994: Device to read from
 * @reg: First register
 * @count: Number of registers
59
 * @buf: Buffer to fill.  The data will be returned big endian.
M
Mark Brown 已提交
60 61 62 63
 */
int wm8994_bulk_read(struct wm8994 *wm8994, unsigned short reg,
		     int count, u16 *buf)
{
64
	return regmap_bulk_read(wm8994->regmap, reg, buf, count);
M
Mark Brown 已提交
65 66 67 68 69 70 71 72 73 74 75 76
}

/**
 * wm8994_reg_write: Write a single WM8994 register.
 *
 * @wm8994: Device to write to.
 * @reg: Register to write to.
 * @val: Value to write.
 */
int wm8994_reg_write(struct wm8994 *wm8994, unsigned short reg,
		     unsigned short val)
{
77
	return regmap_write(wm8994->regmap, reg, val);
M
Mark Brown 已提交
78 79 80
}
EXPORT_SYMBOL_GPL(wm8994_reg_write);

81 82 83 84 85 86
/**
 * wm8994_bulk_write: Write multiple WM8994 registers
 *
 * @wm8994: Device to write to
 * @reg: First register
 * @count: Number of registers
87
 * @buf: Buffer to write from.  Data must be big-endian formatted.
88 89
 */
int wm8994_bulk_write(struct wm8994 *wm8994, unsigned short reg,
M
Mark Brown 已提交
90
		      int count, const u16 *buf)
91
{
92
	return regmap_raw_write(wm8994->regmap, reg, buf, count * sizeof(u16));
93 94 95
}
EXPORT_SYMBOL_GPL(wm8994_bulk_write);

M
Mark Brown 已提交
96 97 98 99 100 101 102 103 104 105 106
/**
 * wm8994_set_bits: Set the value of a bitfield in a WM8994 register
 *
 * @wm8994: Device to write to.
 * @reg: Register to write to.
 * @mask: Mask of bits to set.
 * @val: Value to set (unshifted)
 */
int wm8994_set_bits(struct wm8994 *wm8994, unsigned short reg,
		    unsigned short mask, unsigned short val)
{
107
	return regmap_update_bits(wm8994->regmap, reg, mask, val);
M
Mark Brown 已提交
108 109 110 111
}
EXPORT_SYMBOL_GPL(wm8994_set_bits);

static struct mfd_cell wm8994_regulator_devs[] = {
112 113 114 115 116 117 118 119 120 121
	{
		.name = "wm8994-ldo",
		.id = 1,
		.pm_runtime_no_callbacks = true,
	},
	{
		.name = "wm8994-ldo",
		.id = 2,
		.pm_runtime_no_callbacks = true,
	},
M
Mark Brown 已提交
122 123
};

124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139
static struct resource wm8994_codec_resources[] = {
	{
		.start = WM8994_IRQ_TEMP_SHUT,
		.end   = WM8994_IRQ_TEMP_WARN,
		.flags = IORESOURCE_IRQ,
	},
};

static struct resource wm8994_gpio_resources[] = {
	{
		.start = WM8994_IRQ_GPIO(1),
		.end   = WM8994_IRQ_GPIO(11),
		.flags = IORESOURCE_IRQ,
	},
};

M
Mark Brown 已提交
140
static struct mfd_cell wm8994_devs[] = {
141 142 143 144 145 146 147 148 149 150
	{
		.name = "wm8994-codec",
		.num_resources = ARRAY_SIZE(wm8994_codec_resources),
		.resources = wm8994_codec_resources,
	},

	{
		.name = "wm8994-gpio",
		.num_resources = ARRAY_SIZE(wm8994_gpio_resources),
		.resources = wm8994_gpio_resources,
151
		.pm_runtime_no_callbacks = true,
152
	},
M
Mark Brown 已提交
153 154 155 156 157 158 159
};

/*
 * Supplies for the main bulk of CODEC; the LDO supplies are ignored
 * and should be handled via the standard regulator API supply
 * management.
 */
M
Mark Brown 已提交
160 161 162 163 164 165 166 167 168 169 170 171
static const char *wm1811_main_supplies[] = {
	"DBVDD1",
	"DBVDD2",
	"DBVDD3",
	"DCVDD",
	"AVDD1",
	"AVDD2",
	"CPVDD",
	"SPKVDD1",
	"SPKVDD2",
};

M
Mark Brown 已提交
172 173 174 175 176 177 178 179 180 181
static const char *wm8994_main_supplies[] = {
	"DBVDD",
	"DCVDD",
	"AVDD1",
	"AVDD2",
	"CPVDD",
	"SPKVDD1",
	"SPKVDD2",
};

M
Mark Brown 已提交
182 183 184 185 186 187 188 189 190 191 192 193
static const char *wm8958_main_supplies[] = {
	"DBVDD1",
	"DBVDD2",
	"DBVDD3",
	"DCVDD",
	"AVDD1",
	"AVDD2",
	"CPVDD",
	"SPKVDD1",
	"SPKVDD2",
};

M
Mark Brown 已提交
194
#ifdef CONFIG_PM
195
static int wm8994_suspend(struct device *dev)
M
Mark Brown 已提交
196 197 198 199
{
	struct wm8994 *wm8994 = dev_get_drvdata(dev);
	int ret;

200 201 202 203 204 205 206 207 208 209
	/* Don't actually go through with the suspend if the CODEC is
	 * still active (eg, for audio passthrough from CP. */
	ret = wm8994_reg_read(wm8994, WM8994_POWER_MANAGEMENT_1);
	if (ret < 0) {
		dev_err(dev, "Failed to read power status: %d\n", ret);
	} else if (ret & WM8994_VMID_SEL_MASK) {
		dev_dbg(dev, "CODEC still active, ignoring suspend\n");
		return 0;
	}

210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231
	ret = wm8994_reg_read(wm8994, WM8994_POWER_MANAGEMENT_4);
	if (ret < 0) {
		dev_err(dev, "Failed to read power status: %d\n", ret);
	} else if (ret & (WM8994_AIF2ADCL_ENA | WM8994_AIF2ADCR_ENA |
			  WM8994_AIF1ADC2L_ENA | WM8994_AIF1ADC2R_ENA |
			  WM8994_AIF1ADC1L_ENA | WM8994_AIF1ADC1R_ENA)) {
		dev_dbg(dev, "CODEC still active, ignoring suspend\n");
		return 0;
	}

	ret = wm8994_reg_read(wm8994, WM8994_POWER_MANAGEMENT_5);
	if (ret < 0) {
		dev_err(dev, "Failed to read power status: %d\n", ret);
	} else if (ret & (WM8994_AIF2DACL_ENA | WM8994_AIF2DACR_ENA |
			  WM8994_AIF1DAC2L_ENA | WM8994_AIF1DAC2R_ENA |
			  WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA)) {
		dev_dbg(dev, "CODEC still active, ignoring suspend\n");
		return 0;
	}

	switch (wm8994->type) {
	case WM8958:
232
	case WM1811:
233 234 235 236 237 238 239 240 241 242 243 244
		ret = wm8994_reg_read(wm8994, WM8958_MIC_DETECT_1);
		if (ret < 0) {
			dev_err(dev, "Failed to read power status: %d\n", ret);
		} else if (ret & WM8958_MICD_ENA) {
			dev_dbg(dev, "CODEC still active, ignoring suspend\n");
			return 0;
		}
		break;
	default:
		break;
	}

245 246 247 248 249 250 251 252 253 254 255 256 257 258
	switch (wm8994->type) {
	case WM1811:
		ret = wm8994_reg_read(wm8994, WM8994_ANTIPOP_2);
		if (ret < 0) {
			dev_err(dev, "Failed to read jackdet: %d\n", ret);
		} else if (ret & WM1811_JACKDET_MODE_MASK) {
			dev_dbg(dev, "CODEC still active, ignoring suspend\n");
			return 0;
		}
		break;
	default:
		break;
	}

259 260 261 262 263 264 265 266 267 268 269 270 271 272
	switch (wm8994->type) {
	case WM1811:
		ret = wm8994_reg_read(wm8994, WM8994_ANTIPOP_2);
		if (ret < 0) {
			dev_err(dev, "Failed to read jackdet: %d\n", ret);
		} else if (ret & WM1811_JACKDET_MODE_MASK) {
			dev_dbg(dev, "CODEC still active, ignoring suspend\n");
			return 0;
		}
		break;
	default:
		break;
	}

273 274 275 276 277 278 279
	/* Disable LDO pulldowns while the device is suspended if we
	 * don't know that something will be driving them. */
	if (!wm8994->ldo_ena_always_driven)
		wm8994_set_bits(wm8994, WM8994_PULL_CONTROL_2,
				WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD,
				WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD);

280 281 282
	/* Explicitly put the device into reset in case regulators
	 * don't get disabled in order to ensure consistent restart.
	 */
283 284
	wm8994_reg_write(wm8994, WM8994_SOFTWARE_RESET,
			 wm8994_reg_read(wm8994, WM8994_SOFTWARE_RESET));
285

286 287
	regcache_mark_dirty(wm8994->regmap);

288 289 290
	/* Restore GPIO registers to prevent problems with mismatched
	 * pin configurations.
	 */
291 292
	ret = regcache_sync_region(wm8994->regmap, WM8994_GPIO_1,
				   WM8994_GPIO_11);
293 294 295
	if (ret != 0)
		dev_err(dev, "Failed to restore GPIO registers: %d\n", ret);

296
	regcache_cache_only(wm8994->regmap, true);
297 298
	wm8994->suspended = true;

M
Mark Brown 已提交
299
	ret = regulator_bulk_disable(wm8994->num_supplies,
M
Mark Brown 已提交
300 301 302 303 304 305 306 307 308
				     wm8994->supplies);
	if (ret != 0) {
		dev_err(dev, "Failed to disable supplies: %d\n", ret);
		return ret;
	}

	return 0;
}

309
static int wm8994_resume(struct device *dev)
M
Mark Brown 已提交
310 311
{
	struct wm8994 *wm8994 = dev_get_drvdata(dev);
312
	int ret;
M
Mark Brown 已提交
313

314 315 316 317
	/* We may have lied to the PM core about suspending */
	if (!wm8994->suspended)
		return 0;

M
Mark Brown 已提交
318
	ret = regulator_bulk_enable(wm8994->num_supplies,
M
Mark Brown 已提交
319 320 321 322 323 324
				    wm8994->supplies);
	if (ret != 0) {
		dev_err(dev, "Failed to enable supplies: %d\n", ret);
		return ret;
	}

325
	regcache_cache_only(wm8994->regmap, false);
326 327 328 329
	ret = regcache_sync(wm8994->regmap);
	if (ret != 0) {
		dev_err(dev, "Failed to restore register map: %d\n", ret);
		goto err_enable;
330
	}
331

332 333 334 335 336
	/* Disable LDO pulldowns while the device is active */
	wm8994_set_bits(wm8994, WM8994_PULL_CONTROL_2,
			WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD,
			0);

337 338
	wm8994->suspended = false;

M
Mark Brown 已提交
339
	return 0;
340 341 342 343 344

err_enable:
	regulator_bulk_disable(wm8994->num_supplies, wm8994->supplies);

	return ret;
M
Mark Brown 已提交
345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369
}
#endif

#ifdef CONFIG_REGULATOR
static int wm8994_ldo_in_use(struct wm8994_pdata *pdata, int ldo)
{
	struct wm8994_ldo_pdata *ldo_pdata;

	if (!pdata)
		return 0;

	ldo_pdata = &pdata->ldo[ldo];

	if (!ldo_pdata->init_data)
		return 0;

	return ldo_pdata->init_data->num_consumer_supplies != 0;
}
#else
static int wm8994_ldo_in_use(struct wm8994_pdata *pdata, int ldo)
{
	return 0;
}
#endif

370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385
static const __devinitdata struct reg_default wm8994_revc_patch[] = {
	{ 0x102, 0x3 },
	{ 0x56, 0x3 },
	{ 0x817, 0x0 },
	{ 0x102, 0x0 },
};

static const __devinitdata struct reg_default wm8958_reva_patch[] = {
	{ 0x102, 0x3 },
	{ 0xcb, 0x81 },
	{ 0x817, 0x0 },
	{ 0x102, 0x0 },
};

static const __devinitdata struct reg_default wm1811_reva_patch[] = {
	{ 0x102, 0x3 },
386
	{ 0x56, 0x7 },
387 388 389 390 391
	{ 0x5d, 0x7e },
	{ 0x5e, 0x0 },
	{ 0x102, 0x0 },
};

M
Mark Brown 已提交
392 393 394
/*
 * Instantiate the generic non-control parts of the device.
 */
395
static __devinit int wm8994_device_init(struct wm8994 *wm8994, int irq)
M
Mark Brown 已提交
396 397
{
	struct wm8994_pdata *pdata = wm8994->dev->platform_data;
398
	struct regmap_config *regmap_config;
399
	const struct reg_default *regmap_patch = NULL;
M
Mark Brown 已提交
400
	const char *devname;
401
	int ret, i, patch_regs;
M
Mark Brown 已提交
402
	int pulls = 0;
M
Mark Brown 已提交
403 404 405 406 407 408 409 410 411 412

	dev_set_drvdata(wm8994->dev, wm8994);

	/* Add the on-chip regulators first for bootstrapping */
	ret = mfd_add_devices(wm8994->dev, -1,
			      wm8994_regulator_devs,
			      ARRAY_SIZE(wm8994_regulator_devs),
			      NULL, 0);
	if (ret != 0) {
		dev_err(wm8994->dev, "Failed to add children: %d\n", ret);
413
		goto err;
M
Mark Brown 已提交
414 415
	}

M
Mark Brown 已提交
416
	switch (wm8994->type) {
M
Mark Brown 已提交
417 418 419
	case WM1811:
		wm8994->num_supplies = ARRAY_SIZE(wm1811_main_supplies);
		break;
M
Mark Brown 已提交
420 421 422 423 424 425 426 427
	case WM8994:
		wm8994->num_supplies = ARRAY_SIZE(wm8994_main_supplies);
		break;
	case WM8958:
		wm8994->num_supplies = ARRAY_SIZE(wm8958_main_supplies);
		break;
	default:
		BUG();
428
		goto err;
M
Mark Brown 已提交
429 430
	}

M
Mark Brown 已提交
431 432 433
	wm8994->supplies = devm_kzalloc(wm8994->dev,
					sizeof(struct regulator_bulk_data) *
					wm8994->num_supplies, GFP_KERNEL);
434 435
	if (!wm8994->supplies) {
		ret = -ENOMEM;
436
		goto err;
437
	}
M
Mark Brown 已提交
438

M
Mark Brown 已提交
439
	switch (wm8994->type) {
M
Mark Brown 已提交
440 441 442 443
	case WM1811:
		for (i = 0; i < ARRAY_SIZE(wm1811_main_supplies); i++)
			wm8994->supplies[i].supply = wm1811_main_supplies[i];
		break;
M
Mark Brown 已提交
444 445 446 447 448 449 450 451 452 453
	case WM8994:
		for (i = 0; i < ARRAY_SIZE(wm8994_main_supplies); i++)
			wm8994->supplies[i].supply = wm8994_main_supplies[i];
		break;
	case WM8958:
		for (i = 0; i < ARRAY_SIZE(wm8958_main_supplies); i++)
			wm8994->supplies[i].supply = wm8958_main_supplies[i];
		break;
	default:
		BUG();
454
		goto err;
M
Mark Brown 已提交
455 456 457
	}
		
	ret = regulator_bulk_get(wm8994->dev, wm8994->num_supplies,
M
Mark Brown 已提交
458 459 460
				 wm8994->supplies);
	if (ret != 0) {
		dev_err(wm8994->dev, "Failed to get supplies: %d\n", ret);
461
		goto err;
M
Mark Brown 已提交
462 463
	}

M
Mark Brown 已提交
464
	ret = regulator_bulk_enable(wm8994->num_supplies,
M
Mark Brown 已提交
465 466 467
				    wm8994->supplies);
	if (ret != 0) {
		dev_err(wm8994->dev, "Failed to enable supplies: %d\n", ret);
J
Joonyoung Shim 已提交
468
		goto err_get;
M
Mark Brown 已提交
469 470 471 472 473 474 475
	}

	ret = wm8994_reg_read(wm8994, WM8994_SOFTWARE_RESET);
	if (ret < 0) {
		dev_err(wm8994->dev, "Failed to read ID register\n");
		goto err_enable;
	}
M
Mark Brown 已提交
476
	switch (ret) {
M
Mark Brown 已提交
477 478 479 480 481 482 483
	case 0x1811:
		devname = "WM1811";
		if (wm8994->type != WM1811)
			dev_warn(wm8994->dev, "Device registered as type %d\n",
				 wm8994->type);
		wm8994->type = WM1811;
		break;
M
Mark Brown 已提交
484 485 486 487 488 489 490 491 492 493 494 495 496 497 498
	case 0x8994:
		devname = "WM8994";
		if (wm8994->type != WM8994)
			dev_warn(wm8994->dev, "Device registered as type %d\n",
				 wm8994->type);
		wm8994->type = WM8994;
		break;
	case 0x8958:
		devname = "WM8958";
		if (wm8994->type != WM8958)
			dev_warn(wm8994->dev, "Device registered as type %d\n",
				 wm8994->type);
		wm8994->type = WM8958;
		break;
	default:
M
Mark Brown 已提交
499 500 501 502 503 504 505 506 507 508 509 510
		dev_err(wm8994->dev, "Device is not a WM8994, ID is %x\n",
			ret);
		ret = -EINVAL;
		goto err_enable;
	}

	ret = wm8994_reg_read(wm8994, WM8994_CHIP_REVISION);
	if (ret < 0) {
		dev_err(wm8994->dev, "Failed to read revision register: %d\n",
			ret);
		goto err_enable;
	}
511 512
	wm8994->revision = ret & WM8994_CHIP_REV_MASK;
	wm8994->cust_id = (ret & WM8994_CUST_ID_MASK) >> WM8994_CUST_ID_SHIFT;
M
Mark Brown 已提交
513

514 515
	switch (wm8994->type) {
	case WM8994:
516
		switch (wm8994->revision) {
517 518
		case 0:
		case 1:
M
Mark Brown 已提交
519 520
			dev_warn(wm8994->dev,
				 "revision %c not fully supported\n",
521
				 'A' + wm8994->revision);
522
			break;
523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538
		case 2:
		case 3:
			regmap_patch = wm8994_revc_patch;
			patch_regs = ARRAY_SIZE(wm8994_revc_patch);
			break;
		default:
			break;
		}
		break;

	case WM8958:
		switch (wm8994->revision) {
		case 0:
			regmap_patch = wm8958_reva_patch;
			patch_regs = ARRAY_SIZE(wm8958_reva_patch);
			break;
539 540 541
		default:
			break;
		}
M
Mark Brown 已提交
542
		break;
543

544 545
	case WM1811:
		/* Revision C did not change the relevant layer */
546 547
		if (wm8994->revision > 1)
			wm8994->revision++;
548 549 550
		switch (wm8994->revision) {
		case 0:
		case 1:
551 552
		case 2:
		case 3:
553 554 555 556 557 558
			regmap_patch = wm1811_reva_patch;
			patch_regs = ARRAY_SIZE(wm1811_reva_patch);
			break;
		default:
			break;
		}
559
		break;
560

M
Mark Brown 已提交
561 562 563 564
	default:
		break;
	}

565 566
	dev_info(wm8994->dev, "%s revision %c CUST_ID %02x\n", devname,
		 'A' + wm8994->revision, wm8994->cust_id);
M
Mark Brown 已提交
567

568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588
	switch (wm8994->type) {
	case WM1811:
		regmap_config = &wm1811_regmap_config;
		break;
	case WM8994:
		regmap_config = &wm8994_regmap_config;
		break;
	case WM8958:
		regmap_config = &wm8958_regmap_config;
		break;
	default:
		dev_err(wm8994->dev, "Unknown device type %d\n", wm8994->type);
		return -EINVAL;
	}

	ret = regmap_reinit_cache(wm8994->regmap, regmap_config);
	if (ret != 0) {
		dev_err(wm8994->dev, "Failed to reinit register cache: %d\n",
			ret);
		return ret;
	}
M
Mark Brown 已提交
589

590 591 592 593 594 595
	if (regmap_patch) {
		ret = regmap_register_patch(wm8994->regmap, regmap_patch,
					    patch_regs);
		if (ret != 0) {
			dev_err(wm8994->dev, "Failed to register patch: %d\n",
				ret);
596
			goto err;
597 598 599
		}
	}

M
Mark Brown 已提交
600
	if (pdata) {
601
		wm8994->irq_base = pdata->irq_base;
M
Mark Brown 已提交
602 603 604 605 606 607 608 609 610 611
		wm8994->gpio_base = pdata->gpio_base;

		/* GPIO configuration is only applied if it's non-zero */
		for (i = 0; i < ARRAY_SIZE(pdata->gpio_defaults); i++) {
			if (pdata->gpio_defaults[i]) {
				wm8994_set_bits(wm8994, WM8994_GPIO_1 + i,
						0xffff,
						pdata->gpio_defaults[i]);
			}
		}
612 613

		wm8994->ldo_ena_always_driven = pdata->ldo_ena_always_driven;
M
Mark Brown 已提交
614 615 616

		if (pdata->spkmode_pu)
			pulls |= WM8994_SPKMODE_PU;
M
Mark Brown 已提交
617 618
	}

M
Mark Brown 已提交
619
	/* Disable unneeded pulls */
620
	wm8994_set_bits(wm8994, WM8994_PULL_CONTROL_2,
M
Mark Brown 已提交
621 622 623
			WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD |
			WM8994_SPKMODE_PU | WM8994_CSNADDR_PD,
			pulls);
624

M
Mark Brown 已提交
625 626 627 628 629 630 631 632 633 634 635 636 637 638 639
	/* In some system designs where the regulators are not in use,
	 * we can achieve a small reduction in leakage currents by
	 * floating LDO outputs.  This bit makes no difference if the
	 * LDOs are enabled, it only affects cases where the LDOs were
	 * in operation and are then disabled.
	 */
	for (i = 0; i < WM8994_NUM_LDO_REGS; i++) {
		if (wm8994_ldo_in_use(pdata, i))
			wm8994_set_bits(wm8994, WM8994_LDO_1 + i,
					WM8994_LDO1_DISCH, WM8994_LDO1_DISCH);
		else
			wm8994_set_bits(wm8994, WM8994_LDO_1 + i,
					WM8994_LDO1_DISCH, 0);
	}

640 641
	wm8994_irq_init(wm8994);

M
Mark Brown 已提交
642 643 644 645 646
	ret = mfd_add_devices(wm8994->dev, -1,
			      wm8994_devs, ARRAY_SIZE(wm8994_devs),
			      NULL, 0);
	if (ret != 0) {
		dev_err(wm8994->dev, "Failed to add children: %d\n", ret);
647
		goto err_irq;
M
Mark Brown 已提交
648 649
	}

650
	pm_runtime_enable(wm8994->dev);
651
	pm_runtime_idle(wm8994->dev);
652

M
Mark Brown 已提交
653 654
	return 0;

655 656
err_irq:
	wm8994_irq_exit(wm8994);
M
Mark Brown 已提交
657
err_enable:
M
Mark Brown 已提交
658
	regulator_bulk_disable(wm8994->num_supplies,
M
Mark Brown 已提交
659 660
			       wm8994->supplies);
err_get:
M
Mark Brown 已提交
661
	regulator_bulk_free(wm8994->num_supplies, wm8994->supplies);
662
err:
M
Mark Brown 已提交
663 664 665 666
	mfd_remove_devices(wm8994->dev);
	return ret;
}

667
static __devexit void wm8994_device_exit(struct wm8994 *wm8994)
M
Mark Brown 已提交
668
{
669
	pm_runtime_disable(wm8994->dev);
M
Mark Brown 已提交
670
	mfd_remove_devices(wm8994->dev);
671
	wm8994_irq_exit(wm8994);
M
Mark Brown 已提交
672
	regulator_bulk_disable(wm8994->num_supplies,
M
Mark Brown 已提交
673
			       wm8994->supplies);
M
Mark Brown 已提交
674
	regulator_bulk_free(wm8994->num_supplies, wm8994->supplies);
M
Mark Brown 已提交
675 676
}

677 678 679 680 681 682 683 684
static const struct of_device_id wm8994_of_match[] = {
	{ .compatible = "wlf,wm1811", },
	{ .compatible = "wlf,wm8994", },
	{ .compatible = "wlf,wm8958", },
	{ }
};
MODULE_DEVICE_TABLE(of, wm8994_of_match);

685 686
static __devinit int wm8994_i2c_probe(struct i2c_client *i2c,
				      const struct i2c_device_id *id)
M
Mark Brown 已提交
687 688
{
	struct wm8994 *wm8994;
689
	int ret;
M
Mark Brown 已提交
690

M
Mark Brown 已提交
691
	wm8994 = devm_kzalloc(&i2c->dev, sizeof(struct wm8994), GFP_KERNEL);
692
	if (wm8994 == NULL)
M
Mark Brown 已提交
693 694 695 696
		return -ENOMEM;

	i2c_set_clientdata(i2c, wm8994);
	wm8994->dev = &i2c->dev;
697
	wm8994->irq = i2c->irq;
M
Mark Brown 已提交
698
	wm8994->type = id->driver_data;
M
Mark Brown 已提交
699

700
	wm8994->regmap = devm_regmap_init_i2c(i2c, &wm8994_base_regmap_config);
701 702 703 704 705 706 707
	if (IS_ERR(wm8994->regmap)) {
		ret = PTR_ERR(wm8994->regmap);
		dev_err(wm8994->dev, "Failed to allocate register map: %d\n",
			ret);
		return ret;
	}

M
Mark Brown 已提交
708
	return wm8994_device_init(wm8994, i2c->irq);
M
Mark Brown 已提交
709 710
}

711
static __devexit int wm8994_i2c_remove(struct i2c_client *i2c)
M
Mark Brown 已提交
712 713 714 715 716 717 718 719 720
{
	struct wm8994 *wm8994 = i2c_get_clientdata(i2c);

	wm8994_device_exit(wm8994);

	return 0;
}

static const struct i2c_device_id wm8994_i2c_id[] = {
M
Mark Brown 已提交
721
	{ "wm1811", WM1811 },
722
	{ "wm1811a", WM1811 },
M
Mark Brown 已提交
723 724
	{ "wm8994", WM8994 },
	{ "wm8958", WM8958 },
M
Mark Brown 已提交
725 726 727 728
	{ }
};
MODULE_DEVICE_TABLE(i2c, wm8994_i2c_id);

M
Mark Brown 已提交
729 730
static UNIVERSAL_DEV_PM_OPS(wm8994_pm_ops, wm8994_suspend, wm8994_resume,
			    NULL);
731

M
Mark Brown 已提交
732 733
static struct i2c_driver wm8994_i2c_driver = {
	.driver = {
734 735 736
		.name = "wm8994",
		.owner = THIS_MODULE,
		.pm = &wm8994_pm_ops,
737
		.of_match_table = wm8994_of_match,
M
Mark Brown 已提交
738 739
	},
	.probe = wm8994_i2c_probe,
740
	.remove = __devexit_p(wm8994_i2c_remove),
M
Mark Brown 已提交
741 742 743
	.id_table = wm8994_i2c_id,
};

744
module_i2c_driver(wm8994_i2c_driver);
M
Mark Brown 已提交
745 746 747 748

MODULE_DESCRIPTION("Core support for the WM8994 audio CODEC");
MODULE_LICENSE("GPL");
MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");