mfd: Read CUST_ID from the wm8994 device
[linux-2.6-block.git] / drivers / mfd / wm8994-core.c
CommitLineData
9e501086
MB
1/*
2 * wm8994-core.c -- Device access for Wolfson WM8994
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 it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
12 *
13 */
14
15#include <linux/kernel.h>
16#include <linux/module.h>
5a0e3ad6 17#include <linux/slab.h>
9e501086 18#include <linux/i2c.h>
d6c645fc 19#include <linux/err.h>
9e501086
MB
20#include <linux/delay.h>
21#include <linux/mfd/core.h>
d450f19e 22#include <linux/pm_runtime.h>
d6c645fc 23#include <linux/regmap.h>
9e501086
MB
24#include <linux/regulator/consumer.h>
25#include <linux/regulator/machine.h>
26
27#include <linux/mfd/wm8994/core.h>
28#include <linux/mfd/wm8994/pdata.h>
29#include <linux/mfd/wm8994/registers.h>
30
c3f13861 31#include "wm8994.h"
9e501086
MB
32
33/**
34 * wm8994_reg_read: Read a single WM8994 register.
35 *
36 * @wm8994: Device to read from.
37 * @reg: Register to read.
38 */
39int wm8994_reg_read(struct wm8994 *wm8994, unsigned short reg)
40{
d6c645fc 41 unsigned int val;
9e501086
MB
42 int ret;
43
d6c645fc 44 ret = regmap_read(wm8994->regmap, reg, &val);
9e501086
MB
45
46 if (ret < 0)
47 return ret;
48 else
d6c645fc 49 return val;
9e501086
MB
50}
51EXPORT_SYMBOL_GPL(wm8994_reg_read);
52
53/**
54 * wm8994_bulk_read: Read multiple WM8994 registers
55 *
56 * @wm8994: Device to read from
57 * @reg: First register
58 * @count: Number of registers
316b6cc0 59 * @buf: Buffer to fill. The data will be returned big endian.
9e501086
MB
60 */
61int wm8994_bulk_read(struct wm8994 *wm8994, unsigned short reg,
62 int count, u16 *buf)
63{
d6c645fc 64 return regmap_bulk_read(wm8994->regmap, reg, buf, count);
9e501086 65}
9e501086 66
9e501086
MB
67/**
68 * wm8994_reg_write: Write a single WM8994 register.
69 *
70 * @wm8994: Device to write to.
71 * @reg: Register to write to.
72 * @val: Value to write.
73 */
74int wm8994_reg_write(struct wm8994 *wm8994, unsigned short reg,
75 unsigned short val)
76{
d6c645fc 77 return regmap_write(wm8994->regmap, reg, val);
9e501086
MB
78}
79EXPORT_SYMBOL_GPL(wm8994_reg_write);
80
e93c5387
MB
81/**
82 * wm8994_bulk_write: Write multiple WM8994 registers
83 *
84 * @wm8994: Device to write to
85 * @reg: First register
86 * @count: Number of registers
4277163c 87 * @buf: Buffer to write from. Data must be big-endian formatted.
e93c5387
MB
88 */
89int wm8994_bulk_write(struct wm8994 *wm8994, unsigned short reg,
07e73fbb 90 int count, const u16 *buf)
e93c5387 91{
d6c645fc 92 return regmap_raw_write(wm8994->regmap, reg, buf, count * sizeof(u16));
e93c5387
MB
93}
94EXPORT_SYMBOL_GPL(wm8994_bulk_write);
95
9e501086
MB
96/**
97 * wm8994_set_bits: Set the value of a bitfield in a WM8994 register
98 *
99 * @wm8994: Device to write to.
100 * @reg: Register to write to.
101 * @mask: Mask of bits to set.
102 * @val: Value to set (unshifted)
103 */
104int wm8994_set_bits(struct wm8994 *wm8994, unsigned short reg,
105 unsigned short mask, unsigned short val)
106{
d6c645fc 107 return regmap_update_bits(wm8994->regmap, reg, mask, val);
9e501086
MB
108}
109EXPORT_SYMBOL_GPL(wm8994_set_bits);
110
111static struct mfd_cell wm8994_regulator_devs[] = {
d450f19e
MB
112 {
113 .name = "wm8994-ldo",
114 .id = 1,
115 .pm_runtime_no_callbacks = true,
116 },
117 {
118 .name = "wm8994-ldo",
119 .id = 2,
120 .pm_runtime_no_callbacks = true,
121 },
9e501086
MB
122};
123
c9fbf7e0
MB
124static struct resource wm8994_codec_resources[] = {
125 {
126 .start = WM8994_IRQ_TEMP_SHUT,
127 .end = WM8994_IRQ_TEMP_WARN,
128 .flags = IORESOURCE_IRQ,
129 },
130};
131
132static struct resource wm8994_gpio_resources[] = {
133 {
134 .start = WM8994_IRQ_GPIO(1),
135 .end = WM8994_IRQ_GPIO(11),
136 .flags = IORESOURCE_IRQ,
137 },
138};
139
9e501086 140static struct mfd_cell wm8994_devs[] = {
c9fbf7e0
MB
141 {
142 .name = "wm8994-codec",
143 .num_resources = ARRAY_SIZE(wm8994_codec_resources),
144 .resources = wm8994_codec_resources,
145 },
146
147 {
148 .name = "wm8994-gpio",
149 .num_resources = ARRAY_SIZE(wm8994_gpio_resources),
150 .resources = wm8994_gpio_resources,
d450f19e 151 .pm_runtime_no_callbacks = true,
c9fbf7e0 152 },
9e501086
MB
153};
154
155/*
156 * Supplies for the main bulk of CODEC; the LDO supplies are ignored
157 * and should be handled via the standard regulator API supply
158 * management.
159 */
b1f43bf3
MB
160static const char *wm1811_main_supplies[] = {
161 "DBVDD1",
162 "DBVDD2",
163 "DBVDD3",
164 "DCVDD",
165 "AVDD1",
166 "AVDD2",
167 "CPVDD",
168 "SPKVDD1",
169 "SPKVDD2",
170};
171
9e501086
MB
172static const char *wm8994_main_supplies[] = {
173 "DBVDD",
174 "DCVDD",
175 "AVDD1",
176 "AVDD2",
177 "CPVDD",
178 "SPKVDD1",
179 "SPKVDD2",
180};
181
559e0df6
MB
182static const char *wm8958_main_supplies[] = {
183 "DBVDD1",
184 "DBVDD2",
185 "DBVDD3",
186 "DCVDD",
187 "AVDD1",
188 "AVDD2",
189 "CPVDD",
190 "SPKVDD1",
191 "SPKVDD2",
192};
193
9e501086 194#ifdef CONFIG_PM
d450f19e 195static int wm8994_suspend(struct device *dev)
9e501086
MB
196{
197 struct wm8994 *wm8994 = dev_get_drvdata(dev);
198 int ret;
199
77bd70e9
MB
200 /* Don't actually go through with the suspend if the CODEC is
201 * still active (eg, for audio passthrough from CP. */
202 ret = wm8994_reg_read(wm8994, WM8994_POWER_MANAGEMENT_1);
203 if (ret < 0) {
204 dev_err(dev, "Failed to read power status: %d\n", ret);
205 } else if (ret & WM8994_VMID_SEL_MASK) {
206 dev_dbg(dev, "CODEC still active, ignoring suspend\n");
207 return 0;
208 }
209
5f40c6b6
MB
210 ret = wm8994_reg_read(wm8994, WM8994_POWER_MANAGEMENT_4);
211 if (ret < 0) {
212 dev_err(dev, "Failed to read power status: %d\n", ret);
213 } else if (ret & (WM8994_AIF2ADCL_ENA | WM8994_AIF2ADCR_ENA |
214 WM8994_AIF1ADC2L_ENA | WM8994_AIF1ADC2R_ENA |
215 WM8994_AIF1ADC1L_ENA | WM8994_AIF1ADC1R_ENA)) {
216 dev_dbg(dev, "CODEC still active, ignoring suspend\n");
217 return 0;
218 }
219
220 ret = wm8994_reg_read(wm8994, WM8994_POWER_MANAGEMENT_5);
221 if (ret < 0) {
222 dev_err(dev, "Failed to read power status: %d\n", ret);
223 } else if (ret & (WM8994_AIF2DACL_ENA | WM8994_AIF2DACR_ENA |
224 WM8994_AIF1DAC2L_ENA | WM8994_AIF1DAC2R_ENA |
225 WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA)) {
226 dev_dbg(dev, "CODEC still active, ignoring suspend\n");
227 return 0;
228 }
229
230 switch (wm8994->type) {
231 case WM8958:
b5488b6e 232 case WM1811:
5f40c6b6
MB
233 ret = wm8994_reg_read(wm8994, WM8958_MIC_DETECT_1);
234 if (ret < 0) {
235 dev_err(dev, "Failed to read power status: %d\n", ret);
236 } else if (ret & WM8958_MICD_ENA) {
237 dev_dbg(dev, "CODEC still active, ignoring suspend\n");
238 return 0;
239 }
240 break;
241 default:
242 break;
243 }
244
e7c248a0
MB
245 switch (wm8994->type) {
246 case WM1811:
247 ret = wm8994_reg_read(wm8994, WM8994_ANTIPOP_2);
248 if (ret < 0) {
249 dev_err(dev, "Failed to read jackdet: %d\n", ret);
250 } else if (ret & WM1811_JACKDET_MODE_MASK) {
251 dev_dbg(dev, "CODEC still active, ignoring suspend\n");
252 return 0;
253 }
254 break;
255 default:
256 break;
257 }
258
a3462490
MB
259 switch (wm8994->type) {
260 case WM1811:
261 ret = wm8994_reg_read(wm8994, WM8994_ANTIPOP_2);
262 if (ret < 0) {
263 dev_err(dev, "Failed to read jackdet: %d\n", ret);
264 } else if (ret & WM1811_JACKDET_MODE_MASK) {
265 dev_dbg(dev, "CODEC still active, ignoring suspend\n");
266 return 0;
267 }
268 break;
269 default:
270 break;
271 }
272
881de670
MB
273 /* Disable LDO pulldowns while the device is suspended if we
274 * don't know that something will be driving them. */
275 if (!wm8994->ldo_ena_always_driven)
276 wm8994_set_bits(wm8994, WM8994_PULL_CONTROL_2,
277 WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD,
278 WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD);
279
f40dff9e
MB
280 /* Explicitly put the device into reset in case regulators
281 * don't get disabled in order to ensure consistent restart.
282 */
be79cf2f
MB
283 wm8994_reg_write(wm8994, WM8994_SOFTWARE_RESET,
284 wm8994_reg_read(wm8994, WM8994_SOFTWARE_RESET));
f40dff9e 285
3befc925 286 regcache_cache_only(wm8994->regmap, true);
c3f13861 287 regcache_mark_dirty(wm8994->regmap);
f40dff9e 288
77bd70e9
MB
289 wm8994->suspended = true;
290
559e0df6 291 ret = regulator_bulk_disable(wm8994->num_supplies,
9e501086
MB
292 wm8994->supplies);
293 if (ret != 0) {
294 dev_err(dev, "Failed to disable supplies: %d\n", ret);
295 return ret;
296 }
297
298 return 0;
299}
300
d450f19e 301static int wm8994_resume(struct device *dev)
9e501086
MB
302{
303 struct wm8994 *wm8994 = dev_get_drvdata(dev);
c3f13861 304 int ret;
9e501086 305
77bd70e9
MB
306 /* We may have lied to the PM core about suspending */
307 if (!wm8994->suspended)
308 return 0;
309
559e0df6 310 ret = regulator_bulk_enable(wm8994->num_supplies,
9e501086
MB
311 wm8994->supplies);
312 if (ret != 0) {
313 dev_err(dev, "Failed to enable supplies: %d\n", ret);
314 return ret;
315 }
316
3befc925 317 regcache_cache_only(wm8994->regmap, false);
c3f13861
MB
318 ret = regcache_sync(wm8994->regmap);
319 if (ret != 0) {
320 dev_err(dev, "Failed to restore register map: %d\n", ret);
321 goto err_enable;
98ae1cca 322 }
c9fbf7e0 323
881de670
MB
324 /* Disable LDO pulldowns while the device is active */
325 wm8994_set_bits(wm8994, WM8994_PULL_CONTROL_2,
326 WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD,
327 0);
328
77bd70e9
MB
329 wm8994->suspended = false;
330
9e501086 331 return 0;
c3f13861
MB
332
333err_enable:
334 regulator_bulk_disable(wm8994->num_supplies, wm8994->supplies);
335
336 return ret;
9e501086
MB
337}
338#endif
339
340#ifdef CONFIG_REGULATOR
341static int wm8994_ldo_in_use(struct wm8994_pdata *pdata, int ldo)
342{
343 struct wm8994_ldo_pdata *ldo_pdata;
344
345 if (!pdata)
346 return 0;
347
348 ldo_pdata = &pdata->ldo[ldo];
349
350 if (!ldo_pdata->init_data)
351 return 0;
352
353 return ldo_pdata->init_data->num_consumer_supplies != 0;
354}
355#else
356static int wm8994_ldo_in_use(struct wm8994_pdata *pdata, int ldo)
357{
358 return 0;
359}
360#endif
361
462835e4
MB
362static const __devinitdata struct reg_default wm8994_revc_patch[] = {
363 { 0x102, 0x3 },
364 { 0x56, 0x3 },
365 { 0x817, 0x0 },
366 { 0x102, 0x0 },
367};
368
369static const __devinitdata struct reg_default wm8958_reva_patch[] = {
370 { 0x102, 0x3 },
371 { 0xcb, 0x81 },
372 { 0x817, 0x0 },
373 { 0x102, 0x0 },
374};
375
376static const __devinitdata struct reg_default wm1811_reva_patch[] = {
377 { 0x102, 0x3 },
a0cc0209 378 { 0x56, 0x7 },
462835e4
MB
379 { 0x5d, 0x7e },
380 { 0x5e, 0x0 },
381 { 0x102, 0x0 },
382};
383
9e501086
MB
384/*
385 * Instantiate the generic non-control parts of the device.
386 */
abc0ccea 387static __devinit int wm8994_device_init(struct wm8994 *wm8994, int irq)
9e501086
MB
388{
389 struct wm8994_pdata *pdata = wm8994->dev->platform_data;
34697898 390 struct regmap_config *regmap_config;
462835e4 391 const struct reg_default *regmap_patch = NULL;
559e0df6 392 const char *devname;
462835e4 393 int ret, i, patch_regs;
26c34c25 394 int pulls = 0;
9e501086 395
9e501086
MB
396 dev_set_drvdata(wm8994->dev, wm8994);
397
398 /* Add the on-chip regulators first for bootstrapping */
399 ret = mfd_add_devices(wm8994->dev, -1,
400 wm8994_regulator_devs,
401 ARRAY_SIZE(wm8994_regulator_devs),
402 NULL, 0);
403 if (ret != 0) {
404 dev_err(wm8994->dev, "Failed to add children: %d\n", ret);
9db4249f 405 goto err;
9e501086
MB
406 }
407
559e0df6 408 switch (wm8994->type) {
b1f43bf3
MB
409 case WM1811:
410 wm8994->num_supplies = ARRAY_SIZE(wm1811_main_supplies);
411 break;
559e0df6
MB
412 case WM8994:
413 wm8994->num_supplies = ARRAY_SIZE(wm8994_main_supplies);
414 break;
415 case WM8958:
416 wm8994->num_supplies = ARRAY_SIZE(wm8958_main_supplies);
417 break;
418 default:
419 BUG();
9db4249f 420 goto err;
559e0df6
MB
421 }
422
2fa33494
MB
423 wm8994->supplies = devm_kzalloc(wm8994->dev,
424 sizeof(struct regulator_bulk_data) *
425 wm8994->num_supplies, GFP_KERNEL);
fccbd21f
AL
426 if (!wm8994->supplies) {
427 ret = -ENOMEM;
9db4249f 428 goto err;
fccbd21f 429 }
9e501086 430
559e0df6 431 switch (wm8994->type) {
b1f43bf3
MB
432 case WM1811:
433 for (i = 0; i < ARRAY_SIZE(wm1811_main_supplies); i++)
434 wm8994->supplies[i].supply = wm1811_main_supplies[i];
435 break;
559e0df6
MB
436 case WM8994:
437 for (i = 0; i < ARRAY_SIZE(wm8994_main_supplies); i++)
438 wm8994->supplies[i].supply = wm8994_main_supplies[i];
439 break;
440 case WM8958:
441 for (i = 0; i < ARRAY_SIZE(wm8958_main_supplies); i++)
442 wm8994->supplies[i].supply = wm8958_main_supplies[i];
443 break;
444 default:
445 BUG();
9db4249f 446 goto err;
559e0df6
MB
447 }
448
449 ret = regulator_bulk_get(wm8994->dev, wm8994->num_supplies,
9e501086
MB
450 wm8994->supplies);
451 if (ret != 0) {
452 dev_err(wm8994->dev, "Failed to get supplies: %d\n", ret);
9db4249f 453 goto err;
9e501086
MB
454 }
455
559e0df6 456 ret = regulator_bulk_enable(wm8994->num_supplies,
9e501086
MB
457 wm8994->supplies);
458 if (ret != 0) {
459 dev_err(wm8994->dev, "Failed to enable supplies: %d\n", ret);
7731074a 460 goto err_get;
9e501086
MB
461 }
462
463 ret = wm8994_reg_read(wm8994, WM8994_SOFTWARE_RESET);
464 if (ret < 0) {
465 dev_err(wm8994->dev, "Failed to read ID register\n");
466 goto err_enable;
467 }
559e0df6 468 switch (ret) {
b1f43bf3
MB
469 case 0x1811:
470 devname = "WM1811";
471 if (wm8994->type != WM1811)
472 dev_warn(wm8994->dev, "Device registered as type %d\n",
473 wm8994->type);
474 wm8994->type = WM1811;
475 break;
559e0df6
MB
476 case 0x8994:
477 devname = "WM8994";
478 if (wm8994->type != WM8994)
479 dev_warn(wm8994->dev, "Device registered as type %d\n",
480 wm8994->type);
481 wm8994->type = WM8994;
482 break;
483 case 0x8958:
484 devname = "WM8958";
485 if (wm8994->type != WM8958)
486 dev_warn(wm8994->dev, "Device registered as type %d\n",
487 wm8994->type);
488 wm8994->type = WM8958;
489 break;
490 default:
9e501086
MB
491 dev_err(wm8994->dev, "Device is not a WM8994, ID is %x\n",
492 ret);
493 ret = -EINVAL;
494 goto err_enable;
495 }
496
497 ret = wm8994_reg_read(wm8994, WM8994_CHIP_REVISION);
498 if (ret < 0) {
499 dev_err(wm8994->dev, "Failed to read revision register: %d\n",
500 ret);
501 goto err_enable;
502 }
cc7a7279
MB
503 wm8994->revision = ret & WM8994_CHIP_REV_MASK;
504 wm8994->cust_id = (ret & WM8994_CUST_ID_MASK) >> WM8994_CUST_ID_SHIFT;
9e501086 505
a2495bc7
MB
506 switch (wm8994->type) {
507 case WM8994:
7ed5849c 508 switch (wm8994->revision) {
a2495bc7
MB
509 case 0:
510 case 1:
559e0df6
MB
511 dev_warn(wm8994->dev,
512 "revision %c not fully supported\n",
7ed5849c 513 'A' + wm8994->revision);
a2495bc7 514 break;
462835e4
MB
515 case 2:
516 case 3:
517 regmap_patch = wm8994_revc_patch;
518 patch_regs = ARRAY_SIZE(wm8994_revc_patch);
519 break;
520 default:
521 break;
522 }
523 break;
524
525 case WM8958:
526 switch (wm8994->revision) {
527 case 0:
528 regmap_patch = wm8958_reva_patch;
529 patch_regs = ARRAY_SIZE(wm8958_reva_patch);
530 break;
a2495bc7
MB
531 default:
532 break;
533 }
9e501086 534 break;
462835e4 535
443e67ed
MB
536 case WM1811:
537 /* Revision C did not change the relevant layer */
7ed5849c
MB
538 if (wm8994->revision > 1)
539 wm8994->revision++;
462835e4
MB
540 switch (wm8994->revision) {
541 case 0:
542 case 1:
a0cc0209
MB
543 case 2:
544 case 3:
462835e4
MB
545 regmap_patch = wm1811_reva_patch;
546 patch_regs = ARRAY_SIZE(wm1811_reva_patch);
547 break;
548 default:
549 break;
550 }
443e67ed 551 break;
462835e4 552
9e501086 553 default:
9e501086
MB
554 break;
555 }
556
cc7a7279
MB
557 dev_info(wm8994->dev, "%s revision %c CUST_ID %02x\n", devname,
558 'A' + wm8994->revision, wm8994->cust_id);
9e501086 559
34697898
MB
560 switch (wm8994->type) {
561 case WM1811:
562 regmap_config = &wm1811_regmap_config;
563 break;
564 case WM8994:
565 regmap_config = &wm8994_regmap_config;
566 break;
567 case WM8958:
568 regmap_config = &wm8958_regmap_config;
569 break;
570 default:
571 dev_err(wm8994->dev, "Unknown device type %d\n", wm8994->type);
572 return -EINVAL;
573 }
574
575 ret = regmap_reinit_cache(wm8994->regmap, regmap_config);
576 if (ret != 0) {
577 dev_err(wm8994->dev, "Failed to reinit register cache: %d\n",
578 ret);
579 return ret;
580 }
9e501086 581
462835e4
MB
582 if (regmap_patch) {
583 ret = regmap_register_patch(wm8994->regmap, regmap_patch,
584 patch_regs);
585 if (ret != 0) {
586 dev_err(wm8994->dev, "Failed to register patch: %d\n",
587 ret);
9db4249f 588 goto err;
462835e4
MB
589 }
590 }
591
9e501086 592 if (pdata) {
c9fbf7e0 593 wm8994->irq_base = pdata->irq_base;
9e501086
MB
594 wm8994->gpio_base = pdata->gpio_base;
595
596 /* GPIO configuration is only applied if it's non-zero */
597 for (i = 0; i < ARRAY_SIZE(pdata->gpio_defaults); i++) {
598 if (pdata->gpio_defaults[i]) {
599 wm8994_set_bits(wm8994, WM8994_GPIO_1 + i,
600 0xffff,
601 pdata->gpio_defaults[i]);
602 }
603 }
881de670
MB
604
605 wm8994->ldo_ena_always_driven = pdata->ldo_ena_always_driven;
26c34c25
MB
606
607 if (pdata->spkmode_pu)
608 pulls |= WM8994_SPKMODE_PU;
9e501086
MB
609 }
610
26c34c25 611 /* Disable unneeded pulls */
881de670 612 wm8994_set_bits(wm8994, WM8994_PULL_CONTROL_2,
26c34c25
MB
613 WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD |
614 WM8994_SPKMODE_PU | WM8994_CSNADDR_PD,
615 pulls);
881de670 616
9e501086
MB
617 /* In some system designs where the regulators are not in use,
618 * we can achieve a small reduction in leakage currents by
619 * floating LDO outputs. This bit makes no difference if the
620 * LDOs are enabled, it only affects cases where the LDOs were
621 * in operation and are then disabled.
622 */
623 for (i = 0; i < WM8994_NUM_LDO_REGS; i++) {
624 if (wm8994_ldo_in_use(pdata, i))
625 wm8994_set_bits(wm8994, WM8994_LDO_1 + i,
626 WM8994_LDO1_DISCH, WM8994_LDO1_DISCH);
627 else
628 wm8994_set_bits(wm8994, WM8994_LDO_1 + i,
629 WM8994_LDO1_DISCH, 0);
630 }
631
c9fbf7e0
MB
632 wm8994_irq_init(wm8994);
633
9e501086
MB
634 ret = mfd_add_devices(wm8994->dev, -1,
635 wm8994_devs, ARRAY_SIZE(wm8994_devs),
636 NULL, 0);
637 if (ret != 0) {
638 dev_err(wm8994->dev, "Failed to add children: %d\n", ret);
c9fbf7e0 639 goto err_irq;
9e501086
MB
640 }
641
d450f19e 642 pm_runtime_enable(wm8994->dev);
ee67b0cd 643 pm_runtime_idle(wm8994->dev);
d450f19e 644
9e501086
MB
645 return 0;
646
c9fbf7e0
MB
647err_irq:
648 wm8994_irq_exit(wm8994);
9e501086 649err_enable:
559e0df6 650 regulator_bulk_disable(wm8994->num_supplies,
9e501086
MB
651 wm8994->supplies);
652err_get:
559e0df6 653 regulator_bulk_free(wm8994->num_supplies, wm8994->supplies);
9db4249f 654err:
9e501086 655 mfd_remove_devices(wm8994->dev);
9e501086
MB
656 return ret;
657}
658
abc0ccea 659static __devexit void wm8994_device_exit(struct wm8994 *wm8994)
9e501086 660{
d450f19e 661 pm_runtime_disable(wm8994->dev);
9e501086 662 mfd_remove_devices(wm8994->dev);
c9fbf7e0 663 wm8994_irq_exit(wm8994);
559e0df6 664 regulator_bulk_disable(wm8994->num_supplies,
9e501086 665 wm8994->supplies);
559e0df6 666 regulator_bulk_free(wm8994->num_supplies, wm8994->supplies);
9e501086
MB
667}
668
cf763c2e
MB
669static const struct of_device_id wm8994_of_match[] = {
670 { .compatible = "wlf,wm1811", },
671 { .compatible = "wlf,wm8994", },
672 { .compatible = "wlf,wm8958", },
673 { }
674};
675MODULE_DEVICE_TABLE(of, wm8994_of_match);
676
027d6766
MB
677static __devinit int wm8994_i2c_probe(struct i2c_client *i2c,
678 const struct i2c_device_id *id)
9e501086
MB
679{
680 struct wm8994 *wm8994;
d6c645fc 681 int ret;
9e501086 682
2fa33494 683 wm8994 = devm_kzalloc(&i2c->dev, sizeof(struct wm8994), GFP_KERNEL);
d0a11693 684 if (wm8994 == NULL)
9e501086 685 return -ENOMEM;
9e501086
MB
686
687 i2c_set_clientdata(i2c, wm8994);
688 wm8994->dev = &i2c->dev;
c9fbf7e0 689 wm8994->irq = i2c->irq;
559e0df6 690 wm8994->type = id->driver_data;
9e501086 691
9db4249f 692 wm8994->regmap = devm_regmap_init_i2c(i2c, &wm8994_base_regmap_config);
d6c645fc
MB
693 if (IS_ERR(wm8994->regmap)) {
694 ret = PTR_ERR(wm8994->regmap);
695 dev_err(wm8994->dev, "Failed to allocate register map: %d\n",
696 ret);
d6c645fc
MB
697 return ret;
698 }
699
559e0df6 700 return wm8994_device_init(wm8994, i2c->irq);
9e501086
MB
701}
702
027d6766 703static __devexit int wm8994_i2c_remove(struct i2c_client *i2c)
9e501086
MB
704{
705 struct wm8994 *wm8994 = i2c_get_clientdata(i2c);
706
707 wm8994_device_exit(wm8994);
708
709 return 0;
710}
711
9e501086 712static const struct i2c_device_id wm8994_i2c_id[] = {
b1f43bf3 713 { "wm1811", WM1811 },
71d17184 714 { "wm1811a", WM1811 },
559e0df6
MB
715 { "wm8994", WM8994 },
716 { "wm8958", WM8958 },
9e501086
MB
717 { }
718};
719MODULE_DEVICE_TABLE(i2c, wm8994_i2c_id);
720
aad34310
MB
721static UNIVERSAL_DEV_PM_OPS(wm8994_pm_ops, wm8994_suspend, wm8994_resume,
722 NULL);
d450f19e 723
9e501086
MB
724static struct i2c_driver wm8994_i2c_driver = {
725 .driver = {
d450f19e
MB
726 .name = "wm8994",
727 .owner = THIS_MODULE,
728 .pm = &wm8994_pm_ops,
cf763c2e 729 .of_match_table = wm8994_of_match,
9e501086
MB
730 },
731 .probe = wm8994_i2c_probe,
027d6766 732 .remove = __devexit_p(wm8994_i2c_remove),
9e501086
MB
733 .id_table = wm8994_i2c_id,
734};
735
736static int __init wm8994_i2c_init(void)
737{
738 int ret;
739
740 ret = i2c_add_driver(&wm8994_i2c_driver);
741 if (ret != 0)
742 pr_err("Failed to register wm8994 I2C driver: %d\n", ret);
743
744 return ret;
745}
746module_init(wm8994_i2c_init);
747
748static void __exit wm8994_i2c_exit(void)
749{
750 i2c_del_driver(&wm8994_i2c_driver);
751}
752module_exit(wm8994_i2c_exit);
753
754MODULE_DESCRIPTION("Core support for the WM8994 audio CODEC");
755MODULE_LICENSE("GPL");
756MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");