xref: /OK3568_Linux_fs/kernel/sound/soc/codecs/sigmadsp.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
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