2 * wm_adsp.c -- Wolfson ADSP support
4 * Copyright 2012 Wolfson Microelectronics plc
6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
13 #include <linux/module.h>
14 #include <linux/moduleparam.h>
15 #include <linux/init.h>
16 #include <linux/delay.h>
17 #include <linux/firmware.h>
19 #include <linux/pm_runtime.h>
20 #include <linux/regmap.h>
21 #include <linux/regulator/consumer.h>
22 #include <linux/slab.h>
23 #include <sound/core.h>
24 #include <sound/pcm.h>
25 #include <sound/pcm_params.h>
26 #include <sound/soc.h>
27 #include <sound/jack.h>
28 #include <sound/initval.h>
29 #include <sound/tlv.h>
31 #include <linux/mfd/arizona/registers.h>
35 #define adsp_crit(_dsp, fmt, ...) \
36 dev_crit(_dsp->dev, "DSP%d: " fmt, _dsp->num, ##__VA_ARGS__)
37 #define adsp_err(_dsp, fmt, ...) \
38 dev_err(_dsp->dev, "DSP%d: " fmt, _dsp->num, ##__VA_ARGS__)
39 #define adsp_warn(_dsp, fmt, ...) \
40 dev_warn(_dsp->dev, "DSP%d: " fmt, _dsp->num, ##__VA_ARGS__)
41 #define adsp_info(_dsp, fmt, ...) \
42 dev_info(_dsp->dev, "DSP%d: " fmt, _dsp->num, ##__VA_ARGS__)
43 #define adsp_dbg(_dsp, fmt, ...) \
44 dev_dbg(_dsp->dev, "DSP%d: " fmt, _dsp->num, ##__VA_ARGS__)
46 #define ADSP1_CONTROL_1 0x00
47 #define ADSP1_CONTROL_2 0x02
48 #define ADSP1_CONTROL_3 0x03
49 #define ADSP1_CONTROL_4 0x04
50 #define ADSP1_CONTROL_5 0x06
51 #define ADSP1_CONTROL_6 0x07
52 #define ADSP1_CONTROL_7 0x08
53 #define ADSP1_CONTROL_8 0x09
54 #define ADSP1_CONTROL_9 0x0A
55 #define ADSP1_CONTROL_10 0x0B
56 #define ADSP1_CONTROL_11 0x0C
57 #define ADSP1_CONTROL_12 0x0D
58 #define ADSP1_CONTROL_13 0x0F
59 #define ADSP1_CONTROL_14 0x10
60 #define ADSP1_CONTROL_15 0x11
61 #define ADSP1_CONTROL_16 0x12
62 #define ADSP1_CONTROL_17 0x13
63 #define ADSP1_CONTROL_18 0x14
64 #define ADSP1_CONTROL_19 0x16
65 #define ADSP1_CONTROL_20 0x17
66 #define ADSP1_CONTROL_21 0x18
67 #define ADSP1_CONTROL_22 0x1A
68 #define ADSP1_CONTROL_23 0x1B
69 #define ADSP1_CONTROL_24 0x1C
70 #define ADSP1_CONTROL_25 0x1E
71 #define ADSP1_CONTROL_26 0x20
72 #define ADSP1_CONTROL_27 0x21
73 #define ADSP1_CONTROL_28 0x22
74 #define ADSP1_CONTROL_29 0x23
75 #define ADSP1_CONTROL_30 0x24
76 #define ADSP1_CONTROL_31 0x26
81 #define ADSP1_WDMA_BUFFER_LENGTH_MASK 0x00FF /* DSP1_WDMA_BUFFER_LENGTH - [7:0] */
82 #define ADSP1_WDMA_BUFFER_LENGTH_SHIFT 0 /* DSP1_WDMA_BUFFER_LENGTH - [7:0] */
83 #define ADSP1_WDMA_BUFFER_LENGTH_WIDTH 8 /* DSP1_WDMA_BUFFER_LENGTH - [7:0] */
89 #define ADSP1_DBG_CLK_ENA 0x0008 /* DSP1_DBG_CLK_ENA */
90 #define ADSP1_DBG_CLK_ENA_MASK 0x0008 /* DSP1_DBG_CLK_ENA */
91 #define ADSP1_DBG_CLK_ENA_SHIFT 3 /* DSP1_DBG_CLK_ENA */
92 #define ADSP1_DBG_CLK_ENA_WIDTH 1 /* DSP1_DBG_CLK_ENA */
93 #define ADSP1_SYS_ENA 0x0004 /* DSP1_SYS_ENA */
94 #define ADSP1_SYS_ENA_MASK 0x0004 /* DSP1_SYS_ENA */
95 #define ADSP1_SYS_ENA_SHIFT 2 /* DSP1_SYS_ENA */
96 #define ADSP1_SYS_ENA_WIDTH 1 /* DSP1_SYS_ENA */
97 #define ADSP1_CORE_ENA 0x0002 /* DSP1_CORE_ENA */
98 #define ADSP1_CORE_ENA_MASK 0x0002 /* DSP1_CORE_ENA */
99 #define ADSP1_CORE_ENA_SHIFT 1 /* DSP1_CORE_ENA */
100 #define ADSP1_CORE_ENA_WIDTH 1 /* DSP1_CORE_ENA */
101 #define ADSP1_START 0x0001 /* DSP1_START */
102 #define ADSP1_START_MASK 0x0001 /* DSP1_START */
103 #define ADSP1_START_SHIFT 0 /* DSP1_START */
104 #define ADSP1_START_WIDTH 1 /* DSP1_START */
106 #define ADSP2_CONTROL 0
107 #define ADSP2_CLOCKING 1
108 #define ADSP2_STATUS1 4
114 #define ADSP2_MEM_ENA 0x0010 /* DSP1_MEM_ENA */
115 #define ADSP2_MEM_ENA_MASK 0x0010 /* DSP1_MEM_ENA */
116 #define ADSP2_MEM_ENA_SHIFT 4 /* DSP1_MEM_ENA */
117 #define ADSP2_MEM_ENA_WIDTH 1 /* DSP1_MEM_ENA */
118 #define ADSP2_SYS_ENA 0x0004 /* DSP1_SYS_ENA */
119 #define ADSP2_SYS_ENA_MASK 0x0004 /* DSP1_SYS_ENA */
120 #define ADSP2_SYS_ENA_SHIFT 2 /* DSP1_SYS_ENA */
121 #define ADSP2_SYS_ENA_WIDTH 1 /* DSP1_SYS_ENA */
122 #define ADSP2_CORE_ENA 0x0002 /* DSP1_CORE_ENA */
123 #define ADSP2_CORE_ENA_MASK 0x0002 /* DSP1_CORE_ENA */
124 #define ADSP2_CORE_ENA_SHIFT 1 /* DSP1_CORE_ENA */
125 #define ADSP2_CORE_ENA_WIDTH 1 /* DSP1_CORE_ENA */
126 #define ADSP2_START 0x0001 /* DSP1_START */
127 #define ADSP2_START_MASK 0x0001 /* DSP1_START */
128 #define ADSP2_START_SHIFT 0 /* DSP1_START */
129 #define ADSP2_START_WIDTH 1 /* DSP1_START */
134 #define ADSP2_CLK_SEL_MASK 0x0007 /* CLK_SEL_ENA */
135 #define ADSP2_CLK_SEL_SHIFT 0 /* CLK_SEL_ENA */
136 #define ADSP2_CLK_SEL_WIDTH 3 /* CLK_SEL_ENA */
141 #define ADSP2_RAM_RDY 0x0001
142 #define ADSP2_RAM_RDY_MASK 0x0001
143 #define ADSP2_RAM_RDY_SHIFT 0
144 #define ADSP2_RAM_RDY_WIDTH 1
147 static struct wm_adsp_region
const *wm_adsp_find_region(struct wm_adsp
*dsp
,
152 for (i
= 0; i
< dsp
->num_mems
; i
++)
153 if (dsp
->mem
[i
].type
== type
)
159 static unsigned int wm_adsp_region_to_reg(struct wm_adsp_region
const *region
,
162 switch (region
->type
) {
164 return region
->base
+ (offset
* 3);
166 return region
->base
+ (offset
* 2);
168 return region
->base
+ (offset
* 2);
170 return region
->base
+ (offset
* 2);
172 return region
->base
+ (offset
* 2);
174 WARN_ON(NULL
!= "Unknown memory region type");
179 static int wm_adsp_load(struct wm_adsp
*dsp
)
181 const struct firmware
*firmware
;
182 struct regmap
*regmap
= dsp
->regmap
;
183 unsigned int pos
= 0;
184 const struct wmfw_header
*header
;
185 const struct wmfw_adsp1_sizes
*adsp1_sizes
;
186 const struct wmfw_adsp2_sizes
*adsp2_sizes
;
187 const struct wmfw_footer
*footer
;
188 const struct wmfw_region
*region
;
189 const struct wm_adsp_region
*mem
;
190 const char *region_name
;
194 int ret
, offset
, type
, sizes
;
196 file
= kzalloc(PAGE_SIZE
, GFP_KERNEL
);
200 snprintf(file
, PAGE_SIZE
, "%s-dsp%d.wmfw", dsp
->part
, dsp
->num
);
201 file
[PAGE_SIZE
- 1] = '\0';
203 ret
= request_firmware(&firmware
, file
, dsp
->dev
);
205 adsp_err(dsp
, "Failed to request '%s'\n", file
);
210 pos
= sizeof(*header
) + sizeof(*adsp1_sizes
) + sizeof(*footer
);
211 if (pos
>= firmware
->size
) {
212 adsp_err(dsp
, "%s: file too short, %zu bytes\n",
213 file
, firmware
->size
);
217 header
= (void*)&firmware
->data
[0];
219 if (memcmp(&header
->magic
[0], "WMFW", 4) != 0) {
220 adsp_err(dsp
, "%s: invalid magic\n", file
);
224 if (header
->ver
!= 0) {
225 adsp_err(dsp
, "%s: unknown file format %d\n",
230 if (header
->core
!= dsp
->type
) {
231 adsp_err(dsp
, "%s: invalid core %d != %d\n",
232 file
, header
->core
, dsp
->type
);
238 pos
= sizeof(*header
) + sizeof(*adsp1_sizes
) + sizeof(*footer
);
239 adsp1_sizes
= (void *)&(header
[1]);
240 footer
= (void *)&(adsp1_sizes
[1]);
241 sizes
= sizeof(*adsp1_sizes
);
243 adsp_dbg(dsp
, "%s: %d DM, %d PM, %d ZM\n",
244 file
, le32_to_cpu(adsp1_sizes
->dm
),
245 le32_to_cpu(adsp1_sizes
->pm
),
246 le32_to_cpu(adsp1_sizes
->zm
));
250 pos
= sizeof(*header
) + sizeof(*adsp2_sizes
) + sizeof(*footer
);
251 adsp2_sizes
= (void *)&(header
[1]);
252 footer
= (void *)&(adsp2_sizes
[1]);
253 sizes
= sizeof(*adsp2_sizes
);
255 adsp_dbg(dsp
, "%s: %d XM, %d YM %d PM, %d ZM\n",
256 file
, le32_to_cpu(adsp2_sizes
->xm
),
257 le32_to_cpu(adsp2_sizes
->ym
),
258 le32_to_cpu(adsp2_sizes
->pm
),
259 le32_to_cpu(adsp2_sizes
->zm
));
263 BUG_ON(NULL
== "Unknown DSP type");
267 if (le32_to_cpu(header
->len
) != sizeof(*header
) +
268 sizes
+ sizeof(*footer
)) {
269 adsp_err(dsp
, "%s: unexpected header length %d\n",
270 file
, le32_to_cpu(header
->len
));
274 adsp_dbg(dsp
, "%s: timestamp %llu\n", file
,
275 le64_to_cpu(footer
->timestamp
));
277 while (pos
< firmware
->size
&&
278 pos
- firmware
->size
> sizeof(*region
)) {
279 region
= (void *)&(firmware
->data
[pos
]);
280 region_name
= "Unknown";
283 offset
= le32_to_cpu(region
->offset
) & 0xffffff;
284 type
= be32_to_cpu(region
->type
) & 0xff;
285 mem
= wm_adsp_find_region(dsp
, type
);
289 region_name
= "Firmware name";
290 text
= kzalloc(le32_to_cpu(region
->len
) + 1,
294 region_name
= "Information";
295 text
= kzalloc(le32_to_cpu(region
->len
) + 1,
299 region_name
= "Absolute";
305 reg
= wm_adsp_region_to_reg(mem
, offset
);
310 reg
= wm_adsp_region_to_reg(mem
, offset
);
315 reg
= wm_adsp_region_to_reg(mem
, offset
);
320 reg
= wm_adsp_region_to_reg(mem
, offset
);
325 reg
= wm_adsp_region_to_reg(mem
, offset
);
329 "%s.%d: Unknown region type %x at %d(%x)\n",
330 file
, regions
, type
, pos
, pos
);
334 adsp_dbg(dsp
, "%s.%d: %d bytes at %d in %s\n", file
,
335 regions
, le32_to_cpu(region
->len
), offset
,
339 memcpy(text
, region
->data
, le32_to_cpu(region
->len
));
340 adsp_info(dsp
, "%s: %s\n", file
, text
);
345 ret
= regmap_raw_write(regmap
, reg
, region
->data
,
346 le32_to_cpu(region
->len
));
349 "%s.%d: Failed to write %d bytes at %d in %s: %d\n",
351 le32_to_cpu(region
->len
), offset
,
357 pos
+= le32_to_cpu(region
->len
) + sizeof(*region
);
361 if (pos
> firmware
->size
)
362 adsp_warn(dsp
, "%s.%d: %zu bytes at end of file\n",
363 file
, regions
, pos
- firmware
->size
);
366 release_firmware(firmware
);
373 static int wm_adsp_setup_algs(struct wm_adsp
*dsp
)
375 struct regmap
*regmap
= dsp
->regmap
;
376 struct wmfw_adsp1_id_hdr adsp1_id
;
377 struct wmfw_adsp2_id_hdr adsp2_id
;
378 struct wmfw_adsp1_alg_hdr
*adsp1_alg
;
379 struct wmfw_adsp2_alg_hdr
*adsp2_alg
;
381 const struct wm_adsp_region
*mem
;
382 unsigned int pos
, term
;
389 mem
= wm_adsp_find_region(dsp
, WMFW_ADSP1_DM
);
392 mem
= wm_adsp_find_region(dsp
, WMFW_ADSP2_XM
);
406 ret
= regmap_raw_read(regmap
, mem
->base
, &adsp1_id
,
409 adsp_err(dsp
, "Failed to read algorithm info: %d\n",
414 algs
= be32_to_cpu(adsp1_id
.algs
);
415 adsp_info(dsp
, "Firmware: %x v%d.%d.%d, %zu algorithms\n",
416 be32_to_cpu(adsp1_id
.fw
.id
),
417 (be32_to_cpu(adsp1_id
.fw
.ver
) & 0xff0000) >> 16,
418 (be32_to_cpu(adsp1_id
.fw
.ver
) & 0xff00) >> 8,
419 be32_to_cpu(adsp1_id
.fw
.ver
) & 0xff,
422 pos
= sizeof(adsp1_id
) / 2;
423 term
= pos
+ ((sizeof(*adsp1_alg
) * algs
) / 2);
427 ret
= regmap_raw_read(regmap
, mem
->base
, &adsp2_id
,
430 adsp_err(dsp
, "Failed to read algorithm info: %d\n",
435 algs
= be32_to_cpu(adsp2_id
.algs
);
436 adsp_info(dsp
, "Firmware: %x v%d.%d.%d, %zu algorithms\n",
437 be32_to_cpu(adsp2_id
.fw
.id
),
438 (be32_to_cpu(adsp2_id
.fw
.ver
) & 0xff0000) >> 16,
439 (be32_to_cpu(adsp2_id
.fw
.ver
) & 0xff00) >> 8,
440 be32_to_cpu(adsp2_id
.fw
.ver
) & 0xff,
443 pos
= sizeof(adsp2_id
) / 2;
444 term
= pos
+ ((sizeof(*adsp2_alg
) * algs
) / 2);
448 BUG_ON(NULL
== "Unknown DSP type");
453 adsp_err(dsp
, "No algorithms\n");
457 /* Read the terminator first to validate the length */
458 ret
= regmap_raw_read(regmap
, mem
->base
+ term
, &val
, sizeof(val
));
460 adsp_err(dsp
, "Failed to read algorithm list end: %d\n",
465 if (be32_to_cpu(val
) != 0xbedead)
466 adsp_warn(dsp
, "Algorithm list end %x 0x%x != 0xbeadead\n",
467 term
, be32_to_cpu(val
));
469 alg
= kzalloc((term
- pos
) * 2, GFP_KERNEL
);
473 ret
= regmap_raw_read(regmap
, mem
->base
+ pos
, alg
, (term
- pos
) * 2);
475 adsp_err(dsp
, "Failed to read algorithm list: %d\n",
483 for (i
= 0; i
< algs
; i
++) {
486 adsp_info(dsp
, "%d: ID %x v%d.%d.%d\n",
487 i
, be32_to_cpu(adsp1_alg
[i
].alg
.id
),
488 (be32_to_cpu(adsp1_alg
[i
].alg
.ver
) & 0xff0000) >> 16,
489 (be32_to_cpu(adsp1_alg
[i
].alg
.ver
) & 0xff00) >> 8,
490 be32_to_cpu(adsp1_alg
[i
].alg
.ver
) & 0xff);
494 adsp_info(dsp
, "%d: ID %x v%d.%d.%d\n",
495 i
, be32_to_cpu(adsp2_alg
[i
].alg
.id
),
496 (be32_to_cpu(adsp2_alg
[i
].alg
.ver
) & 0xff0000) >> 16,
497 (be32_to_cpu(adsp2_alg
[i
].alg
.ver
) & 0xff00) >> 8,
498 be32_to_cpu(adsp2_alg
[i
].alg
.ver
) & 0xff);
508 static int wm_adsp_load_coeff(struct wm_adsp
*dsp
)
510 struct regmap
*regmap
= dsp
->regmap
;
511 struct wmfw_coeff_hdr
*hdr
;
512 struct wmfw_coeff_item
*blk
;
513 const struct firmware
*firmware
;
514 const char *region_name
;
515 int ret
, pos
, blocks
, type
, offset
, reg
;
518 file
= kzalloc(PAGE_SIZE
, GFP_KERNEL
);
522 snprintf(file
, PAGE_SIZE
, "%s-dsp%d.bin", dsp
->part
, dsp
->num
);
523 file
[PAGE_SIZE
- 1] = '\0';
525 ret
= request_firmware(&firmware
, file
, dsp
->dev
);
527 adsp_warn(dsp
, "Failed to request '%s'\n", file
);
533 if (sizeof(*hdr
) >= firmware
->size
) {
534 adsp_err(dsp
, "%s: file too short, %zu bytes\n",
535 file
, firmware
->size
);
539 hdr
= (void*)&firmware
->data
[0];
540 if (memcmp(hdr
->magic
, "WMDR", 4) != 0) {
541 adsp_err(dsp
, "%s: invalid magic\n", file
);
545 adsp_dbg(dsp
, "%s: v%d.%d.%d\n", file
,
546 (le32_to_cpu(hdr
->ver
) >> 16) & 0xff,
547 (le32_to_cpu(hdr
->ver
) >> 8) & 0xff,
548 le32_to_cpu(hdr
->ver
) & 0xff);
550 pos
= le32_to_cpu(hdr
->len
);
553 while (pos
< firmware
->size
&&
554 pos
- firmware
->size
> sizeof(*blk
)) {
555 blk
= (void*)(&firmware
->data
[pos
]);
557 type
= be32_to_cpu(blk
->type
) & 0xff;
558 offset
= le32_to_cpu(blk
->offset
) & 0xffffff;
560 adsp_dbg(dsp
, "%s.%d: %x v%d.%d.%d\n",
561 file
, blocks
, le32_to_cpu(blk
->id
),
562 (le32_to_cpu(blk
->ver
) >> 16) & 0xff,
563 (le32_to_cpu(blk
->ver
) >> 8) & 0xff,
564 le32_to_cpu(blk
->ver
) & 0xff);
565 adsp_dbg(dsp
, "%s.%d: %d bytes at 0x%x in %x\n",
566 file
, blocks
, le32_to_cpu(blk
->len
), offset
, type
);
569 region_name
= "Unknown";
575 region_name
= "register";
579 adsp_err(dsp
, "Unknown region type %x\n", type
);
584 ret
= regmap_raw_write(regmap
, reg
, blk
->data
,
585 le32_to_cpu(blk
->len
));
588 "%s.%d: Failed to write to %x in %s\n",
589 file
, blocks
, reg
, region_name
);
593 pos
+= le32_to_cpu(blk
->len
) + sizeof(*blk
);
597 if (pos
> firmware
->size
)
598 adsp_warn(dsp
, "%s.%d: %zu bytes at end of file\n",
599 file
, blocks
, pos
- firmware
->size
);
602 release_firmware(firmware
);
608 int wm_adsp1_event(struct snd_soc_dapm_widget
*w
,
609 struct snd_kcontrol
*kcontrol
,
612 struct snd_soc_codec
*codec
= w
->codec
;
613 struct wm_adsp
*dsps
= snd_soc_codec_get_drvdata(codec
);
614 struct wm_adsp
*dsp
= &dsps
[w
->shift
];
618 case SND_SOC_DAPM_POST_PMU
:
619 regmap_update_bits(dsp
->regmap
, dsp
->base
+ ADSP1_CONTROL_30
,
620 ADSP1_SYS_ENA
, ADSP1_SYS_ENA
);
622 ret
= wm_adsp_load(dsp
);
626 ret
= wm_adsp_setup_algs(dsp
);
630 ret
= wm_adsp_load_coeff(dsp
);
634 /* Start the core running */
635 regmap_update_bits(dsp
->regmap
, dsp
->base
+ ADSP1_CONTROL_30
,
636 ADSP1_CORE_ENA
| ADSP1_START
,
637 ADSP1_CORE_ENA
| ADSP1_START
);
640 case SND_SOC_DAPM_PRE_PMD
:
642 regmap_update_bits(dsp
->regmap
, dsp
->base
+ ADSP1_CONTROL_30
,
643 ADSP1_CORE_ENA
| ADSP1_START
, 0);
645 regmap_update_bits(dsp
->regmap
, dsp
->base
+ ADSP1_CONTROL_19
,
646 ADSP1_WDMA_BUFFER_LENGTH_MASK
, 0);
648 regmap_update_bits(dsp
->regmap
, dsp
->base
+ ADSP1_CONTROL_30
,
659 regmap_update_bits(dsp
->regmap
, dsp
->base
+ ADSP1_CONTROL_30
,
663 EXPORT_SYMBOL_GPL(wm_adsp1_event
);
665 static int wm_adsp2_ena(struct wm_adsp
*dsp
)
670 ret
= regmap_update_bits(dsp
->regmap
, dsp
->base
+ ADSP2_CONTROL
,
671 ADSP2_SYS_ENA
, ADSP2_SYS_ENA
);
675 /* Wait for the RAM to start, should be near instantaneous */
678 ret
= regmap_read(dsp
->regmap
, dsp
->base
+ ADSP2_STATUS1
,
682 } while (!(val
& ADSP2_RAM_RDY
) && ++count
< 10);
684 if (!(val
& ADSP2_RAM_RDY
)) {
685 adsp_err(dsp
, "Failed to start DSP RAM\n");
689 adsp_dbg(dsp
, "RAM ready after %d polls\n", count
);
690 adsp_info(dsp
, "RAM ready after %d polls\n", count
);
695 int wm_adsp2_event(struct snd_soc_dapm_widget
*w
,
696 struct snd_kcontrol
*kcontrol
, int event
)
698 struct snd_soc_codec
*codec
= w
->codec
;
699 struct wm_adsp
*dsps
= snd_soc_codec_get_drvdata(codec
);
700 struct wm_adsp
*dsp
= &dsps
[w
->shift
];
705 case SND_SOC_DAPM_POST_PMU
:
707 * For simplicity set the DSP clock rate to be the
708 * SYSCLK rate rather than making it configurable.
710 ret
= regmap_read(dsp
->regmap
, ARIZONA_SYSTEM_CLOCK_1
, &val
);
712 adsp_err(dsp
, "Failed to read SYSCLK state: %d\n",
716 val
= (val
& ARIZONA_SYSCLK_FREQ_MASK
)
717 >> ARIZONA_SYSCLK_FREQ_SHIFT
;
719 ret
= regmap_update_bits(dsp
->regmap
,
720 dsp
->base
+ ADSP2_CLOCKING
,
721 ADSP2_CLK_SEL_MASK
, val
);
723 adsp_err(dsp
, "Failed to set clock rate: %d\n",
729 ret
= regmap_read(dsp
->regmap
,
730 dsp
->base
+ ADSP2_CLOCKING
, &val
);
733 "Failed to read clocking: %d\n", ret
);
737 if ((val
& ADSP2_CLK_SEL_MASK
) >= 3) {
738 ret
= regulator_enable(dsp
->dvfs
);
741 "Failed to enable supply: %d\n",
746 ret
= regulator_set_voltage(dsp
->dvfs
,
751 "Failed to raise supply: %d\n",
758 ret
= wm_adsp2_ena(dsp
);
762 ret
= wm_adsp_load(dsp
);
766 ret
= wm_adsp_setup_algs(dsp
);
770 ret
= wm_adsp_load_coeff(dsp
);
774 ret
= regmap_update_bits(dsp
->regmap
,
775 dsp
->base
+ ADSP2_CONTROL
,
776 ADSP2_CORE_ENA
| ADSP2_START
,
777 ADSP2_CORE_ENA
| ADSP2_START
);
782 case SND_SOC_DAPM_PRE_PMD
:
783 regmap_update_bits(dsp
->regmap
, dsp
->base
+ ADSP2_CONTROL
,
784 ADSP2_SYS_ENA
| ADSP2_CORE_ENA
|
788 ret
= regulator_set_voltage(dsp
->dvfs
, 1200000,
792 "Failed to lower supply: %d\n",
795 ret
= regulator_disable(dsp
->dvfs
);
798 "Failed to enable supply: %d\n",
809 regmap_update_bits(dsp
->regmap
, dsp
->base
+ ADSP2_CONTROL
,
810 ADSP2_SYS_ENA
| ADSP2_CORE_ENA
| ADSP2_START
, 0);
813 EXPORT_SYMBOL_GPL(wm_adsp2_event
);
815 int wm_adsp2_init(struct wm_adsp
*adsp
, bool dvfs
)
820 * Disable the DSP memory by default when in reset for a small
823 ret
= regmap_update_bits(adsp
->regmap
, adsp
->base
+ ADSP2_CONTROL
,
826 adsp_err(adsp
, "Failed to clear memory retention: %d\n", ret
);
831 adsp
->dvfs
= devm_regulator_get(adsp
->dev
, "DCVDD");
832 if (IS_ERR(adsp
->dvfs
)) {
833 ret
= PTR_ERR(adsp
->dvfs
);
834 dev_err(adsp
->dev
, "Failed to get DCVDD: %d\n", ret
);
838 ret
= regulator_enable(adsp
->dvfs
);
840 dev_err(adsp
->dev
, "Failed to enable DCVDD: %d\n",
845 ret
= regulator_set_voltage(adsp
->dvfs
, 1200000, 1800000);
847 dev_err(adsp
->dev
, "Failed to initialise DVFS: %d\n",
852 ret
= regulator_disable(adsp
->dvfs
);
854 dev_err(adsp
->dev
, "Failed to disable DCVDD: %d\n",
862 EXPORT_SYMBOL_GPL(wm_adsp2_init
);