1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * cnl-sst-dsp.c - CNL SST library generic function
4 *
5 * Copyright (C) 2016-17, Intel Corporation.
6 * Author: Guneshwor Singh <guneshwor.o.singh@intel.com>
7 *
8 * Modified from:
9 * SKL SST library generic function
10 * Copyright (C) 2014-15, Intel Corporation.
11 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
12 *
13 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
14 */
15 #include <linux/device.h>
16 #include "../common/sst-dsp.h"
17 #include "../common/sst-ipc.h"
18 #include "../common/sst-dsp-priv.h"
19 #include "cnl-sst-dsp.h"
20
21 /* various timeout values */
22 #define CNL_DSP_PU_TO 50
23 #define CNL_DSP_PD_TO 50
24 #define CNL_DSP_RESET_TO 50
25
26 static int
cnl_dsp_core_set_reset_state(struct sst_dsp * ctx,unsigned int core_mask)27 cnl_dsp_core_set_reset_state(struct sst_dsp *ctx, unsigned int core_mask)
28 {
29 /* update bits */
30 sst_dsp_shim_update_bits_unlocked(ctx,
31 CNL_ADSP_REG_ADSPCS, CNL_ADSPCS_CRST(core_mask),
32 CNL_ADSPCS_CRST(core_mask));
33
34 /* poll with timeout to check if operation successful */
35 return sst_dsp_register_poll(ctx,
36 CNL_ADSP_REG_ADSPCS,
37 CNL_ADSPCS_CRST(core_mask),
38 CNL_ADSPCS_CRST(core_mask),
39 CNL_DSP_RESET_TO,
40 "Set reset");
41 }
42
43 static int
cnl_dsp_core_unset_reset_state(struct sst_dsp * ctx,unsigned int core_mask)44 cnl_dsp_core_unset_reset_state(struct sst_dsp *ctx, unsigned int core_mask)
45 {
46 /* update bits */
47 sst_dsp_shim_update_bits_unlocked(ctx, CNL_ADSP_REG_ADSPCS,
48 CNL_ADSPCS_CRST(core_mask), 0);
49
50 /* poll with timeout to check if operation successful */
51 return sst_dsp_register_poll(ctx,
52 CNL_ADSP_REG_ADSPCS,
53 CNL_ADSPCS_CRST(core_mask),
54 0,
55 CNL_DSP_RESET_TO,
56 "Unset reset");
57 }
58
is_cnl_dsp_core_enable(struct sst_dsp * ctx,unsigned int core_mask)59 static bool is_cnl_dsp_core_enable(struct sst_dsp *ctx, unsigned int core_mask)
60 {
61 int val;
62 bool is_enable;
63
64 val = sst_dsp_shim_read_unlocked(ctx, CNL_ADSP_REG_ADSPCS);
65
66 is_enable = (val & CNL_ADSPCS_CPA(core_mask)) &&
67 (val & CNL_ADSPCS_SPA(core_mask)) &&
68 !(val & CNL_ADSPCS_CRST(core_mask)) &&
69 !(val & CNL_ADSPCS_CSTALL(core_mask));
70
71 dev_dbg(ctx->dev, "DSP core(s) enabled? %d: core_mask %#x\n",
72 is_enable, core_mask);
73
74 return is_enable;
75 }
76
cnl_dsp_reset_core(struct sst_dsp * ctx,unsigned int core_mask)77 static int cnl_dsp_reset_core(struct sst_dsp *ctx, unsigned int core_mask)
78 {
79 /* stall core */
80 sst_dsp_shim_update_bits_unlocked(ctx, CNL_ADSP_REG_ADSPCS,
81 CNL_ADSPCS_CSTALL(core_mask),
82 CNL_ADSPCS_CSTALL(core_mask));
83
84 /* set reset state */
85 return cnl_dsp_core_set_reset_state(ctx, core_mask);
86 }
87
cnl_dsp_start_core(struct sst_dsp * ctx,unsigned int core_mask)88 static int cnl_dsp_start_core(struct sst_dsp *ctx, unsigned int core_mask)
89 {
90 int ret;
91
92 /* unset reset state */
93 ret = cnl_dsp_core_unset_reset_state(ctx, core_mask);
94 if (ret < 0)
95 return ret;
96
97 /* run core */
98 sst_dsp_shim_update_bits_unlocked(ctx, CNL_ADSP_REG_ADSPCS,
99 CNL_ADSPCS_CSTALL(core_mask), 0);
100
101 if (!is_cnl_dsp_core_enable(ctx, core_mask)) {
102 cnl_dsp_reset_core(ctx, core_mask);
103 dev_err(ctx->dev, "DSP core mask %#x enable failed\n",
104 core_mask);
105 ret = -EIO;
106 }
107
108 return ret;
109 }
110
cnl_dsp_core_power_up(struct sst_dsp * ctx,unsigned int core_mask)111 static int cnl_dsp_core_power_up(struct sst_dsp *ctx, unsigned int core_mask)
112 {
113 /* update bits */
114 sst_dsp_shim_update_bits_unlocked(ctx, CNL_ADSP_REG_ADSPCS,
115 CNL_ADSPCS_SPA(core_mask),
116 CNL_ADSPCS_SPA(core_mask));
117
118 /* poll with timeout to check if operation successful */
119 return sst_dsp_register_poll(ctx, CNL_ADSP_REG_ADSPCS,
120 CNL_ADSPCS_CPA(core_mask),
121 CNL_ADSPCS_CPA(core_mask),
122 CNL_DSP_PU_TO,
123 "Power up");
124 }
125
cnl_dsp_core_power_down(struct sst_dsp * ctx,unsigned int core_mask)126 static int cnl_dsp_core_power_down(struct sst_dsp *ctx, unsigned int core_mask)
127 {
128 /* update bits */
129 sst_dsp_shim_update_bits_unlocked(ctx, CNL_ADSP_REG_ADSPCS,
130 CNL_ADSPCS_SPA(core_mask), 0);
131
132 /* poll with timeout to check if operation successful */
133 return sst_dsp_register_poll(ctx,
134 CNL_ADSP_REG_ADSPCS,
135 CNL_ADSPCS_CPA(core_mask),
136 0,
137 CNL_DSP_PD_TO,
138 "Power down");
139 }
140
cnl_dsp_enable_core(struct sst_dsp * ctx,unsigned int core_mask)141 int cnl_dsp_enable_core(struct sst_dsp *ctx, unsigned int core_mask)
142 {
143 int ret;
144
145 /* power up */
146 ret = cnl_dsp_core_power_up(ctx, core_mask);
147 if (ret < 0) {
148 dev_dbg(ctx->dev, "DSP core mask %#x power up failed",
149 core_mask);
150 return ret;
151 }
152
153 return cnl_dsp_start_core(ctx, core_mask);
154 }
155
cnl_dsp_disable_core(struct sst_dsp * ctx,unsigned int core_mask)156 int cnl_dsp_disable_core(struct sst_dsp *ctx, unsigned int core_mask)
157 {
158 int ret;
159
160 ret = cnl_dsp_reset_core(ctx, core_mask);
161 if (ret < 0) {
162 dev_err(ctx->dev, "DSP core mask %#x reset failed\n",
163 core_mask);
164 return ret;
165 }
166
167 /* power down core*/
168 ret = cnl_dsp_core_power_down(ctx, core_mask);
169 if (ret < 0) {
170 dev_err(ctx->dev, "DSP core mask %#x power down failed\n",
171 core_mask);
172 return ret;
173 }
174
175 if (is_cnl_dsp_core_enable(ctx, core_mask)) {
176 dev_err(ctx->dev, "DSP core mask %#x disable failed\n",
177 core_mask);
178 ret = -EIO;
179 }
180
181 return ret;
182 }
183
cnl_dsp_sst_interrupt(int irq,void * dev_id)184 irqreturn_t cnl_dsp_sst_interrupt(int irq, void *dev_id)
185 {
186 struct sst_dsp *ctx = dev_id;
187 u32 val;
188 irqreturn_t ret = IRQ_NONE;
189
190 spin_lock(&ctx->spinlock);
191
192 val = sst_dsp_shim_read_unlocked(ctx, CNL_ADSP_REG_ADSPIS);
193 ctx->intr_status = val;
194
195 if (val == 0xffffffff) {
196 spin_unlock(&ctx->spinlock);
197 return IRQ_NONE;
198 }
199
200 if (val & CNL_ADSPIS_IPC) {
201 cnl_ipc_int_disable(ctx);
202 ret = IRQ_WAKE_THREAD;
203 }
204
205 spin_unlock(&ctx->spinlock);
206
207 return ret;
208 }
209
cnl_dsp_free(struct sst_dsp * dsp)210 void cnl_dsp_free(struct sst_dsp *dsp)
211 {
212 cnl_ipc_int_disable(dsp);
213
214 free_irq(dsp->irq, dsp);
215 cnl_ipc_op_int_disable(dsp);
216 cnl_dsp_disable_core(dsp, SKL_DSP_CORE0_MASK);
217 }
218 EXPORT_SYMBOL_GPL(cnl_dsp_free);
219
cnl_ipc_int_enable(struct sst_dsp * ctx)220 void cnl_ipc_int_enable(struct sst_dsp *ctx)
221 {
222 sst_dsp_shim_update_bits(ctx, CNL_ADSP_REG_ADSPIC,
223 CNL_ADSPIC_IPC, CNL_ADSPIC_IPC);
224 }
225
cnl_ipc_int_disable(struct sst_dsp * ctx)226 void cnl_ipc_int_disable(struct sst_dsp *ctx)
227 {
228 sst_dsp_shim_update_bits_unlocked(ctx, CNL_ADSP_REG_ADSPIC,
229 CNL_ADSPIC_IPC, 0);
230 }
231
cnl_ipc_op_int_enable(struct sst_dsp * ctx)232 void cnl_ipc_op_int_enable(struct sst_dsp *ctx)
233 {
234 /* enable IPC DONE interrupt */
235 sst_dsp_shim_update_bits(ctx, CNL_ADSP_REG_HIPCCTL,
236 CNL_ADSP_REG_HIPCCTL_DONE,
237 CNL_ADSP_REG_HIPCCTL_DONE);
238
239 /* enable IPC BUSY interrupt */
240 sst_dsp_shim_update_bits(ctx, CNL_ADSP_REG_HIPCCTL,
241 CNL_ADSP_REG_HIPCCTL_BUSY,
242 CNL_ADSP_REG_HIPCCTL_BUSY);
243 }
244
cnl_ipc_op_int_disable(struct sst_dsp * ctx)245 void cnl_ipc_op_int_disable(struct sst_dsp *ctx)
246 {
247 /* disable IPC DONE interrupt */
248 sst_dsp_shim_update_bits(ctx, CNL_ADSP_REG_HIPCCTL,
249 CNL_ADSP_REG_HIPCCTL_DONE, 0);
250
251 /* disable IPC BUSY interrupt */
252 sst_dsp_shim_update_bits(ctx, CNL_ADSP_REG_HIPCCTL,
253 CNL_ADSP_REG_HIPCCTL_BUSY, 0);
254 }
255
cnl_ipc_int_status(struct sst_dsp * ctx)256 bool cnl_ipc_int_status(struct sst_dsp *ctx)
257 {
258 return sst_dsp_shim_read_unlocked(ctx, CNL_ADSP_REG_ADSPIS) &
259 CNL_ADSPIS_IPC;
260 }
261
cnl_ipc_free(struct sst_generic_ipc * ipc)262 void cnl_ipc_free(struct sst_generic_ipc *ipc)
263 {
264 cnl_ipc_op_int_disable(ipc->dsp);
265 sst_ipc_fini(ipc);
266 }
267