mfd: wm8994: Allow to configure Speaker Mode Pullup from dts
[linux-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>
20fb2772
MB
22#include <linux/of.h>
23#include <linux/of_device.h>
24#include <linux/of_gpio.h>
d450f19e 25#include <linux/pm_runtime.h>
d6c645fc 26#include <linux/regmap.h>
9e501086
MB
27#include <linux/regulator/consumer.h>
28#include <linux/regulator/machine.h>
29
30#include <linux/mfd/wm8994/core.h>
31#include <linux/mfd/wm8994/pdata.h>
32#include <linux/mfd/wm8994/registers.h>
33
c3f13861 34#include "wm8994.h"
9e501086 35
ad59de48 36static const struct mfd_cell wm8994_regulator_devs[] = {
d450f19e
MB
37 {
38 .name = "wm8994-ldo",
fef22cb4 39 .id = 0,
d450f19e
MB
40 .pm_runtime_no_callbacks = true,
41 },
42 {
43 .name = "wm8994-ldo",
fef22cb4 44 .id = 1,
d450f19e
MB
45 .pm_runtime_no_callbacks = true,
46 },
9e501086
MB
47};
48
c9fbf7e0
MB
49static struct resource wm8994_codec_resources[] = {
50 {
51 .start = WM8994_IRQ_TEMP_SHUT,
52 .end = WM8994_IRQ_TEMP_WARN,
53 .flags = IORESOURCE_IRQ,
54 },
55};
56
57static struct resource wm8994_gpio_resources[] = {
58 {
59 .start = WM8994_IRQ_GPIO(1),
60 .end = WM8994_IRQ_GPIO(11),
61 .flags = IORESOURCE_IRQ,
62 },
63};
64
ad59de48 65static const struct mfd_cell wm8994_devs[] = {
c9fbf7e0
MB
66 {
67 .name = "wm8994-codec",
68 .num_resources = ARRAY_SIZE(wm8994_codec_resources),
69 .resources = wm8994_codec_resources,
70 },
71
72 {
73 .name = "wm8994-gpio",
74 .num_resources = ARRAY_SIZE(wm8994_gpio_resources),
75 .resources = wm8994_gpio_resources,
d450f19e 76 .pm_runtime_no_callbacks = true,
c9fbf7e0 77 },
9e501086
MB
78};
79
80/*
81 * Supplies for the main bulk of CODEC; the LDO supplies are ignored
82 * and should be handled via the standard regulator API supply
83 * management.
84 */
b1f43bf3
MB
85static const char *wm1811_main_supplies[] = {
86 "DBVDD1",
87 "DBVDD2",
88 "DBVDD3",
89 "DCVDD",
90 "AVDD1",
91 "AVDD2",
92 "CPVDD",
93 "SPKVDD1",
94 "SPKVDD2",
95};
96
9e501086
MB
97static const char *wm8994_main_supplies[] = {
98 "DBVDD",
99 "DCVDD",
100 "AVDD1",
101 "AVDD2",
102 "CPVDD",
103 "SPKVDD1",
104 "SPKVDD2",
105};
106
559e0df6
MB
107static const char *wm8958_main_supplies[] = {
108 "DBVDD1",
109 "DBVDD2",
110 "DBVDD3",
111 "DCVDD",
112 "AVDD1",
113 "AVDD2",
114 "CPVDD",
115 "SPKVDD1",
116 "SPKVDD2",
117};
118
48bb9fe4 119#ifdef CONFIG_PM
d450f19e 120static int wm8994_suspend(struct device *dev)
9e501086
MB
121{
122 struct wm8994 *wm8994 = dev_get_drvdata(dev);
123 int ret;
124
77bd70e9 125 /* Don't actually go through with the suspend if the CODEC is
ebe38f80 126 * still active for accessory detect. */
5f40c6b6
MB
127 switch (wm8994->type) {
128 case WM8958:
b5488b6e 129 case WM1811:
5f40c6b6
MB
130 ret = wm8994_reg_read(wm8994, WM8958_MIC_DETECT_1);
131 if (ret < 0) {
132 dev_err(dev, "Failed to read power status: %d\n", ret);
133 } else if (ret & WM8958_MICD_ENA) {
134 dev_dbg(dev, "CODEC still active, ignoring suspend\n");
135 return 0;
136 }
137 break;
138 default:
139 break;
140 }
141
881de670
MB
142 /* Disable LDO pulldowns while the device is suspended if we
143 * don't know that something will be driving them. */
144 if (!wm8994->ldo_ena_always_driven)
145 wm8994_set_bits(wm8994, WM8994_PULL_CONTROL_2,
146 WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD,
147 WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD);
148
f40dff9e
MB
149 /* Explicitly put the device into reset in case regulators
150 * don't get disabled in order to ensure consistent restart.
151 */
be79cf2f
MB
152 wm8994_reg_write(wm8994, WM8994_SOFTWARE_RESET,
153 wm8994_reg_read(wm8994, WM8994_SOFTWARE_RESET));
f40dff9e 154
ed393dcd
MB
155 regcache_mark_dirty(wm8994->regmap);
156
78a27cd3
CR
157 /* Restore GPIO registers to prevent problems with mismatched
158 * pin configurations.
159 */
ed393dcd
MB
160 ret = regcache_sync_region(wm8994->regmap, WM8994_GPIO_1,
161 WM8994_GPIO_11);
78a27cd3
CR
162 if (ret != 0)
163 dev_err(dev, "Failed to restore GPIO registers: %d\n", ret);
164
1a2017b7
MB
165 /* In case one of the GPIOs is used as a wake input. */
166 ret = regcache_sync_region(wm8994->regmap,
167 WM8994_INTERRUPT_STATUS_1_MASK,
168 WM8994_INTERRUPT_STATUS_1_MASK);
169 if (ret != 0)
170 dev_err(dev, "Failed to restore interrupt mask: %d\n", ret);
171
3befc925 172 regcache_cache_only(wm8994->regmap, true);
77bd70e9
MB
173 wm8994->suspended = true;
174
559e0df6 175 ret = regulator_bulk_disable(wm8994->num_supplies,
9e501086
MB
176 wm8994->supplies);
177 if (ret != 0) {
178 dev_err(dev, "Failed to disable supplies: %d\n", ret);
179 return ret;
180 }
181
182 return 0;
183}
184
d450f19e 185static int wm8994_resume(struct device *dev)
9e501086
MB
186{
187 struct wm8994 *wm8994 = dev_get_drvdata(dev);
c3f13861 188 int ret;
9e501086 189
77bd70e9
MB
190 /* We may have lied to the PM core about suspending */
191 if (!wm8994->suspended)
192 return 0;
193
559e0df6 194 ret = regulator_bulk_enable(wm8994->num_supplies,
9e501086
MB
195 wm8994->supplies);
196 if (ret != 0) {
197 dev_err(dev, "Failed to enable supplies: %d\n", ret);
198 return ret;
199 }
200
3befc925 201 regcache_cache_only(wm8994->regmap, false);
c3f13861
MB
202 ret = regcache_sync(wm8994->regmap);
203 if (ret != 0) {
204 dev_err(dev, "Failed to restore register map: %d\n", ret);
205 goto err_enable;
98ae1cca 206 }
c9fbf7e0 207
881de670
MB
208 /* Disable LDO pulldowns while the device is active */
209 wm8994_set_bits(wm8994, WM8994_PULL_CONTROL_2,
210 WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD,
211 0);
212
77bd70e9
MB
213 wm8994->suspended = false;
214
9e501086 215 return 0;
c3f13861
MB
216
217err_enable:
218 regulator_bulk_disable(wm8994->num_supplies, wm8994->supplies);
219
220 return ret;
9e501086
MB
221}
222#endif
223
224#ifdef CONFIG_REGULATOR
225static int wm8994_ldo_in_use(struct wm8994_pdata *pdata, int ldo)
226{
227 struct wm8994_ldo_pdata *ldo_pdata;
228
229 if (!pdata)
230 return 0;
231
232 ldo_pdata = &pdata->ldo[ldo];
233
234 if (!ldo_pdata->init_data)
235 return 0;
236
237 return ldo_pdata->init_data->num_consumer_supplies != 0;
238}
239#else
240static int wm8994_ldo_in_use(struct wm8994_pdata *pdata, int ldo)
241{
242 return 0;
243}
244#endif
245
8019ff6c 246static const struct reg_sequence wm8994_revc_patch[] = {
462835e4
MB
247 { 0x102, 0x3 },
248 { 0x56, 0x3 },
249 { 0x817, 0x0 },
250 { 0x102, 0x0 },
251};
252
8019ff6c 253static const struct reg_sequence wm8958_reva_patch[] = {
462835e4
MB
254 { 0x102, 0x3 },
255 { 0xcb, 0x81 },
256 { 0x817, 0x0 },
257 { 0x102, 0x0 },
258};
259
8019ff6c 260static const struct reg_sequence wm1811_reva_patch[] = {
462835e4 261 { 0x102, 0x3 },
9282a7b9 262 { 0x56, 0xc07 },
462835e4
MB
263 { 0x5d, 0x7e },
264 { 0x5e, 0x0 },
265 { 0x102, 0x0 },
266};
267
20fb2772
MB
268#ifdef CONFIG_OF
269static int wm8994_set_pdata_from_of(struct wm8994 *wm8994)
270{
271 struct device_node *np = wm8994->dev->of_node;
272 struct wm8994_pdata *pdata = &wm8994->pdata;
273 int i;
274
275 if (!np)
276 return 0;
277
278 if (of_property_read_u32_array(np, "wlf,gpio-cfg", pdata->gpio_defaults,
279 ARRAY_SIZE(pdata->gpio_defaults)) >= 0) {
280 for (i = 0; i < ARRAY_SIZE(pdata->gpio_defaults); i++) {
281 if (wm8994->pdata.gpio_defaults[i] == 0)
282 pdata->gpio_defaults[i]
283 = WM8994_CONFIGURE_GPIO;
284 }
285 }
286
287 of_property_read_u32_array(np, "wlf,micbias-cfg", pdata->micbias,
288 ARRAY_SIZE(pdata->micbias));
289
290 pdata->lineout1_diff = true;
291 pdata->lineout2_diff = true;
292 if (of_find_property(np, "wlf,lineout1-se", NULL))
293 pdata->lineout1_diff = false;
294 if (of_find_property(np, "wlf,lineout2-se", NULL))
295 pdata->lineout2_diff = false;
296
297 if (of_find_property(np, "wlf,lineout1-feedback", NULL))
298 pdata->lineout1fb = true;
299 if (of_find_property(np, "wlf,lineout2-feedback", NULL))
300 pdata->lineout2fb = true;
301
302 if (of_find_property(np, "wlf,ldoena-always-driven", NULL))
303 pdata->lineout2fb = true;
304
102370fb
AP
305 pdata->spkmode_pu = of_property_read_bool(np, "wlf,spkmode-pu");
306
20fb2772
MB
307 pdata->ldo[0].enable = of_get_named_gpio(np, "wlf,ldo1ena", 0);
308 if (pdata->ldo[0].enable < 0)
309 pdata->ldo[0].enable = 0;
310
311 pdata->ldo[1].enable = of_get_named_gpio(np, "wlf,ldo2ena", 0);
312 if (pdata->ldo[1].enable < 0)
313 pdata->ldo[1].enable = 0;
314
315 return 0;
316}
317#else
318static int wm8994_set_pdata_from_of(struct wm8994 *wm8994)
319{
320 return 0;
321}
322#endif
323
9e501086
MB
324/*
325 * Instantiate the generic non-control parts of the device.
326 */
f791be49 327static int wm8994_device_init(struct wm8994 *wm8994, int irq)
9e501086 328{
a8a8fc28 329 struct wm8994_pdata *pdata;
34697898 330 struct regmap_config *regmap_config;
8019ff6c 331 const struct reg_sequence *regmap_patch = NULL;
559e0df6 332 const char *devname;
222bc784 333 int ret, i, patch_regs = 0;
26c34c25 334 int pulls = 0;
9e501086 335
a8a8fc28
MB
336 if (dev_get_platdata(wm8994->dev)) {
337 pdata = dev_get_platdata(wm8994->dev);
338 wm8994->pdata = *pdata;
339 }
340 pdata = &wm8994->pdata;
341
20fb2772
MB
342 ret = wm8994_set_pdata_from_of(wm8994);
343 if (ret != 0)
344 return ret;
345
9e501086
MB
346 dev_set_drvdata(wm8994->dev, wm8994);
347
348 /* Add the on-chip regulators first for bootstrapping */
fef22cb4 349 ret = mfd_add_devices(wm8994->dev, 0,
9e501086
MB
350 wm8994_regulator_devs,
351 ARRAY_SIZE(wm8994_regulator_devs),
55692af5 352 NULL, 0, NULL);
9e501086
MB
353 if (ret != 0) {
354 dev_err(wm8994->dev, "Failed to add children: %d\n", ret);
9db4249f 355 goto err;
9e501086
MB
356 }
357
559e0df6 358 switch (wm8994->type) {
b1f43bf3
MB
359 case WM1811:
360 wm8994->num_supplies = ARRAY_SIZE(wm1811_main_supplies);
361 break;
559e0df6
MB
362 case WM8994:
363 wm8994->num_supplies = ARRAY_SIZE(wm8994_main_supplies);
364 break;
365 case WM8958:
366 wm8994->num_supplies = ARRAY_SIZE(wm8958_main_supplies);
367 break;
368 default:
369 BUG();
9db4249f 370 goto err;
559e0df6
MB
371 }
372
a86854d0
KC
373 wm8994->supplies = devm_kcalloc(wm8994->dev,
374 wm8994->num_supplies,
375 sizeof(struct regulator_bulk_data),
376 GFP_KERNEL);
fccbd21f
AL
377 if (!wm8994->supplies) {
378 ret = -ENOMEM;
9db4249f 379 goto err;
fccbd21f 380 }
9e501086 381
559e0df6 382 switch (wm8994->type) {
b1f43bf3
MB
383 case WM1811:
384 for (i = 0; i < ARRAY_SIZE(wm1811_main_supplies); i++)
385 wm8994->supplies[i].supply = wm1811_main_supplies[i];
386 break;
559e0df6
MB
387 case WM8994:
388 for (i = 0; i < ARRAY_SIZE(wm8994_main_supplies); i++)
389 wm8994->supplies[i].supply = wm8994_main_supplies[i];
390 break;
391 case WM8958:
392 for (i = 0; i < ARRAY_SIZE(wm8958_main_supplies); i++)
393 wm8994->supplies[i].supply = wm8958_main_supplies[i];
394 break;
395 default:
396 BUG();
9db4249f 397 goto err;
559e0df6 398 }
202b5689
VK
399
400 /*
401 * Can't use devres helper here as some of the supplies are provided by
402 * wm8994->dev's children (regulators) and those regulators are
403 * unregistered by the devres core before the supplies are freed.
404 */
405 ret = regulator_bulk_get(wm8994->dev, wm8994->num_supplies,
9e501086
MB
406 wm8994->supplies);
407 if (ret != 0) {
408 dev_err(wm8994->dev, "Failed to get supplies: %d\n", ret);
9db4249f 409 goto err;
9e501086
MB
410 }
411
3e56c468 412 ret = regulator_bulk_enable(wm8994->num_supplies, wm8994->supplies);
9e501086
MB
413 if (ret != 0) {
414 dev_err(wm8994->dev, "Failed to enable supplies: %d\n", ret);
202b5689 415 goto err_regulator_free;
9e501086
MB
416 }
417
418 ret = wm8994_reg_read(wm8994, WM8994_SOFTWARE_RESET);
419 if (ret < 0) {
420 dev_err(wm8994->dev, "Failed to read ID register\n");
421 goto err_enable;
422 }
559e0df6 423 switch (ret) {
b1f43bf3
MB
424 case 0x1811:
425 devname = "WM1811";
426 if (wm8994->type != WM1811)
427 dev_warn(wm8994->dev, "Device registered as type %d\n",
428 wm8994->type);
429 wm8994->type = WM1811;
430 break;
559e0df6
MB
431 case 0x8994:
432 devname = "WM8994";
433 if (wm8994->type != WM8994)
434 dev_warn(wm8994->dev, "Device registered as type %d\n",
435 wm8994->type);
436 wm8994->type = WM8994;
437 break;
438 case 0x8958:
439 devname = "WM8958";
440 if (wm8994->type != WM8958)
441 dev_warn(wm8994->dev, "Device registered as type %d\n",
442 wm8994->type);
443 wm8994->type = WM8958;
444 break;
445 default:
9e501086
MB
446 dev_err(wm8994->dev, "Device is not a WM8994, ID is %x\n",
447 ret);
448 ret = -EINVAL;
449 goto err_enable;
450 }
451
452 ret = wm8994_reg_read(wm8994, WM8994_CHIP_REVISION);
453 if (ret < 0) {
454 dev_err(wm8994->dev, "Failed to read revision register: %d\n",
455 ret);
456 goto err_enable;
457 }
cc7a7279
MB
458 wm8994->revision = ret & WM8994_CHIP_REV_MASK;
459 wm8994->cust_id = (ret & WM8994_CUST_ID_MASK) >> WM8994_CUST_ID_SHIFT;
9e501086 460
a2495bc7
MB
461 switch (wm8994->type) {
462 case WM8994:
7ed5849c 463 switch (wm8994->revision) {
a2495bc7
MB
464 case 0:
465 case 1:
559e0df6
MB
466 dev_warn(wm8994->dev,
467 "revision %c not fully supported\n",
7ed5849c 468 'A' + wm8994->revision);
a2495bc7 469 break;
462835e4
MB
470 case 2:
471 case 3:
d54e17f9 472 default:
462835e4
MB
473 regmap_patch = wm8994_revc_patch;
474 patch_regs = ARRAY_SIZE(wm8994_revc_patch);
475 break;
462835e4
MB
476 }
477 break;
478
479 case WM8958:
480 switch (wm8994->revision) {
481 case 0:
482 regmap_patch = wm8958_reva_patch;
483 patch_regs = ARRAY_SIZE(wm8958_reva_patch);
484 break;
a2495bc7
MB
485 default:
486 break;
487 }
9e501086 488 break;
462835e4 489
443e67ed
MB
490 case WM1811:
491 /* Revision C did not change the relevant layer */
7ed5849c
MB
492 if (wm8994->revision > 1)
493 wm8994->revision++;
d54e17f9
MB
494
495 regmap_patch = wm1811_reva_patch;
496 patch_regs = ARRAY_SIZE(wm1811_reva_patch);
443e67ed 497 break;
462835e4 498
9e501086 499 default:
9e501086
MB
500 break;
501 }
502
cc7a7279
MB
503 dev_info(wm8994->dev, "%s revision %c CUST_ID %02x\n", devname,
504 'A' + wm8994->revision, wm8994->cust_id);
9e501086 505
34697898
MB
506 switch (wm8994->type) {
507 case WM1811:
508 regmap_config = &wm1811_regmap_config;
509 break;
510 case WM8994:
511 regmap_config = &wm8994_regmap_config;
512 break;
513 case WM8958:
514 regmap_config = &wm8958_regmap_config;
515 break;
516 default:
517 dev_err(wm8994->dev, "Unknown device type %d\n", wm8994->type);
df47df55
AB
518 ret = -EINVAL;
519 goto err_enable;
34697898
MB
520 }
521
522 ret = regmap_reinit_cache(wm8994->regmap, regmap_config);
523 if (ret != 0) {
524 dev_err(wm8994->dev, "Failed to reinit register cache: %d\n",
525 ret);
df47df55 526 goto err_enable;
34697898 527 }
9e501086 528
f3799e93
MB
529 /* Explicitly put the device into reset in case regulators
530 * don't get disabled in order to ensure we know the device
531 * state.
532 */
533 ret = wm8994_reg_write(wm8994, WM8994_SOFTWARE_RESET,
534 wm8994_reg_read(wm8994, WM8994_SOFTWARE_RESET));
535 if (ret != 0) {
536 dev_err(wm8994->dev, "Failed to reset device: %d\n", ret);
df47df55 537 goto err_enable;
f3799e93
MB
538 }
539
462835e4
MB
540 if (regmap_patch) {
541 ret = regmap_register_patch(wm8994->regmap, regmap_patch,
542 patch_regs);
543 if (ret != 0) {
544 dev_err(wm8994->dev, "Failed to register patch: %d\n",
545 ret);
df47df55 546 goto err_enable;
462835e4
MB
547 }
548 }
549
a8a8fc28
MB
550 wm8994->irq_base = pdata->irq_base;
551 wm8994->gpio_base = pdata->gpio_base;
552
553 /* GPIO configuration is only applied if it's non-zero */
554 for (i = 0; i < ARRAY_SIZE(pdata->gpio_defaults); i++) {
555 if (pdata->gpio_defaults[i]) {
556 wm8994_set_bits(wm8994, WM8994_GPIO_1 + i,
557 0xffff, pdata->gpio_defaults[i]);
9e501086 558 }
a8a8fc28 559 }
881de670 560
a8a8fc28 561 wm8994->ldo_ena_always_driven = pdata->ldo_ena_always_driven;
26c34c25 562
a8a8fc28
MB
563 if (pdata->spkmode_pu)
564 pulls |= WM8994_SPKMODE_PU;
9e501086 565
26c34c25 566 /* Disable unneeded pulls */
881de670 567 wm8994_set_bits(wm8994, WM8994_PULL_CONTROL_2,
26c34c25
MB
568 WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD |
569 WM8994_SPKMODE_PU | WM8994_CSNADDR_PD,
570 pulls);
881de670 571
9e501086
MB
572 /* In some system designs where the regulators are not in use,
573 * we can achieve a small reduction in leakage currents by
574 * floating LDO outputs. This bit makes no difference if the
575 * LDOs are enabled, it only affects cases where the LDOs were
576 * in operation and are then disabled.
577 */
578 for (i = 0; i < WM8994_NUM_LDO_REGS; i++) {
579 if (wm8994_ldo_in_use(pdata, i))
580 wm8994_set_bits(wm8994, WM8994_LDO_1 + i,
581 WM8994_LDO1_DISCH, WM8994_LDO1_DISCH);
582 else
583 wm8994_set_bits(wm8994, WM8994_LDO_1 + i,
584 WM8994_LDO1_DISCH, 0);
585 }
586
c9fbf7e0
MB
587 wm8994_irq_init(wm8994);
588
9e501086
MB
589 ret = mfd_add_devices(wm8994->dev, -1,
590 wm8994_devs, ARRAY_SIZE(wm8994_devs),
55692af5 591 NULL, 0, NULL);
9e501086
MB
592 if (ret != 0) {
593 dev_err(wm8994->dev, "Failed to add children: %d\n", ret);
c9fbf7e0 594 goto err_irq;
9e501086
MB
595 }
596
d450f19e 597 pm_runtime_enable(wm8994->dev);
ee67b0cd 598 pm_runtime_idle(wm8994->dev);
d450f19e 599
9e501086
MB
600 return 0;
601
c9fbf7e0
MB
602err_irq:
603 wm8994_irq_exit(wm8994);
9e501086 604err_enable:
559e0df6 605 regulator_bulk_disable(wm8994->num_supplies,
9e501086 606 wm8994->supplies);
202b5689
VK
607err_regulator_free:
608 regulator_bulk_free(wm8994->num_supplies, wm8994->supplies);
9db4249f 609err:
9e501086 610 mfd_remove_devices(wm8994->dev);
9e501086
MB
611 return ret;
612}
613
4740f73f 614static void wm8994_device_exit(struct wm8994 *wm8994)
9e501086 615{
d450f19e 616 pm_runtime_disable(wm8994->dev);
c9fbf7e0 617 wm8994_irq_exit(wm8994);
3e56c468 618 regulator_bulk_disable(wm8994->num_supplies, wm8994->supplies);
202b5689 619 regulator_bulk_free(wm8994->num_supplies, wm8994->supplies);
bb63f7d3 620 mfd_remove_devices(wm8994->dev);
9e501086
MB
621}
622
cf763c2e 623static const struct of_device_id wm8994_of_match[] = {
39aa3b5a
MB
624 { .compatible = "wlf,wm1811", .data = (void *)WM1811 },
625 { .compatible = "wlf,wm8994", .data = (void *)WM8994 },
626 { .compatible = "wlf,wm8958", .data = (void *)WM8958 },
cf763c2e
MB
627 { }
628};
629MODULE_DEVICE_TABLE(of, wm8994_of_match);
630
f791be49 631static int wm8994_i2c_probe(struct i2c_client *i2c,
027d6766 632 const struct i2c_device_id *id)
9e501086 633{
20fb2772 634 const struct of_device_id *of_id;
9e501086 635 struct wm8994 *wm8994;
d6c645fc 636 int ret;
9e501086 637
2fa33494 638 wm8994 = devm_kzalloc(&i2c->dev, sizeof(struct wm8994), GFP_KERNEL);
d0a11693 639 if (wm8994 == NULL)
9e501086 640 return -ENOMEM;
9e501086
MB
641
642 i2c_set_clientdata(i2c, wm8994);
643 wm8994->dev = &i2c->dev;
c9fbf7e0 644 wm8994->irq = i2c->irq;
20fb2772
MB
645
646 if (i2c->dev.of_node) {
647 of_id = of_match_device(wm8994_of_match, &i2c->dev);
648 if (of_id)
7f8279ce 649 wm8994->type = (enum wm8994_type)of_id->data;
20fb2772
MB
650 } else {
651 wm8994->type = id->driver_data;
652 }
9e501086 653
9db4249f 654 wm8994->regmap = devm_regmap_init_i2c(i2c, &wm8994_base_regmap_config);
d6c645fc
MB
655 if (IS_ERR(wm8994->regmap)) {
656 ret = PTR_ERR(wm8994->regmap);
657 dev_err(wm8994->dev, "Failed to allocate register map: %d\n",
658 ret);
d6c645fc
MB
659 return ret;
660 }
661
559e0df6 662 return wm8994_device_init(wm8994, i2c->irq);
9e501086
MB
663}
664
4740f73f 665static int wm8994_i2c_remove(struct i2c_client *i2c)
9e501086
MB
666{
667 struct wm8994 *wm8994 = i2c_get_clientdata(i2c);
668
669 wm8994_device_exit(wm8994);
670
671 return 0;
672}
673
9e501086 674static const struct i2c_device_id wm8994_i2c_id[] = {
b1f43bf3 675 { "wm1811", WM1811 },
71d17184 676 { "wm1811a", WM1811 },
559e0df6
MB
677 { "wm8994", WM8994 },
678 { "wm8958", WM8958 },
9e501086
MB
679 { }
680};
681MODULE_DEVICE_TABLE(i2c, wm8994_i2c_id);
682
6394678e
MB
683static const struct dev_pm_ops wm8994_pm_ops = {
684 SET_RUNTIME_PM_OPS(wm8994_suspend, wm8994_resume, NULL)
685};
d450f19e 686
9e501086
MB
687static struct i2c_driver wm8994_i2c_driver = {
688 .driver = {
d450f19e 689 .name = "wm8994",
d450f19e 690 .pm = &wm8994_pm_ops,
20fb2772 691 .of_match_table = of_match_ptr(wm8994_of_match),
9e501086
MB
692 },
693 .probe = wm8994_i2c_probe,
84449216 694 .remove = wm8994_i2c_remove,
9e501086
MB
695 .id_table = wm8994_i2c_id,
696};
697
ceb57d27 698module_i2c_driver(wm8994_i2c_driver);
9e501086
MB
699
700MODULE_DESCRIPTION("Core support for the WM8994 audio CODEC");
701MODULE_LICENSE("GPL");
702MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");