1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Load Analog Devices SigmaStudio firmware files
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright 2009-2014 Analog Devices Inc.
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <linux/crc32.h>
9*4882a593Smuzhiyun #include <linux/firmware.h>
10*4882a593Smuzhiyun #include <linux/kernel.h>
11*4882a593Smuzhiyun #include <linux/i2c.h>
12*4882a593Smuzhiyun #include <linux/regmap.h>
13*4882a593Smuzhiyun #include <linux/module.h>
14*4882a593Smuzhiyun #include <linux/slab.h>
15*4882a593Smuzhiyun
16*4882a593Smuzhiyun #include <sound/control.h>
17*4882a593Smuzhiyun #include <sound/soc.h>
18*4882a593Smuzhiyun
19*4882a593Smuzhiyun #include "sigmadsp.h"
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun #define SIGMA_MAGIC "ADISIGM"
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun #define SIGMA_FW_CHUNK_TYPE_DATA 0
24*4882a593Smuzhiyun #define SIGMA_FW_CHUNK_TYPE_CONTROL 1
25*4882a593Smuzhiyun #define SIGMA_FW_CHUNK_TYPE_SAMPLERATES 2
26*4882a593Smuzhiyun
27*4882a593Smuzhiyun struct sigmadsp_control {
28*4882a593Smuzhiyun struct list_head head;
29*4882a593Smuzhiyun uint32_t samplerates;
30*4882a593Smuzhiyun unsigned int addr;
31*4882a593Smuzhiyun unsigned int num_bytes;
32*4882a593Smuzhiyun const char *name;
33*4882a593Smuzhiyun struct snd_kcontrol *kcontrol;
34*4882a593Smuzhiyun bool cached;
35*4882a593Smuzhiyun uint8_t cache[];
36*4882a593Smuzhiyun };
37*4882a593Smuzhiyun
38*4882a593Smuzhiyun struct sigmadsp_data {
39*4882a593Smuzhiyun struct list_head head;
40*4882a593Smuzhiyun uint32_t samplerates;
41*4882a593Smuzhiyun unsigned int addr;
42*4882a593Smuzhiyun unsigned int length;
43*4882a593Smuzhiyun uint8_t data[];
44*4882a593Smuzhiyun };
45*4882a593Smuzhiyun
46*4882a593Smuzhiyun struct sigma_fw_chunk {
47*4882a593Smuzhiyun __le32 length;
48*4882a593Smuzhiyun __le32 tag;
49*4882a593Smuzhiyun __le32 samplerates;
50*4882a593Smuzhiyun } __packed;
51*4882a593Smuzhiyun
52*4882a593Smuzhiyun struct sigma_fw_chunk_data {
53*4882a593Smuzhiyun struct sigma_fw_chunk chunk;
54*4882a593Smuzhiyun __le16 addr;
55*4882a593Smuzhiyun uint8_t data[];
56*4882a593Smuzhiyun } __packed;
57*4882a593Smuzhiyun
58*4882a593Smuzhiyun struct sigma_fw_chunk_control {
59*4882a593Smuzhiyun struct sigma_fw_chunk chunk;
60*4882a593Smuzhiyun __le16 type;
61*4882a593Smuzhiyun __le16 addr;
62*4882a593Smuzhiyun __le16 num_bytes;
63*4882a593Smuzhiyun const char name[];
64*4882a593Smuzhiyun } __packed;
65*4882a593Smuzhiyun
66*4882a593Smuzhiyun struct sigma_fw_chunk_samplerate {
67*4882a593Smuzhiyun struct sigma_fw_chunk chunk;
68*4882a593Smuzhiyun __le32 samplerates[];
69*4882a593Smuzhiyun } __packed;
70*4882a593Smuzhiyun
71*4882a593Smuzhiyun struct sigma_firmware_header {
72*4882a593Smuzhiyun unsigned char magic[7];
73*4882a593Smuzhiyun u8 version;
74*4882a593Smuzhiyun __le32 crc;
75*4882a593Smuzhiyun } __packed;
76*4882a593Smuzhiyun
77*4882a593Smuzhiyun enum {
78*4882a593Smuzhiyun SIGMA_ACTION_WRITEXBYTES = 0,
79*4882a593Smuzhiyun SIGMA_ACTION_WRITESINGLE,
80*4882a593Smuzhiyun SIGMA_ACTION_WRITESAFELOAD,
81*4882a593Smuzhiyun SIGMA_ACTION_END,
82*4882a593Smuzhiyun };
83*4882a593Smuzhiyun
84*4882a593Smuzhiyun struct sigma_action {
85*4882a593Smuzhiyun u8 instr;
86*4882a593Smuzhiyun u8 len_hi;
87*4882a593Smuzhiyun __le16 len;
88*4882a593Smuzhiyun __be16 addr;
89*4882a593Smuzhiyun unsigned char payload[];
90*4882a593Smuzhiyun } __packed;
91*4882a593Smuzhiyun
sigmadsp_write(struct sigmadsp * sigmadsp,unsigned int addr,const uint8_t data[],size_t len)92*4882a593Smuzhiyun static int sigmadsp_write(struct sigmadsp *sigmadsp, unsigned int addr,
93*4882a593Smuzhiyun const uint8_t data[], size_t len)
94*4882a593Smuzhiyun {
95*4882a593Smuzhiyun return sigmadsp->write(sigmadsp->control_data, addr, data, len);
96*4882a593Smuzhiyun }
97*4882a593Smuzhiyun
sigmadsp_read(struct sigmadsp * sigmadsp,unsigned int addr,uint8_t data[],size_t len)98*4882a593Smuzhiyun static int sigmadsp_read(struct sigmadsp *sigmadsp, unsigned int addr,
99*4882a593Smuzhiyun uint8_t data[], size_t len)
100*4882a593Smuzhiyun {
101*4882a593Smuzhiyun return sigmadsp->read(sigmadsp->control_data, addr, data, len);
102*4882a593Smuzhiyun }
103*4882a593Smuzhiyun
sigmadsp_ctrl_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * info)104*4882a593Smuzhiyun static int sigmadsp_ctrl_info(struct snd_kcontrol *kcontrol,
105*4882a593Smuzhiyun struct snd_ctl_elem_info *info)
106*4882a593Smuzhiyun {
107*4882a593Smuzhiyun struct sigmadsp_control *ctrl = (void *)kcontrol->private_value;
108*4882a593Smuzhiyun
109*4882a593Smuzhiyun info->type = SNDRV_CTL_ELEM_TYPE_BYTES;
110*4882a593Smuzhiyun info->count = ctrl->num_bytes;
111*4882a593Smuzhiyun
112*4882a593Smuzhiyun return 0;
113*4882a593Smuzhiyun }
114*4882a593Smuzhiyun
sigmadsp_ctrl_write(struct sigmadsp * sigmadsp,struct sigmadsp_control * ctrl,void * data)115*4882a593Smuzhiyun static int sigmadsp_ctrl_write(struct sigmadsp *sigmadsp,
116*4882a593Smuzhiyun struct sigmadsp_control *ctrl, void *data)
117*4882a593Smuzhiyun {
118*4882a593Smuzhiyun /* safeload loads up to 20 bytes in a atomic operation */
119*4882a593Smuzhiyun if (ctrl->num_bytes <= 20 && sigmadsp->ops && sigmadsp->ops->safeload)
120*4882a593Smuzhiyun return sigmadsp->ops->safeload(sigmadsp, ctrl->addr, data,
121*4882a593Smuzhiyun ctrl->num_bytes);
122*4882a593Smuzhiyun else
123*4882a593Smuzhiyun return sigmadsp_write(sigmadsp, ctrl->addr, data,
124*4882a593Smuzhiyun ctrl->num_bytes);
125*4882a593Smuzhiyun }
126*4882a593Smuzhiyun
sigmadsp_ctrl_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)127*4882a593Smuzhiyun static int sigmadsp_ctrl_put(struct snd_kcontrol *kcontrol,
128*4882a593Smuzhiyun struct snd_ctl_elem_value *ucontrol)
129*4882a593Smuzhiyun {
130*4882a593Smuzhiyun struct sigmadsp_control *ctrl = (void *)kcontrol->private_value;
131*4882a593Smuzhiyun struct sigmadsp *sigmadsp = snd_kcontrol_chip(kcontrol);
132*4882a593Smuzhiyun uint8_t *data;
133*4882a593Smuzhiyun int ret = 0;
134*4882a593Smuzhiyun
135*4882a593Smuzhiyun mutex_lock(&sigmadsp->lock);
136*4882a593Smuzhiyun
137*4882a593Smuzhiyun data = ucontrol->value.bytes.data;
138*4882a593Smuzhiyun
139*4882a593Smuzhiyun if (!(kcontrol->vd[0].access & SNDRV_CTL_ELEM_ACCESS_INACTIVE))
140*4882a593Smuzhiyun ret = sigmadsp_ctrl_write(sigmadsp, ctrl, data);
141*4882a593Smuzhiyun
142*4882a593Smuzhiyun if (ret == 0) {
143*4882a593Smuzhiyun memcpy(ctrl->cache, data, ctrl->num_bytes);
144*4882a593Smuzhiyun ctrl->cached = true;
145*4882a593Smuzhiyun }
146*4882a593Smuzhiyun
147*4882a593Smuzhiyun mutex_unlock(&sigmadsp->lock);
148*4882a593Smuzhiyun
149*4882a593Smuzhiyun return ret;
150*4882a593Smuzhiyun }
151*4882a593Smuzhiyun
sigmadsp_ctrl_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)152*4882a593Smuzhiyun static int sigmadsp_ctrl_get(struct snd_kcontrol *kcontrol,
153*4882a593Smuzhiyun struct snd_ctl_elem_value *ucontrol)
154*4882a593Smuzhiyun {
155*4882a593Smuzhiyun struct sigmadsp_control *ctrl = (void *)kcontrol->private_value;
156*4882a593Smuzhiyun struct sigmadsp *sigmadsp = snd_kcontrol_chip(kcontrol);
157*4882a593Smuzhiyun int ret = 0;
158*4882a593Smuzhiyun
159*4882a593Smuzhiyun mutex_lock(&sigmadsp->lock);
160*4882a593Smuzhiyun
161*4882a593Smuzhiyun if (!ctrl->cached) {
162*4882a593Smuzhiyun ret = sigmadsp_read(sigmadsp, ctrl->addr, ctrl->cache,
163*4882a593Smuzhiyun ctrl->num_bytes);
164*4882a593Smuzhiyun }
165*4882a593Smuzhiyun
166*4882a593Smuzhiyun if (ret == 0) {
167*4882a593Smuzhiyun ctrl->cached = true;
168*4882a593Smuzhiyun memcpy(ucontrol->value.bytes.data, ctrl->cache,
169*4882a593Smuzhiyun ctrl->num_bytes);
170*4882a593Smuzhiyun }
171*4882a593Smuzhiyun
172*4882a593Smuzhiyun mutex_unlock(&sigmadsp->lock);
173*4882a593Smuzhiyun
174*4882a593Smuzhiyun return ret;
175*4882a593Smuzhiyun }
176*4882a593Smuzhiyun
sigmadsp_control_free(struct snd_kcontrol * kcontrol)177*4882a593Smuzhiyun static void sigmadsp_control_free(struct snd_kcontrol *kcontrol)
178*4882a593Smuzhiyun {
179*4882a593Smuzhiyun struct sigmadsp_control *ctrl = (void *)kcontrol->private_value;
180*4882a593Smuzhiyun
181*4882a593Smuzhiyun ctrl->kcontrol = NULL;
182*4882a593Smuzhiyun }
183*4882a593Smuzhiyun
sigma_fw_validate_control_name(const char * name,unsigned int len)184*4882a593Smuzhiyun static bool sigma_fw_validate_control_name(const char *name, unsigned int len)
185*4882a593Smuzhiyun {
186*4882a593Smuzhiyun unsigned int i;
187*4882a593Smuzhiyun
188*4882a593Smuzhiyun for (i = 0; i < len; i++) {
189*4882a593Smuzhiyun /* Normal ASCII characters are valid */
190*4882a593Smuzhiyun if (name[i] < ' ' || name[i] > '~')
191*4882a593Smuzhiyun return false;
192*4882a593Smuzhiyun }
193*4882a593Smuzhiyun
194*4882a593Smuzhiyun return true;
195*4882a593Smuzhiyun }
196*4882a593Smuzhiyun
sigma_fw_load_control(struct sigmadsp * sigmadsp,const struct sigma_fw_chunk * chunk,unsigned int length)197*4882a593Smuzhiyun static int sigma_fw_load_control(struct sigmadsp *sigmadsp,
198*4882a593Smuzhiyun const struct sigma_fw_chunk *chunk, unsigned int length)
199*4882a593Smuzhiyun {
200*4882a593Smuzhiyun const struct sigma_fw_chunk_control *ctrl_chunk;
201*4882a593Smuzhiyun struct sigmadsp_control *ctrl;
202*4882a593Smuzhiyun unsigned int num_bytes;
203*4882a593Smuzhiyun size_t name_len;
204*4882a593Smuzhiyun char *name;
205*4882a593Smuzhiyun int ret;
206*4882a593Smuzhiyun
207*4882a593Smuzhiyun if (length <= sizeof(*ctrl_chunk))
208*4882a593Smuzhiyun return -EINVAL;
209*4882a593Smuzhiyun
210*4882a593Smuzhiyun ctrl_chunk = (const struct sigma_fw_chunk_control *)chunk;
211*4882a593Smuzhiyun
212*4882a593Smuzhiyun name_len = length - sizeof(*ctrl_chunk);
213*4882a593Smuzhiyun if (name_len >= SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
214*4882a593Smuzhiyun name_len = SNDRV_CTL_ELEM_ID_NAME_MAXLEN - 1;
215*4882a593Smuzhiyun
216*4882a593Smuzhiyun /* Make sure there are no non-displayable characaters in the string */
217*4882a593Smuzhiyun if (!sigma_fw_validate_control_name(ctrl_chunk->name, name_len))
218*4882a593Smuzhiyun return -EINVAL;
219*4882a593Smuzhiyun
220*4882a593Smuzhiyun num_bytes = le16_to_cpu(ctrl_chunk->num_bytes);
221*4882a593Smuzhiyun ctrl = kzalloc(sizeof(*ctrl) + num_bytes, GFP_KERNEL);
222*4882a593Smuzhiyun if (!ctrl)
223*4882a593Smuzhiyun return -ENOMEM;
224*4882a593Smuzhiyun
225*4882a593Smuzhiyun name = kzalloc(name_len + 1, GFP_KERNEL);
226*4882a593Smuzhiyun if (!name) {
227*4882a593Smuzhiyun ret = -ENOMEM;
228*4882a593Smuzhiyun goto err_free_ctrl;
229*4882a593Smuzhiyun }
230*4882a593Smuzhiyun memcpy(name, ctrl_chunk->name, name_len);
231*4882a593Smuzhiyun name[name_len] = '\0';
232*4882a593Smuzhiyun ctrl->name = name;
233*4882a593Smuzhiyun
234*4882a593Smuzhiyun ctrl->addr = le16_to_cpu(ctrl_chunk->addr);
235*4882a593Smuzhiyun ctrl->num_bytes = num_bytes;
236*4882a593Smuzhiyun ctrl->samplerates = le32_to_cpu(chunk->samplerates);
237*4882a593Smuzhiyun
238*4882a593Smuzhiyun list_add_tail(&ctrl->head, &sigmadsp->ctrl_list);
239*4882a593Smuzhiyun
240*4882a593Smuzhiyun return 0;
241*4882a593Smuzhiyun
242*4882a593Smuzhiyun err_free_ctrl:
243*4882a593Smuzhiyun kfree(ctrl);
244*4882a593Smuzhiyun
245*4882a593Smuzhiyun return ret;
246*4882a593Smuzhiyun }
247*4882a593Smuzhiyun
sigma_fw_load_data(struct sigmadsp * sigmadsp,const struct sigma_fw_chunk * chunk,unsigned int length)248*4882a593Smuzhiyun static int sigma_fw_load_data(struct sigmadsp *sigmadsp,
249*4882a593Smuzhiyun const struct sigma_fw_chunk *chunk, unsigned int length)
250*4882a593Smuzhiyun {
251*4882a593Smuzhiyun const struct sigma_fw_chunk_data *data_chunk;
252*4882a593Smuzhiyun struct sigmadsp_data *data;
253*4882a593Smuzhiyun
254*4882a593Smuzhiyun if (length <= sizeof(*data_chunk))
255*4882a593Smuzhiyun return -EINVAL;
256*4882a593Smuzhiyun
257*4882a593Smuzhiyun data_chunk = (struct sigma_fw_chunk_data *)chunk;
258*4882a593Smuzhiyun
259*4882a593Smuzhiyun length -= sizeof(*data_chunk);
260*4882a593Smuzhiyun
261*4882a593Smuzhiyun data = kzalloc(sizeof(*data) + length, GFP_KERNEL);
262*4882a593Smuzhiyun if (!data)
263*4882a593Smuzhiyun return -ENOMEM;
264*4882a593Smuzhiyun
265*4882a593Smuzhiyun data->addr = le16_to_cpu(data_chunk->addr);
266*4882a593Smuzhiyun data->length = length;
267*4882a593Smuzhiyun data->samplerates = le32_to_cpu(chunk->samplerates);
268*4882a593Smuzhiyun memcpy(data->data, data_chunk->data, length);
269*4882a593Smuzhiyun list_add_tail(&data->head, &sigmadsp->data_list);
270*4882a593Smuzhiyun
271*4882a593Smuzhiyun return 0;
272*4882a593Smuzhiyun }
273*4882a593Smuzhiyun
sigma_fw_load_samplerates(struct sigmadsp * sigmadsp,const struct sigma_fw_chunk * chunk,unsigned int length)274*4882a593Smuzhiyun static int sigma_fw_load_samplerates(struct sigmadsp *sigmadsp,
275*4882a593Smuzhiyun const struct sigma_fw_chunk *chunk, unsigned int length)
276*4882a593Smuzhiyun {
277*4882a593Smuzhiyun const struct sigma_fw_chunk_samplerate *rate_chunk;
278*4882a593Smuzhiyun unsigned int num_rates;
279*4882a593Smuzhiyun unsigned int *rates;
280*4882a593Smuzhiyun unsigned int i;
281*4882a593Smuzhiyun
282*4882a593Smuzhiyun rate_chunk = (const struct sigma_fw_chunk_samplerate *)chunk;
283*4882a593Smuzhiyun
284*4882a593Smuzhiyun num_rates = (length - sizeof(*rate_chunk)) / sizeof(__le32);
285*4882a593Smuzhiyun
286*4882a593Smuzhiyun if (num_rates > 32 || num_rates == 0)
287*4882a593Smuzhiyun return -EINVAL;
288*4882a593Smuzhiyun
289*4882a593Smuzhiyun /* We only allow one samplerates block per file */
290*4882a593Smuzhiyun if (sigmadsp->rate_constraints.count)
291*4882a593Smuzhiyun return -EINVAL;
292*4882a593Smuzhiyun
293*4882a593Smuzhiyun rates = kcalloc(num_rates, sizeof(*rates), GFP_KERNEL);
294*4882a593Smuzhiyun if (!rates)
295*4882a593Smuzhiyun return -ENOMEM;
296*4882a593Smuzhiyun
297*4882a593Smuzhiyun for (i = 0; i < num_rates; i++)
298*4882a593Smuzhiyun rates[i] = le32_to_cpu(rate_chunk->samplerates[i]);
299*4882a593Smuzhiyun
300*4882a593Smuzhiyun sigmadsp->rate_constraints.count = num_rates;
301*4882a593Smuzhiyun sigmadsp->rate_constraints.list = rates;
302*4882a593Smuzhiyun
303*4882a593Smuzhiyun return 0;
304*4882a593Smuzhiyun }
305*4882a593Smuzhiyun
sigmadsp_fw_load_v2(struct sigmadsp * sigmadsp,const struct firmware * fw)306*4882a593Smuzhiyun static int sigmadsp_fw_load_v2(struct sigmadsp *sigmadsp,
307*4882a593Smuzhiyun const struct firmware *fw)
308*4882a593Smuzhiyun {
309*4882a593Smuzhiyun struct sigma_fw_chunk *chunk;
310*4882a593Smuzhiyun unsigned int length, pos;
311*4882a593Smuzhiyun int ret;
312*4882a593Smuzhiyun
313*4882a593Smuzhiyun /*
314*4882a593Smuzhiyun * Make sure that there is at least one chunk to avoid integer
315*4882a593Smuzhiyun * underflows later on. Empty firmware is still valid though.
316*4882a593Smuzhiyun */
317*4882a593Smuzhiyun if (fw->size < sizeof(*chunk) + sizeof(struct sigma_firmware_header))
318*4882a593Smuzhiyun return 0;
319*4882a593Smuzhiyun
320*4882a593Smuzhiyun pos = sizeof(struct sigma_firmware_header);
321*4882a593Smuzhiyun
322*4882a593Smuzhiyun while (pos < fw->size - sizeof(*chunk)) {
323*4882a593Smuzhiyun chunk = (struct sigma_fw_chunk *)(fw->data + pos);
324*4882a593Smuzhiyun
325*4882a593Smuzhiyun length = le32_to_cpu(chunk->length);
326*4882a593Smuzhiyun
327*4882a593Smuzhiyun if (length > fw->size - pos || length < sizeof(*chunk))
328*4882a593Smuzhiyun return -EINVAL;
329*4882a593Smuzhiyun
330*4882a593Smuzhiyun switch (le32_to_cpu(chunk->tag)) {
331*4882a593Smuzhiyun case SIGMA_FW_CHUNK_TYPE_DATA:
332*4882a593Smuzhiyun ret = sigma_fw_load_data(sigmadsp, chunk, length);
333*4882a593Smuzhiyun break;
334*4882a593Smuzhiyun case SIGMA_FW_CHUNK_TYPE_CONTROL:
335*4882a593Smuzhiyun ret = sigma_fw_load_control(sigmadsp, chunk, length);
336*4882a593Smuzhiyun break;
337*4882a593Smuzhiyun case SIGMA_FW_CHUNK_TYPE_SAMPLERATES:
338*4882a593Smuzhiyun ret = sigma_fw_load_samplerates(sigmadsp, chunk, length);
339*4882a593Smuzhiyun break;
340*4882a593Smuzhiyun default:
341*4882a593Smuzhiyun dev_warn(sigmadsp->dev, "Unknown chunk type: %d\n",
342*4882a593Smuzhiyun chunk->tag);
343*4882a593Smuzhiyun ret = 0;
344*4882a593Smuzhiyun break;
345*4882a593Smuzhiyun }
346*4882a593Smuzhiyun
347*4882a593Smuzhiyun if (ret)
348*4882a593Smuzhiyun return ret;
349*4882a593Smuzhiyun
350*4882a593Smuzhiyun /*
351*4882a593Smuzhiyun * This can not overflow since if length is larger than the
352*4882a593Smuzhiyun * maximum firmware size (0x4000000) we'll error out earilier.
353*4882a593Smuzhiyun */
354*4882a593Smuzhiyun pos += ALIGN(length, sizeof(__le32));
355*4882a593Smuzhiyun }
356*4882a593Smuzhiyun
357*4882a593Smuzhiyun return 0;
358*4882a593Smuzhiyun }
359*4882a593Smuzhiyun
sigma_action_len(struct sigma_action * sa)360*4882a593Smuzhiyun static inline u32 sigma_action_len(struct sigma_action *sa)
361*4882a593Smuzhiyun {
362*4882a593Smuzhiyun return (sa->len_hi << 16) | le16_to_cpu(sa->len);
363*4882a593Smuzhiyun }
364*4882a593Smuzhiyun
sigma_action_size(struct sigma_action * sa)365*4882a593Smuzhiyun static size_t sigma_action_size(struct sigma_action *sa)
366*4882a593Smuzhiyun {
367*4882a593Smuzhiyun size_t payload = 0;
368*4882a593Smuzhiyun
369*4882a593Smuzhiyun switch (sa->instr) {
370*4882a593Smuzhiyun case SIGMA_ACTION_WRITEXBYTES:
371*4882a593Smuzhiyun case SIGMA_ACTION_WRITESINGLE:
372*4882a593Smuzhiyun case SIGMA_ACTION_WRITESAFELOAD:
373*4882a593Smuzhiyun payload = sigma_action_len(sa);
374*4882a593Smuzhiyun break;
375*4882a593Smuzhiyun default:
376*4882a593Smuzhiyun break;
377*4882a593Smuzhiyun }
378*4882a593Smuzhiyun
379*4882a593Smuzhiyun payload = ALIGN(payload, 2);
380*4882a593Smuzhiyun
381*4882a593Smuzhiyun return payload + sizeof(struct sigma_action);
382*4882a593Smuzhiyun }
383*4882a593Smuzhiyun
384*4882a593Smuzhiyun /*
385*4882a593Smuzhiyun * Returns a negative error value in case of an error, 0 if processing of
386*4882a593Smuzhiyun * the firmware should be stopped after this action, 1 otherwise.
387*4882a593Smuzhiyun */
process_sigma_action(struct sigmadsp * sigmadsp,struct sigma_action * sa)388*4882a593Smuzhiyun static int process_sigma_action(struct sigmadsp *sigmadsp,
389*4882a593Smuzhiyun struct sigma_action *sa)
390*4882a593Smuzhiyun {
391*4882a593Smuzhiyun size_t len = sigma_action_len(sa);
392*4882a593Smuzhiyun struct sigmadsp_data *data;
393*4882a593Smuzhiyun
394*4882a593Smuzhiyun pr_debug("%s: instr:%i addr:%#x len:%zu\n", __func__,
395*4882a593Smuzhiyun sa->instr, sa->addr, len);
396*4882a593Smuzhiyun
397*4882a593Smuzhiyun switch (sa->instr) {
398*4882a593Smuzhiyun case SIGMA_ACTION_WRITEXBYTES:
399*4882a593Smuzhiyun case SIGMA_ACTION_WRITESINGLE:
400*4882a593Smuzhiyun case SIGMA_ACTION_WRITESAFELOAD:
401*4882a593Smuzhiyun if (len < 3)
402*4882a593Smuzhiyun return -EINVAL;
403*4882a593Smuzhiyun
404*4882a593Smuzhiyun data = kzalloc(sizeof(*data) + len - 2, GFP_KERNEL);
405*4882a593Smuzhiyun if (!data)
406*4882a593Smuzhiyun return -ENOMEM;
407*4882a593Smuzhiyun
408*4882a593Smuzhiyun data->addr = be16_to_cpu(sa->addr);
409*4882a593Smuzhiyun data->length = len - 2;
410*4882a593Smuzhiyun memcpy(data->data, sa->payload, data->length);
411*4882a593Smuzhiyun list_add_tail(&data->head, &sigmadsp->data_list);
412*4882a593Smuzhiyun break;
413*4882a593Smuzhiyun case SIGMA_ACTION_END:
414*4882a593Smuzhiyun return 0;
415*4882a593Smuzhiyun default:
416*4882a593Smuzhiyun return -EINVAL;
417*4882a593Smuzhiyun }
418*4882a593Smuzhiyun
419*4882a593Smuzhiyun return 1;
420*4882a593Smuzhiyun }
421*4882a593Smuzhiyun
sigmadsp_fw_load_v1(struct sigmadsp * sigmadsp,const struct firmware * fw)422*4882a593Smuzhiyun static int sigmadsp_fw_load_v1(struct sigmadsp *sigmadsp,
423*4882a593Smuzhiyun const struct firmware *fw)
424*4882a593Smuzhiyun {
425*4882a593Smuzhiyun struct sigma_action *sa;
426*4882a593Smuzhiyun size_t size, pos;
427*4882a593Smuzhiyun int ret;
428*4882a593Smuzhiyun
429*4882a593Smuzhiyun pos = sizeof(struct sigma_firmware_header);
430*4882a593Smuzhiyun
431*4882a593Smuzhiyun while (pos + sizeof(*sa) <= fw->size) {
432*4882a593Smuzhiyun sa = (struct sigma_action *)(fw->data + pos);
433*4882a593Smuzhiyun
434*4882a593Smuzhiyun size = sigma_action_size(sa);
435*4882a593Smuzhiyun pos += size;
436*4882a593Smuzhiyun if (pos > fw->size || size == 0)
437*4882a593Smuzhiyun break;
438*4882a593Smuzhiyun
439*4882a593Smuzhiyun ret = process_sigma_action(sigmadsp, sa);
440*4882a593Smuzhiyun
441*4882a593Smuzhiyun pr_debug("%s: action returned %i\n", __func__, ret);
442*4882a593Smuzhiyun
443*4882a593Smuzhiyun if (ret <= 0)
444*4882a593Smuzhiyun return ret;
445*4882a593Smuzhiyun }
446*4882a593Smuzhiyun
447*4882a593Smuzhiyun if (pos != fw->size)
448*4882a593Smuzhiyun return -EINVAL;
449*4882a593Smuzhiyun
450*4882a593Smuzhiyun return 0;
451*4882a593Smuzhiyun }
452*4882a593Smuzhiyun
sigmadsp_firmware_release(struct sigmadsp * sigmadsp)453*4882a593Smuzhiyun static void sigmadsp_firmware_release(struct sigmadsp *sigmadsp)
454*4882a593Smuzhiyun {
455*4882a593Smuzhiyun struct sigmadsp_control *ctrl, *_ctrl;
456*4882a593Smuzhiyun struct sigmadsp_data *data, *_data;
457*4882a593Smuzhiyun
458*4882a593Smuzhiyun list_for_each_entry_safe(ctrl, _ctrl, &sigmadsp->ctrl_list, head) {
459*4882a593Smuzhiyun kfree(ctrl->name);
460*4882a593Smuzhiyun kfree(ctrl);
461*4882a593Smuzhiyun }
462*4882a593Smuzhiyun
463*4882a593Smuzhiyun list_for_each_entry_safe(data, _data, &sigmadsp->data_list, head)
464*4882a593Smuzhiyun kfree(data);
465*4882a593Smuzhiyun
466*4882a593Smuzhiyun INIT_LIST_HEAD(&sigmadsp->ctrl_list);
467*4882a593Smuzhiyun INIT_LIST_HEAD(&sigmadsp->data_list);
468*4882a593Smuzhiyun }
469*4882a593Smuzhiyun
devm_sigmadsp_release(struct device * dev,void * res)470*4882a593Smuzhiyun static void devm_sigmadsp_release(struct device *dev, void *res)
471*4882a593Smuzhiyun {
472*4882a593Smuzhiyun sigmadsp_firmware_release((struct sigmadsp *)res);
473*4882a593Smuzhiyun }
474*4882a593Smuzhiyun
sigmadsp_firmware_load(struct sigmadsp * sigmadsp,const char * name)475*4882a593Smuzhiyun static int sigmadsp_firmware_load(struct sigmadsp *sigmadsp, const char *name)
476*4882a593Smuzhiyun {
477*4882a593Smuzhiyun const struct sigma_firmware_header *ssfw_head;
478*4882a593Smuzhiyun const struct firmware *fw;
479*4882a593Smuzhiyun int ret;
480*4882a593Smuzhiyun u32 crc;
481*4882a593Smuzhiyun
482*4882a593Smuzhiyun /* first load the blob */
483*4882a593Smuzhiyun ret = request_firmware(&fw, name, sigmadsp->dev);
484*4882a593Smuzhiyun if (ret) {
485*4882a593Smuzhiyun pr_debug("%s: request_firmware() failed with %i\n", __func__, ret);
486*4882a593Smuzhiyun goto done;
487*4882a593Smuzhiyun }
488*4882a593Smuzhiyun
489*4882a593Smuzhiyun /* then verify the header */
490*4882a593Smuzhiyun ret = -EINVAL;
491*4882a593Smuzhiyun
492*4882a593Smuzhiyun /*
493*4882a593Smuzhiyun * Reject too small or unreasonable large files. The upper limit has been
494*4882a593Smuzhiyun * chosen a bit arbitrarily, but it should be enough for all practical
495*4882a593Smuzhiyun * purposes and having the limit makes it easier to avoid integer
496*4882a593Smuzhiyun * overflows later in the loading process.
497*4882a593Smuzhiyun */
498*4882a593Smuzhiyun if (fw->size < sizeof(*ssfw_head) || fw->size >= 0x4000000) {
499*4882a593Smuzhiyun dev_err(sigmadsp->dev, "Failed to load firmware: Invalid size\n");
500*4882a593Smuzhiyun goto done;
501*4882a593Smuzhiyun }
502*4882a593Smuzhiyun
503*4882a593Smuzhiyun ssfw_head = (void *)fw->data;
504*4882a593Smuzhiyun if (memcmp(ssfw_head->magic, SIGMA_MAGIC, ARRAY_SIZE(ssfw_head->magic))) {
505*4882a593Smuzhiyun dev_err(sigmadsp->dev, "Failed to load firmware: Invalid magic\n");
506*4882a593Smuzhiyun goto done;
507*4882a593Smuzhiyun }
508*4882a593Smuzhiyun
509*4882a593Smuzhiyun crc = crc32(0, fw->data + sizeof(*ssfw_head),
510*4882a593Smuzhiyun fw->size - sizeof(*ssfw_head));
511*4882a593Smuzhiyun pr_debug("%s: crc=%x\n", __func__, crc);
512*4882a593Smuzhiyun if (crc != le32_to_cpu(ssfw_head->crc)) {
513*4882a593Smuzhiyun dev_err(sigmadsp->dev, "Failed to load firmware: Wrong crc checksum: expected %x got %x\n",
514*4882a593Smuzhiyun le32_to_cpu(ssfw_head->crc), crc);
515*4882a593Smuzhiyun goto done;
516*4882a593Smuzhiyun }
517*4882a593Smuzhiyun
518*4882a593Smuzhiyun switch (ssfw_head->version) {
519*4882a593Smuzhiyun case 1:
520*4882a593Smuzhiyun ret = sigmadsp_fw_load_v1(sigmadsp, fw);
521*4882a593Smuzhiyun break;
522*4882a593Smuzhiyun case 2:
523*4882a593Smuzhiyun ret = sigmadsp_fw_load_v2(sigmadsp, fw);
524*4882a593Smuzhiyun break;
525*4882a593Smuzhiyun default:
526*4882a593Smuzhiyun dev_err(sigmadsp->dev,
527*4882a593Smuzhiyun "Failed to load firmware: Invalid version %d. Supported firmware versions: 1, 2\n",
528*4882a593Smuzhiyun ssfw_head->version);
529*4882a593Smuzhiyun ret = -EINVAL;
530*4882a593Smuzhiyun break;
531*4882a593Smuzhiyun }
532*4882a593Smuzhiyun
533*4882a593Smuzhiyun if (ret)
534*4882a593Smuzhiyun sigmadsp_firmware_release(sigmadsp);
535*4882a593Smuzhiyun
536*4882a593Smuzhiyun done:
537*4882a593Smuzhiyun release_firmware(fw);
538*4882a593Smuzhiyun
539*4882a593Smuzhiyun return ret;
540*4882a593Smuzhiyun }
541*4882a593Smuzhiyun
sigmadsp_init(struct sigmadsp * sigmadsp,struct device * dev,const struct sigmadsp_ops * ops,const char * firmware_name)542*4882a593Smuzhiyun static int sigmadsp_init(struct sigmadsp *sigmadsp, struct device *dev,
543*4882a593Smuzhiyun const struct sigmadsp_ops *ops, const char *firmware_name)
544*4882a593Smuzhiyun {
545*4882a593Smuzhiyun sigmadsp->ops = ops;
546*4882a593Smuzhiyun sigmadsp->dev = dev;
547*4882a593Smuzhiyun
548*4882a593Smuzhiyun INIT_LIST_HEAD(&sigmadsp->ctrl_list);
549*4882a593Smuzhiyun INIT_LIST_HEAD(&sigmadsp->data_list);
550*4882a593Smuzhiyun mutex_init(&sigmadsp->lock);
551*4882a593Smuzhiyun
552*4882a593Smuzhiyun return sigmadsp_firmware_load(sigmadsp, firmware_name);
553*4882a593Smuzhiyun }
554*4882a593Smuzhiyun
555*4882a593Smuzhiyun /**
556*4882a593Smuzhiyun * devm_sigmadsp_init() - Initialize SigmaDSP instance
557*4882a593Smuzhiyun * @dev: The parent device
558*4882a593Smuzhiyun * @ops: The sigmadsp_ops to use for this instance
559*4882a593Smuzhiyun * @firmware_name: Name of the firmware file to load
560*4882a593Smuzhiyun *
561*4882a593Smuzhiyun * Allocates a SigmaDSP instance and loads the specified firmware file.
562*4882a593Smuzhiyun *
563*4882a593Smuzhiyun * Returns a pointer to a struct sigmadsp on success, or a PTR_ERR() on error.
564*4882a593Smuzhiyun */
devm_sigmadsp_init(struct device * dev,const struct sigmadsp_ops * ops,const char * firmware_name)565*4882a593Smuzhiyun struct sigmadsp *devm_sigmadsp_init(struct device *dev,
566*4882a593Smuzhiyun const struct sigmadsp_ops *ops, const char *firmware_name)
567*4882a593Smuzhiyun {
568*4882a593Smuzhiyun struct sigmadsp *sigmadsp;
569*4882a593Smuzhiyun int ret;
570*4882a593Smuzhiyun
571*4882a593Smuzhiyun sigmadsp = devres_alloc(devm_sigmadsp_release, sizeof(*sigmadsp),
572*4882a593Smuzhiyun GFP_KERNEL);
573*4882a593Smuzhiyun if (!sigmadsp)
574*4882a593Smuzhiyun return ERR_PTR(-ENOMEM);
575*4882a593Smuzhiyun
576*4882a593Smuzhiyun ret = sigmadsp_init(sigmadsp, dev, ops, firmware_name);
577*4882a593Smuzhiyun if (ret) {
578*4882a593Smuzhiyun devres_free(sigmadsp);
579*4882a593Smuzhiyun return ERR_PTR(ret);
580*4882a593Smuzhiyun }
581*4882a593Smuzhiyun
582*4882a593Smuzhiyun devres_add(dev, sigmadsp);
583*4882a593Smuzhiyun
584*4882a593Smuzhiyun return sigmadsp;
585*4882a593Smuzhiyun }
586*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(devm_sigmadsp_init);
587*4882a593Smuzhiyun
sigmadsp_rate_to_index(struct sigmadsp * sigmadsp,unsigned int rate)588*4882a593Smuzhiyun static int sigmadsp_rate_to_index(struct sigmadsp *sigmadsp, unsigned int rate)
589*4882a593Smuzhiyun {
590*4882a593Smuzhiyun unsigned int i;
591*4882a593Smuzhiyun
592*4882a593Smuzhiyun for (i = 0; i < sigmadsp->rate_constraints.count; i++) {
593*4882a593Smuzhiyun if (sigmadsp->rate_constraints.list[i] == rate)
594*4882a593Smuzhiyun return i;
595*4882a593Smuzhiyun }
596*4882a593Smuzhiyun
597*4882a593Smuzhiyun return -EINVAL;
598*4882a593Smuzhiyun }
599*4882a593Smuzhiyun
sigmadsp_get_samplerate_mask(struct sigmadsp * sigmadsp,unsigned int samplerate)600*4882a593Smuzhiyun static unsigned int sigmadsp_get_samplerate_mask(struct sigmadsp *sigmadsp,
601*4882a593Smuzhiyun unsigned int samplerate)
602*4882a593Smuzhiyun {
603*4882a593Smuzhiyun int samplerate_index;
604*4882a593Smuzhiyun
605*4882a593Smuzhiyun if (samplerate == 0)
606*4882a593Smuzhiyun return 0;
607*4882a593Smuzhiyun
608*4882a593Smuzhiyun if (sigmadsp->rate_constraints.count) {
609*4882a593Smuzhiyun samplerate_index = sigmadsp_rate_to_index(sigmadsp, samplerate);
610*4882a593Smuzhiyun if (samplerate_index < 0)
611*4882a593Smuzhiyun return 0;
612*4882a593Smuzhiyun
613*4882a593Smuzhiyun return BIT(samplerate_index);
614*4882a593Smuzhiyun } else {
615*4882a593Smuzhiyun return ~0;
616*4882a593Smuzhiyun }
617*4882a593Smuzhiyun }
618*4882a593Smuzhiyun
sigmadsp_samplerate_valid(unsigned int supported,unsigned int requested)619*4882a593Smuzhiyun static bool sigmadsp_samplerate_valid(unsigned int supported,
620*4882a593Smuzhiyun unsigned int requested)
621*4882a593Smuzhiyun {
622*4882a593Smuzhiyun /* All samplerates are supported */
623*4882a593Smuzhiyun if (!supported)
624*4882a593Smuzhiyun return true;
625*4882a593Smuzhiyun
626*4882a593Smuzhiyun return supported & requested;
627*4882a593Smuzhiyun }
628*4882a593Smuzhiyun
sigmadsp_alloc_control(struct sigmadsp * sigmadsp,struct sigmadsp_control * ctrl,unsigned int samplerate_mask)629*4882a593Smuzhiyun static int sigmadsp_alloc_control(struct sigmadsp *sigmadsp,
630*4882a593Smuzhiyun struct sigmadsp_control *ctrl, unsigned int samplerate_mask)
631*4882a593Smuzhiyun {
632*4882a593Smuzhiyun struct snd_kcontrol_new template;
633*4882a593Smuzhiyun struct snd_kcontrol *kcontrol;
634*4882a593Smuzhiyun
635*4882a593Smuzhiyun memset(&template, 0, sizeof(template));
636*4882a593Smuzhiyun template.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
637*4882a593Smuzhiyun template.name = ctrl->name;
638*4882a593Smuzhiyun template.info = sigmadsp_ctrl_info;
639*4882a593Smuzhiyun template.get = sigmadsp_ctrl_get;
640*4882a593Smuzhiyun template.put = sigmadsp_ctrl_put;
641*4882a593Smuzhiyun template.private_value = (unsigned long)ctrl;
642*4882a593Smuzhiyun template.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
643*4882a593Smuzhiyun if (!sigmadsp_samplerate_valid(ctrl->samplerates, samplerate_mask))
644*4882a593Smuzhiyun template.access |= SNDRV_CTL_ELEM_ACCESS_INACTIVE;
645*4882a593Smuzhiyun
646*4882a593Smuzhiyun kcontrol = snd_ctl_new1(&template, sigmadsp);
647*4882a593Smuzhiyun if (!kcontrol)
648*4882a593Smuzhiyun return -ENOMEM;
649*4882a593Smuzhiyun
650*4882a593Smuzhiyun kcontrol->private_free = sigmadsp_control_free;
651*4882a593Smuzhiyun ctrl->kcontrol = kcontrol;
652*4882a593Smuzhiyun
653*4882a593Smuzhiyun return snd_ctl_add(sigmadsp->component->card->snd_card, kcontrol);
654*4882a593Smuzhiyun }
655*4882a593Smuzhiyun
sigmadsp_activate_ctrl(struct sigmadsp * sigmadsp,struct sigmadsp_control * ctrl,unsigned int samplerate_mask)656*4882a593Smuzhiyun static void sigmadsp_activate_ctrl(struct sigmadsp *sigmadsp,
657*4882a593Smuzhiyun struct sigmadsp_control *ctrl, unsigned int samplerate_mask)
658*4882a593Smuzhiyun {
659*4882a593Smuzhiyun struct snd_card *card = sigmadsp->component->card->snd_card;
660*4882a593Smuzhiyun struct snd_kcontrol_volatile *vd;
661*4882a593Smuzhiyun struct snd_ctl_elem_id id;
662*4882a593Smuzhiyun bool active;
663*4882a593Smuzhiyun bool changed = false;
664*4882a593Smuzhiyun
665*4882a593Smuzhiyun active = sigmadsp_samplerate_valid(ctrl->samplerates, samplerate_mask);
666*4882a593Smuzhiyun
667*4882a593Smuzhiyun down_write(&card->controls_rwsem);
668*4882a593Smuzhiyun if (!ctrl->kcontrol) {
669*4882a593Smuzhiyun up_write(&card->controls_rwsem);
670*4882a593Smuzhiyun return;
671*4882a593Smuzhiyun }
672*4882a593Smuzhiyun
673*4882a593Smuzhiyun id = ctrl->kcontrol->id;
674*4882a593Smuzhiyun vd = &ctrl->kcontrol->vd[0];
675*4882a593Smuzhiyun if (active == (bool)(vd->access & SNDRV_CTL_ELEM_ACCESS_INACTIVE)) {
676*4882a593Smuzhiyun vd->access ^= SNDRV_CTL_ELEM_ACCESS_INACTIVE;
677*4882a593Smuzhiyun changed = true;
678*4882a593Smuzhiyun }
679*4882a593Smuzhiyun up_write(&card->controls_rwsem);
680*4882a593Smuzhiyun
681*4882a593Smuzhiyun if (active && changed) {
682*4882a593Smuzhiyun mutex_lock(&sigmadsp->lock);
683*4882a593Smuzhiyun if (ctrl->cached)
684*4882a593Smuzhiyun sigmadsp_ctrl_write(sigmadsp, ctrl, ctrl->cache);
685*4882a593Smuzhiyun mutex_unlock(&sigmadsp->lock);
686*4882a593Smuzhiyun }
687*4882a593Smuzhiyun
688*4882a593Smuzhiyun if (changed)
689*4882a593Smuzhiyun snd_ctl_notify(card, SNDRV_CTL_EVENT_MASK_INFO, &id);
690*4882a593Smuzhiyun }
691*4882a593Smuzhiyun
692*4882a593Smuzhiyun /**
693*4882a593Smuzhiyun * sigmadsp_attach() - Attach a sigmadsp instance to a ASoC component
694*4882a593Smuzhiyun * @sigmadsp: The sigmadsp instance to attach
695*4882a593Smuzhiyun * @component: The component to attach to
696*4882a593Smuzhiyun *
697*4882a593Smuzhiyun * Typically called in the components probe callback.
698*4882a593Smuzhiyun *
699*4882a593Smuzhiyun * Note, once this function has been called the firmware must not be released
700*4882a593Smuzhiyun * until after the ALSA snd_card that the component belongs to has been
701*4882a593Smuzhiyun * disconnected, even if sigmadsp_attach() returns an error.
702*4882a593Smuzhiyun */
sigmadsp_attach(struct sigmadsp * sigmadsp,struct snd_soc_component * component)703*4882a593Smuzhiyun int sigmadsp_attach(struct sigmadsp *sigmadsp,
704*4882a593Smuzhiyun struct snd_soc_component *component)
705*4882a593Smuzhiyun {
706*4882a593Smuzhiyun struct sigmadsp_control *ctrl;
707*4882a593Smuzhiyun unsigned int samplerate_mask;
708*4882a593Smuzhiyun int ret;
709*4882a593Smuzhiyun
710*4882a593Smuzhiyun sigmadsp->component = component;
711*4882a593Smuzhiyun
712*4882a593Smuzhiyun samplerate_mask = sigmadsp_get_samplerate_mask(sigmadsp,
713*4882a593Smuzhiyun sigmadsp->current_samplerate);
714*4882a593Smuzhiyun
715*4882a593Smuzhiyun list_for_each_entry(ctrl, &sigmadsp->ctrl_list, head) {
716*4882a593Smuzhiyun ret = sigmadsp_alloc_control(sigmadsp, ctrl, samplerate_mask);
717*4882a593Smuzhiyun if (ret)
718*4882a593Smuzhiyun return ret;
719*4882a593Smuzhiyun }
720*4882a593Smuzhiyun
721*4882a593Smuzhiyun return 0;
722*4882a593Smuzhiyun }
723*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(sigmadsp_attach);
724*4882a593Smuzhiyun
725*4882a593Smuzhiyun /**
726*4882a593Smuzhiyun * sigmadsp_setup() - Setup the DSP for the specified samplerate
727*4882a593Smuzhiyun * @sigmadsp: The sigmadsp instance to configure
728*4882a593Smuzhiyun * @samplerate: The samplerate the DSP should be configured for
729*4882a593Smuzhiyun *
730*4882a593Smuzhiyun * Loads the appropriate firmware program and parameter memory (if not already
731*4882a593Smuzhiyun * loaded) and enables the controls for the specified samplerate. Any control
732*4882a593Smuzhiyun * parameter changes that have been made previously will be restored.
733*4882a593Smuzhiyun *
734*4882a593Smuzhiyun * Returns 0 on success, a negative error code otherwise.
735*4882a593Smuzhiyun */
sigmadsp_setup(struct sigmadsp * sigmadsp,unsigned int samplerate)736*4882a593Smuzhiyun int sigmadsp_setup(struct sigmadsp *sigmadsp, unsigned int samplerate)
737*4882a593Smuzhiyun {
738*4882a593Smuzhiyun struct sigmadsp_control *ctrl;
739*4882a593Smuzhiyun unsigned int samplerate_mask;
740*4882a593Smuzhiyun struct sigmadsp_data *data;
741*4882a593Smuzhiyun int ret;
742*4882a593Smuzhiyun
743*4882a593Smuzhiyun if (sigmadsp->current_samplerate == samplerate)
744*4882a593Smuzhiyun return 0;
745*4882a593Smuzhiyun
746*4882a593Smuzhiyun samplerate_mask = sigmadsp_get_samplerate_mask(sigmadsp, samplerate);
747*4882a593Smuzhiyun if (samplerate_mask == 0)
748*4882a593Smuzhiyun return -EINVAL;
749*4882a593Smuzhiyun
750*4882a593Smuzhiyun list_for_each_entry(data, &sigmadsp->data_list, head) {
751*4882a593Smuzhiyun if (!sigmadsp_samplerate_valid(data->samplerates,
752*4882a593Smuzhiyun samplerate_mask))
753*4882a593Smuzhiyun continue;
754*4882a593Smuzhiyun ret = sigmadsp_write(sigmadsp, data->addr, data->data,
755*4882a593Smuzhiyun data->length);
756*4882a593Smuzhiyun if (ret)
757*4882a593Smuzhiyun goto err;
758*4882a593Smuzhiyun }
759*4882a593Smuzhiyun
760*4882a593Smuzhiyun list_for_each_entry(ctrl, &sigmadsp->ctrl_list, head)
761*4882a593Smuzhiyun sigmadsp_activate_ctrl(sigmadsp, ctrl, samplerate_mask);
762*4882a593Smuzhiyun
763*4882a593Smuzhiyun sigmadsp->current_samplerate = samplerate;
764*4882a593Smuzhiyun
765*4882a593Smuzhiyun return 0;
766*4882a593Smuzhiyun err:
767*4882a593Smuzhiyun sigmadsp_reset(sigmadsp);
768*4882a593Smuzhiyun
769*4882a593Smuzhiyun return ret;
770*4882a593Smuzhiyun }
771*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(sigmadsp_setup);
772*4882a593Smuzhiyun
773*4882a593Smuzhiyun /**
774*4882a593Smuzhiyun * sigmadsp_reset() - Notify the sigmadsp instance that the DSP has been reset
775*4882a593Smuzhiyun * @sigmadsp: The sigmadsp instance to reset
776*4882a593Smuzhiyun *
777*4882a593Smuzhiyun * Should be called whenever the DSP has been reset and parameter and program
778*4882a593Smuzhiyun * memory need to be re-loaded.
779*4882a593Smuzhiyun */
sigmadsp_reset(struct sigmadsp * sigmadsp)780*4882a593Smuzhiyun void sigmadsp_reset(struct sigmadsp *sigmadsp)
781*4882a593Smuzhiyun {
782*4882a593Smuzhiyun struct sigmadsp_control *ctrl;
783*4882a593Smuzhiyun
784*4882a593Smuzhiyun list_for_each_entry(ctrl, &sigmadsp->ctrl_list, head)
785*4882a593Smuzhiyun sigmadsp_activate_ctrl(sigmadsp, ctrl, false);
786*4882a593Smuzhiyun
787*4882a593Smuzhiyun sigmadsp->current_samplerate = 0;
788*4882a593Smuzhiyun }
789*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(sigmadsp_reset);
790*4882a593Smuzhiyun
791*4882a593Smuzhiyun /**
792*4882a593Smuzhiyun * sigmadsp_restrict_params() - Applies DSP firmware specific constraints
793*4882a593Smuzhiyun * @sigmadsp: The sigmadsp instance
794*4882a593Smuzhiyun * @substream: The substream to restrict
795*4882a593Smuzhiyun *
796*4882a593Smuzhiyun * Applies samplerate constraints that may be required by the firmware Should
797*4882a593Smuzhiyun * typically be called from the CODEC/component drivers startup callback.
798*4882a593Smuzhiyun *
799*4882a593Smuzhiyun * Returns 0 on success, a negative error code otherwise.
800*4882a593Smuzhiyun */
sigmadsp_restrict_params(struct sigmadsp * sigmadsp,struct snd_pcm_substream * substream)801*4882a593Smuzhiyun int sigmadsp_restrict_params(struct sigmadsp *sigmadsp,
802*4882a593Smuzhiyun struct snd_pcm_substream *substream)
803*4882a593Smuzhiyun {
804*4882a593Smuzhiyun if (sigmadsp->rate_constraints.count == 0)
805*4882a593Smuzhiyun return 0;
806*4882a593Smuzhiyun
807*4882a593Smuzhiyun return snd_pcm_hw_constraint_list(substream->runtime, 0,
808*4882a593Smuzhiyun SNDRV_PCM_HW_PARAM_RATE, &sigmadsp->rate_constraints);
809*4882a593Smuzhiyun }
810*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(sigmadsp_restrict_params);
811*4882a593Smuzhiyun
812*4882a593Smuzhiyun MODULE_LICENSE("GPL");
813