1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Core MFD support for Cirrus Logic Madera codecs
4 *
5 * Copyright (C) 2015-2018 Cirrus Logic
6 */
7
8 #include <linux/device.h>
9 #include <linux/delay.h>
10 #include <linux/err.h>
11 #include <linux/gpio.h>
12 #include <linux/mfd/core.h>
13 #include <linux/module.h>
14 #include <linux/mutex.h>
15 #include <linux/notifier.h>
16 #include <linux/of.h>
17 #include <linux/of_gpio.h>
18 #include <linux/platform_device.h>
19 #include <linux/pm_runtime.h>
20 #include <linux/regmap.h>
21 #include <linux/regulator/consumer.h>
22 #include <linux/regulator/machine.h>
23 #include <linux/regulator/of_regulator.h>
24
25 #include <linux/mfd/madera/core.h>
26 #include <linux/mfd/madera/registers.h>
27
28 #include "madera.h"
29
30 #define CS47L15_SILICON_ID 0x6370
31 #define CS47L35_SILICON_ID 0x6360
32 #define CS47L85_SILICON_ID 0x6338
33 #define CS47L90_SILICON_ID 0x6364
34 #define CS47L92_SILICON_ID 0x6371
35
36 #define MADERA_32KZ_MCLK2 1
37
38 #define MADERA_RESET_MIN_US 2000
39 #define MADERA_RESET_MAX_US 3000
40
41 #define ERRATA_DCVDD_MIN_US 10000
42 #define ERRATA_DCVDD_MAX_US 15000
43
44 static const char * const madera_core_supplies[] = {
45 "AVDD",
46 "DBVDD1",
47 };
48
49 static const struct mfd_cell madera_ldo1_devs[] = {
50 {
51 .name = "madera-ldo1",
52 .level = MFD_DEP_LEVEL_HIGH,
53 },
54 };
55
56 static const char * const cs47l15_supplies[] = {
57 "MICVDD",
58 "CPVDD1",
59 "SPKVDD",
60 };
61
62 static const struct mfd_cell cs47l15_devs[] = {
63 { .name = "madera-pinctrl", },
64 { .name = "madera-irq", },
65 { .name = "madera-gpio", },
66 {
67 .name = "madera-extcon",
68 .parent_supplies = cs47l15_supplies,
69 .num_parent_supplies = 1, /* We only need MICVDD */
70 },
71 {
72 .name = "cs47l15-codec",
73 .parent_supplies = cs47l15_supplies,
74 .num_parent_supplies = ARRAY_SIZE(cs47l15_supplies),
75 },
76 };
77
78 static const char * const cs47l35_supplies[] = {
79 "MICVDD",
80 "DBVDD2",
81 "CPVDD1",
82 "CPVDD2",
83 "SPKVDD",
84 };
85
86 static const struct mfd_cell cs47l35_devs[] = {
87 { .name = "madera-pinctrl", },
88 { .name = "madera-irq", },
89 { .name = "madera-micsupp", },
90 { .name = "madera-gpio", },
91 {
92 .name = "madera-extcon",
93 .parent_supplies = cs47l35_supplies,
94 .num_parent_supplies = 1, /* We only need MICVDD */
95 },
96 {
97 .name = "cs47l35-codec",
98 .parent_supplies = cs47l35_supplies,
99 .num_parent_supplies = ARRAY_SIZE(cs47l35_supplies),
100 },
101 };
102
103 static const char * const cs47l85_supplies[] = {
104 "MICVDD",
105 "DBVDD2",
106 "DBVDD3",
107 "DBVDD4",
108 "CPVDD1",
109 "CPVDD2",
110 "SPKVDDL",
111 "SPKVDDR",
112 };
113
114 static const struct mfd_cell cs47l85_devs[] = {
115 { .name = "madera-pinctrl", },
116 { .name = "madera-irq", },
117 { .name = "madera-micsupp", },
118 { .name = "madera-gpio", },
119 {
120 .name = "madera-extcon",
121 .parent_supplies = cs47l85_supplies,
122 .num_parent_supplies = 1, /* We only need MICVDD */
123 },
124 {
125 .name = "cs47l85-codec",
126 .parent_supplies = cs47l85_supplies,
127 .num_parent_supplies = ARRAY_SIZE(cs47l85_supplies),
128 },
129 };
130
131 static const char * const cs47l90_supplies[] = {
132 "MICVDD",
133 "DBVDD2",
134 "DBVDD3",
135 "DBVDD4",
136 "CPVDD1",
137 "CPVDD2",
138 };
139
140 static const struct mfd_cell cs47l90_devs[] = {
141 { .name = "madera-pinctrl", },
142 { .name = "madera-irq", },
143 { .name = "madera-micsupp", },
144 { .name = "madera-gpio", },
145 {
146 .name = "madera-extcon",
147 .parent_supplies = cs47l90_supplies,
148 .num_parent_supplies = 1, /* We only need MICVDD */
149 },
150 {
151 .name = "cs47l90-codec",
152 .parent_supplies = cs47l90_supplies,
153 .num_parent_supplies = ARRAY_SIZE(cs47l90_supplies),
154 },
155 };
156
157 static const char * const cs47l92_supplies[] = {
158 "MICVDD",
159 "CPVDD1",
160 "CPVDD2",
161 };
162
163 static const struct mfd_cell cs47l92_devs[] = {
164 { .name = "madera-pinctrl", },
165 { .name = "madera-irq", },
166 { .name = "madera-micsupp", },
167 { .name = "madera-gpio", },
168 {
169 .name = "madera-extcon",
170 .parent_supplies = cs47l92_supplies,
171 .num_parent_supplies = 1, /* We only need MICVDD */
172 },
173 {
174 .name = "cs47l92-codec",
175 .parent_supplies = cs47l92_supplies,
176 .num_parent_supplies = ARRAY_SIZE(cs47l92_supplies),
177 },
178 };
179
180 /* Used by madera-i2c and madera-spi drivers */
madera_name_from_type(enum madera_type type)181 const char *madera_name_from_type(enum madera_type type)
182 {
183 switch (type) {
184 case CS47L15:
185 return "CS47L15";
186 case CS47L35:
187 return "CS47L35";
188 case CS47L85:
189 return "CS47L85";
190 case CS47L90:
191 return "CS47L90";
192 case CS47L91:
193 return "CS47L91";
194 case CS42L92:
195 return "CS42L92";
196 case CS47L92:
197 return "CS47L92";
198 case CS47L93:
199 return "CS47L93";
200 case WM1840:
201 return "WM1840";
202 default:
203 return "Unknown";
204 }
205 }
206 EXPORT_SYMBOL_GPL(madera_name_from_type);
207
208 #define MADERA_BOOT_POLL_INTERVAL_USEC 5000
209 #define MADERA_BOOT_POLL_TIMEOUT_USEC 25000
210
madera_wait_for_boot_noack(struct madera * madera)211 static int madera_wait_for_boot_noack(struct madera *madera)
212 {
213 ktime_t timeout;
214 unsigned int val = 0;
215 int ret = 0;
216
217 /*
218 * We can't use an interrupt as we need to runtime resume to do so,
219 * so we poll the status bit. This won't race with the interrupt
220 * handler because it will be blocked on runtime resume.
221 * The chip could NAK a read request while it is booting so ignore
222 * errors from regmap_read.
223 */
224 timeout = ktime_add_us(ktime_get(), MADERA_BOOT_POLL_TIMEOUT_USEC);
225 regmap_read(madera->regmap, MADERA_IRQ1_RAW_STATUS_1, &val);
226 while (!(val & MADERA_BOOT_DONE_STS1) &&
227 !ktime_after(ktime_get(), timeout)) {
228 usleep_range(MADERA_BOOT_POLL_INTERVAL_USEC / 2,
229 MADERA_BOOT_POLL_INTERVAL_USEC);
230 regmap_read(madera->regmap, MADERA_IRQ1_RAW_STATUS_1, &val);
231 }
232
233 if (!(val & MADERA_BOOT_DONE_STS1)) {
234 dev_err(madera->dev, "Polling BOOT_DONE_STS timed out\n");
235 ret = -ETIMEDOUT;
236 }
237
238 return ret;
239 }
240
madera_wait_for_boot(struct madera * madera)241 static int madera_wait_for_boot(struct madera *madera)
242 {
243 int ret = madera_wait_for_boot_noack(madera);
244
245 /*
246 * BOOT_DONE defaults to unmasked on boot so we must ack it.
247 * Do this even after a timeout to avoid interrupt storms.
248 */
249 regmap_write(madera->regmap, MADERA_IRQ1_STATUS_1,
250 MADERA_BOOT_DONE_EINT1);
251
252 pm_runtime_mark_last_busy(madera->dev);
253
254 return ret;
255 }
256
madera_soft_reset(struct madera * madera)257 static int madera_soft_reset(struct madera *madera)
258 {
259 int ret;
260
261 ret = regmap_write(madera->regmap, MADERA_SOFTWARE_RESET, 0);
262 if (ret != 0) {
263 dev_err(madera->dev, "Failed to soft reset device: %d\n", ret);
264 return ret;
265 }
266
267 /* Allow time for internal clocks to startup after reset */
268 usleep_range(MADERA_RESET_MIN_US, MADERA_RESET_MAX_US);
269
270 return 0;
271 }
272
madera_enable_hard_reset(struct madera * madera)273 static void madera_enable_hard_reset(struct madera *madera)
274 {
275 /*
276 * There are many existing out-of-tree users of these codecs that we
277 * can't break so preserve the expected behaviour of setting the line
278 * low to assert reset.
279 */
280 gpiod_set_raw_value_cansleep(madera->pdata.reset, 0);
281 }
282
madera_disable_hard_reset(struct madera * madera)283 static void madera_disable_hard_reset(struct madera *madera)
284 {
285 gpiod_set_raw_value_cansleep(madera->pdata.reset, 1);
286
287 usleep_range(MADERA_RESET_MIN_US, MADERA_RESET_MAX_US);
288 }
289
madera_runtime_resume(struct device * dev)290 static int __maybe_unused madera_runtime_resume(struct device *dev)
291 {
292 struct madera *madera = dev_get_drvdata(dev);
293 int ret;
294
295 dev_dbg(dev, "Leaving sleep mode\n");
296
297 if (!madera->reset_errata)
298 madera_enable_hard_reset(madera);
299
300 ret = regulator_enable(madera->dcvdd);
301 if (ret) {
302 dev_err(dev, "Failed to enable DCVDD: %d\n", ret);
303 return ret;
304 }
305
306 regcache_cache_only(madera->regmap, false);
307 regcache_cache_only(madera->regmap_32bit, false);
308
309 if (madera->reset_errata)
310 usleep_range(ERRATA_DCVDD_MIN_US, ERRATA_DCVDD_MAX_US);
311 else
312 madera_disable_hard_reset(madera);
313
314 if (!madera->pdata.reset || madera->reset_errata) {
315 ret = madera_wait_for_boot(madera);
316 if (ret)
317 goto err;
318
319 ret = madera_soft_reset(madera);
320 if (ret) {
321 dev_err(dev, "Failed to reset: %d\n", ret);
322 goto err;
323 }
324 }
325
326 ret = madera_wait_for_boot(madera);
327 if (ret)
328 goto err;
329
330 ret = regcache_sync(madera->regmap);
331 if (ret) {
332 dev_err(dev, "Failed to restore 16-bit register cache\n");
333 goto err;
334 }
335
336 ret = regcache_sync(madera->regmap_32bit);
337 if (ret) {
338 dev_err(dev, "Failed to restore 32-bit register cache\n");
339 goto err;
340 }
341
342 return 0;
343
344 err:
345 regcache_cache_only(madera->regmap_32bit, true);
346 regcache_cache_only(madera->regmap, true);
347 regulator_disable(madera->dcvdd);
348
349 return ret;
350 }
351
madera_runtime_suspend(struct device * dev)352 static int __maybe_unused madera_runtime_suspend(struct device *dev)
353 {
354 struct madera *madera = dev_get_drvdata(dev);
355
356 dev_dbg(madera->dev, "Entering sleep mode\n");
357
358 regcache_cache_only(madera->regmap, true);
359 regcache_mark_dirty(madera->regmap);
360 regcache_cache_only(madera->regmap_32bit, true);
361 regcache_mark_dirty(madera->regmap_32bit);
362
363 regulator_disable(madera->dcvdd);
364
365 return 0;
366 }
367
368 const struct dev_pm_ops madera_pm_ops = {
369 SET_RUNTIME_PM_OPS(madera_runtime_suspend,
370 madera_runtime_resume,
371 NULL)
372 };
373 EXPORT_SYMBOL_GPL(madera_pm_ops);
374
375 const struct of_device_id madera_of_match[] = {
376 { .compatible = "cirrus,cs47l15", .data = (void *)CS47L15 },
377 { .compatible = "cirrus,cs47l35", .data = (void *)CS47L35 },
378 { .compatible = "cirrus,cs47l85", .data = (void *)CS47L85 },
379 { .compatible = "cirrus,cs47l90", .data = (void *)CS47L90 },
380 { .compatible = "cirrus,cs47l91", .data = (void *)CS47L91 },
381 { .compatible = "cirrus,cs42l92", .data = (void *)CS42L92 },
382 { .compatible = "cirrus,cs47l92", .data = (void *)CS47L92 },
383 { .compatible = "cirrus,cs47l93", .data = (void *)CS47L93 },
384 { .compatible = "cirrus,wm1840", .data = (void *)WM1840 },
385 {}
386 };
387 MODULE_DEVICE_TABLE(of, madera_of_match);
388 EXPORT_SYMBOL_GPL(madera_of_match);
389
madera_get_reset_gpio(struct madera * madera)390 static int madera_get_reset_gpio(struct madera *madera)
391 {
392 struct gpio_desc *reset;
393
394 if (madera->pdata.reset)
395 return 0;
396
397 reset = devm_gpiod_get_optional(madera->dev, "reset", GPIOD_OUT_LOW);
398 if (IS_ERR(reset))
399 return dev_err_probe(madera->dev, PTR_ERR(reset),
400 "Failed to request /RESET");
401
402 /*
403 * A hard reset is needed for full reset of the chip. We allow running
404 * without hard reset only because it can be useful for early
405 * prototyping and some debugging, but we need to warn it's not ideal.
406 */
407 if (!reset)
408 dev_warn(madera->dev,
409 "Running without reset GPIO is not recommended\n");
410
411 madera->pdata.reset = reset;
412
413 return 0;
414 }
415
madera_set_micbias_info(struct madera * madera)416 static void madera_set_micbias_info(struct madera *madera)
417 {
418 /*
419 * num_childbias is an array because future codecs can have different
420 * childbiases for each micbias. Unspecified values default to 0.
421 */
422 switch (madera->type) {
423 case CS47L15:
424 madera->num_micbias = 1;
425 madera->num_childbias[0] = 3;
426 return;
427 case CS47L35:
428 madera->num_micbias = 2;
429 madera->num_childbias[0] = 2;
430 madera->num_childbias[1] = 2;
431 return;
432 case CS47L85:
433 case WM1840:
434 madera->num_micbias = 4;
435 /* no child biases */
436 return;
437 case CS47L90:
438 case CS47L91:
439 madera->num_micbias = 2;
440 madera->num_childbias[0] = 4;
441 madera->num_childbias[1] = 4;
442 return;
443 case CS42L92:
444 case CS47L92:
445 case CS47L93:
446 madera->num_micbias = 2;
447 madera->num_childbias[0] = 4;
448 madera->num_childbias[1] = 2;
449 return;
450 default:
451 return;
452 }
453 }
454
madera_dev_init(struct madera * madera)455 int madera_dev_init(struct madera *madera)
456 {
457 struct device *dev = madera->dev;
458 unsigned int hwid;
459 int (*patch_fn)(struct madera *) = NULL;
460 const struct mfd_cell *mfd_devs;
461 int n_devs = 0;
462 int i, ret;
463
464 dev_set_drvdata(madera->dev, madera);
465 BLOCKING_INIT_NOTIFIER_HEAD(&madera->notifier);
466 mutex_init(&madera->dapm_ptr_lock);
467
468 madera_set_micbias_info(madera);
469
470 /*
471 * We need writable hw config info that all children can share.
472 * Simplest to take one shared copy of pdata struct.
473 */
474 if (dev_get_platdata(madera->dev)) {
475 memcpy(&madera->pdata, dev_get_platdata(madera->dev),
476 sizeof(madera->pdata));
477 }
478
479 madera->mclk[MADERA_MCLK1].id = "mclk1";
480 madera->mclk[MADERA_MCLK2].id = "mclk2";
481 madera->mclk[MADERA_MCLK3].id = "mclk3";
482
483 ret = devm_clk_bulk_get_optional(madera->dev, ARRAY_SIZE(madera->mclk),
484 madera->mclk);
485 if (ret) {
486 dev_err(madera->dev, "Failed to get clocks: %d\n", ret);
487 return ret;
488 }
489
490 /* Not using devm_clk_get to prevent breakage of existing DTs */
491 if (!madera->mclk[MADERA_MCLK2].clk)
492 dev_warn(madera->dev, "Missing MCLK2, requires 32kHz clock\n");
493
494 ret = madera_get_reset_gpio(madera);
495 if (ret)
496 return ret;
497
498 regcache_cache_only(madera->regmap, true);
499 regcache_cache_only(madera->regmap_32bit, true);
500
501 for (i = 0; i < ARRAY_SIZE(madera_core_supplies); i++)
502 madera->core_supplies[i].supply = madera_core_supplies[i];
503
504 madera->num_core_supplies = ARRAY_SIZE(madera_core_supplies);
505
506 /*
507 * On some codecs DCVDD could be supplied by the internal LDO1.
508 * For those we must add the LDO1 driver before requesting DCVDD
509 * No devm_ because we need to control shutdown order of children.
510 */
511 switch (madera->type) {
512 case CS47L15:
513 madera->reset_errata = true;
514 break;
515 case CS47L35:
516 case CS47L90:
517 case CS47L91:
518 case CS42L92:
519 case CS47L92:
520 case CS47L93:
521 break;
522 case CS47L85:
523 case WM1840:
524 ret = mfd_add_devices(madera->dev, PLATFORM_DEVID_NONE,
525 madera_ldo1_devs,
526 ARRAY_SIZE(madera_ldo1_devs),
527 NULL, 0, NULL);
528 if (ret) {
529 dev_err(dev, "Failed to add LDO1 child: %d\n", ret);
530 return ret;
531 }
532 break;
533 default:
534 /* No point continuing if the type is unknown */
535 dev_err(madera->dev, "Unknown device type %d\n", madera->type);
536 return -ENODEV;
537 }
538
539 ret = devm_regulator_bulk_get(dev, madera->num_core_supplies,
540 madera->core_supplies);
541 if (ret) {
542 dev_err(dev, "Failed to request core supplies: %d\n", ret);
543 goto err_devs;
544 }
545
546 /*
547 * Don't use devres here. If the regulator is one of our children it
548 * will already have been removed before devres cleanup on this mfd
549 * driver tries to call put() on it. We need control of shutdown order.
550 */
551 madera->dcvdd = regulator_get(madera->dev, "DCVDD");
552 if (IS_ERR(madera->dcvdd)) {
553 ret = PTR_ERR(madera->dcvdd);
554 dev_err(dev, "Failed to request DCVDD: %d\n", ret);
555 goto err_devs;
556 }
557
558 ret = regulator_bulk_enable(madera->num_core_supplies,
559 madera->core_supplies);
560 if (ret) {
561 dev_err(dev, "Failed to enable core supplies: %d\n", ret);
562 goto err_dcvdd;
563 }
564
565 if (madera->reset_errata)
566 madera_disable_hard_reset(madera);
567
568 ret = regulator_enable(madera->dcvdd);
569 if (ret) {
570 dev_err(dev, "Failed to enable DCVDD: %d\n", ret);
571 goto err_enable;
572 }
573
574 if (madera->reset_errata)
575 usleep_range(ERRATA_DCVDD_MIN_US, ERRATA_DCVDD_MAX_US);
576 else
577 madera_disable_hard_reset(madera);
578
579 regcache_cache_only(madera->regmap, false);
580 regcache_cache_only(madera->regmap_32bit, false);
581
582 ret = madera_wait_for_boot_noack(madera);
583 if (ret) {
584 dev_err(madera->dev, "Device failed initial boot: %d\n", ret);
585 goto err_reset;
586 }
587
588 /*
589 * Now we can power up and verify that this is a chip we know about
590 * before we start doing any writes to its registers.
591 */
592 ret = regmap_read(madera->regmap, MADERA_SOFTWARE_RESET, &hwid);
593 if (ret) {
594 dev_err(dev, "Failed to read ID register: %d\n", ret);
595 goto err_reset;
596 }
597
598 switch (hwid) {
599 case CS47L15_SILICON_ID:
600 if (IS_ENABLED(CONFIG_MFD_CS47L15)) {
601 switch (madera->type) {
602 case CS47L15:
603 patch_fn = &cs47l15_patch;
604 mfd_devs = cs47l15_devs;
605 n_devs = ARRAY_SIZE(cs47l15_devs);
606 break;
607 default:
608 break;
609 }
610 }
611 break;
612 case CS47L35_SILICON_ID:
613 if (IS_ENABLED(CONFIG_MFD_CS47L35)) {
614 switch (madera->type) {
615 case CS47L35:
616 patch_fn = cs47l35_patch;
617 mfd_devs = cs47l35_devs;
618 n_devs = ARRAY_SIZE(cs47l35_devs);
619 break;
620 default:
621 break;
622 }
623 }
624 break;
625 case CS47L85_SILICON_ID:
626 if (IS_ENABLED(CONFIG_MFD_CS47L85)) {
627 switch (madera->type) {
628 case CS47L85:
629 case WM1840:
630 patch_fn = cs47l85_patch;
631 mfd_devs = cs47l85_devs;
632 n_devs = ARRAY_SIZE(cs47l85_devs);
633 break;
634 default:
635 break;
636 }
637 }
638 break;
639 case CS47L90_SILICON_ID:
640 if (IS_ENABLED(CONFIG_MFD_CS47L90)) {
641 switch (madera->type) {
642 case CS47L90:
643 case CS47L91:
644 patch_fn = cs47l90_patch;
645 mfd_devs = cs47l90_devs;
646 n_devs = ARRAY_SIZE(cs47l90_devs);
647 break;
648 default:
649 break;
650 }
651 }
652 break;
653 case CS47L92_SILICON_ID:
654 if (IS_ENABLED(CONFIG_MFD_CS47L92)) {
655 switch (madera->type) {
656 case CS42L92:
657 case CS47L92:
658 case CS47L93:
659 patch_fn = cs47l92_patch;
660 mfd_devs = cs47l92_devs;
661 n_devs = ARRAY_SIZE(cs47l92_devs);
662 break;
663 default:
664 break;
665 }
666 }
667 break;
668 default:
669 dev_err(madera->dev, "Unknown device ID: %x\n", hwid);
670 ret = -EINVAL;
671 goto err_reset;
672 }
673
674 if (!n_devs) {
675 dev_err(madera->dev, "Device ID 0x%x not a %s\n", hwid,
676 madera->type_name);
677 ret = -ENODEV;
678 goto err_reset;
679 }
680
681 /*
682 * It looks like a device we support. If we don't have a hard reset
683 * we can now attempt a soft reset.
684 */
685 if (!madera->pdata.reset || madera->reset_errata) {
686 ret = madera_soft_reset(madera);
687 if (ret)
688 goto err_reset;
689 }
690
691 ret = madera_wait_for_boot(madera);
692 if (ret) {
693 dev_err(madera->dev, "Failed to clear boot done: %d\n", ret);
694 goto err_reset;
695 }
696
697 ret = regmap_read(madera->regmap, MADERA_HARDWARE_REVISION,
698 &madera->rev);
699 if (ret) {
700 dev_err(dev, "Failed to read revision register: %d\n", ret);
701 goto err_reset;
702 }
703 madera->rev &= MADERA_HW_REVISION_MASK;
704
705 dev_info(dev, "%s silicon revision %d\n", madera->type_name,
706 madera->rev);
707
708 /* Apply hardware patch */
709 if (patch_fn) {
710 ret = patch_fn(madera);
711 if (ret) {
712 dev_err(madera->dev, "Failed to apply patch %d\n", ret);
713 goto err_reset;
714 }
715 }
716
717 /* Init 32k clock sourced from MCLK2 */
718 ret = clk_prepare_enable(madera->mclk[MADERA_MCLK2].clk);
719 if (ret) {
720 dev_err(madera->dev, "Failed to enable 32k clock: %d\n", ret);
721 goto err_reset;
722 }
723
724 ret = regmap_update_bits(madera->regmap,
725 MADERA_CLOCK_32K_1,
726 MADERA_CLK_32K_ENA_MASK | MADERA_CLK_32K_SRC_MASK,
727 MADERA_CLK_32K_ENA | MADERA_32KZ_MCLK2);
728 if (ret) {
729 dev_err(madera->dev, "Failed to init 32k clock: %d\n", ret);
730 goto err_clock;
731 }
732
733 pm_runtime_set_active(madera->dev);
734 pm_runtime_enable(madera->dev);
735 pm_runtime_set_autosuspend_delay(madera->dev, 100);
736 pm_runtime_use_autosuspend(madera->dev);
737
738 /* No devm_ because we need to control shutdown order of children */
739 ret = mfd_add_devices(madera->dev, PLATFORM_DEVID_NONE,
740 mfd_devs, n_devs,
741 NULL, 0, NULL);
742 if (ret) {
743 dev_err(madera->dev, "Failed to add subdevices: %d\n", ret);
744 goto err_pm_runtime;
745 }
746
747 return 0;
748
749 err_pm_runtime:
750 pm_runtime_disable(madera->dev);
751 err_clock:
752 clk_disable_unprepare(madera->mclk[MADERA_MCLK2].clk);
753 err_reset:
754 madera_enable_hard_reset(madera);
755 regulator_disable(madera->dcvdd);
756 err_enable:
757 regulator_bulk_disable(madera->num_core_supplies,
758 madera->core_supplies);
759 err_dcvdd:
760 regulator_put(madera->dcvdd);
761 err_devs:
762 mfd_remove_devices(dev);
763
764 return ret;
765 }
766 EXPORT_SYMBOL_GPL(madera_dev_init);
767
madera_dev_exit(struct madera * madera)768 int madera_dev_exit(struct madera *madera)
769 {
770 /* Prevent any IRQs being serviced while we clean up */
771 disable_irq(madera->irq);
772
773 pm_runtime_get_sync(madera->dev);
774
775 mfd_remove_devices(madera->dev);
776
777 pm_runtime_disable(madera->dev);
778
779 regulator_disable(madera->dcvdd);
780 regulator_put(madera->dcvdd);
781
782 mfd_remove_devices_late(madera->dev);
783
784 pm_runtime_set_suspended(madera->dev);
785 pm_runtime_put_noidle(madera->dev);
786
787 clk_disable_unprepare(madera->mclk[MADERA_MCLK2].clk);
788
789 madera_enable_hard_reset(madera);
790
791 regulator_bulk_disable(madera->num_core_supplies,
792 madera->core_supplies);
793 return 0;
794 }
795 EXPORT_SYMBOL_GPL(madera_dev_exit);
796
797 MODULE_DESCRIPTION("Madera core MFD driver");
798 MODULE_AUTHOR("Richard Fitzgerald <rf@opensource.cirrus.com>");
799 MODULE_LICENSE("GPL v2");
800