Commit | Line | Data |
---|---|---|
4eef5a90 KM |
1 | // SPDX-License-Identifier: GPL-2.0+ |
2 | // | |
3 | // soc-ops.c -- Generic ASoC operations | |
4 | // | |
5 | // Copyright 2005 Wolfson Microelectronics PLC. | |
6 | // Copyright 2005 Openedhand Ltd. | |
7 | // Copyright (C) 2010 Slimlogic Ltd. | |
8 | // Copyright (C) 2010 Texas Instruments Inc. | |
9 | // | |
10 | // Author: Liam Girdwood <lrg@slimlogic.co.uk> | |
11 | // with code, comments and ideas from :- | |
12 | // Richard Purdie <richard@openedhand.com> | |
7077148f MB |
13 | |
14 | #include <linux/module.h> | |
15 | #include <linux/moduleparam.h> | |
16 | #include <linux/init.h> | |
17 | #include <linux/delay.h> | |
18 | #include <linux/pm.h> | |
19 | #include <linux/bitops.h> | |
20 | #include <linux/ctype.h> | |
21 | #include <linux/slab.h> | |
22 | #include <sound/core.h> | |
23 | #include <sound/jack.h> | |
24 | #include <sound/pcm.h> | |
25 | #include <sound/pcm_params.h> | |
26 | #include <sound/soc.h> | |
27 | #include <sound/soc-dpcm.h> | |
28 | #include <sound/initval.h> | |
29 | ||
30 | /** | |
31 | * snd_soc_info_enum_double - enumerated double mixer info callback | |
32 | * @kcontrol: mixer control | |
33 | * @uinfo: control element information | |
34 | * | |
35 | * Callback to provide information about a double enumerated | |
36 | * mixer control. | |
37 | * | |
38 | * Returns 0 for success. | |
39 | */ | |
40 | int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol, | |
41 | struct snd_ctl_elem_info *uinfo) | |
42 | { | |
43 | struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; | |
44 | ||
45 | return snd_ctl_enum_info(uinfo, e->shift_l == e->shift_r ? 1 : 2, | |
46 | e->items, e->texts); | |
47 | } | |
48 | EXPORT_SYMBOL_GPL(snd_soc_info_enum_double); | |
49 | ||
50 | /** | |
51 | * snd_soc_get_enum_double - enumerated double mixer get callback | |
52 | * @kcontrol: mixer control | |
53 | * @ucontrol: control element information | |
54 | * | |
55 | * Callback to get the value of a double enumerated mixer. | |
56 | * | |
57 | * Returns 0 for success. | |
58 | */ | |
59 | int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol, | |
60 | struct snd_ctl_elem_value *ucontrol) | |
61 | { | |
62 | struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); | |
63 | struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; | |
64 | unsigned int val, item; | |
65 | unsigned int reg_val; | |
7077148f | 66 | |
cf6e26c7 | 67 | reg_val = snd_soc_component_read(component, e->reg); |
7077148f MB |
68 | val = (reg_val >> e->shift_l) & e->mask; |
69 | item = snd_soc_enum_val_to_item(e, val); | |
70 | ucontrol->value.enumerated.item[0] = item; | |
71 | if (e->shift_l != e->shift_r) { | |
189f06c0 | 72 | val = (reg_val >> e->shift_r) & e->mask; |
7077148f MB |
73 | item = snd_soc_enum_val_to_item(e, val); |
74 | ucontrol->value.enumerated.item[1] = item; | |
75 | } | |
76 | ||
77 | return 0; | |
78 | } | |
79 | EXPORT_SYMBOL_GPL(snd_soc_get_enum_double); | |
80 | ||
81 | /** | |
82 | * snd_soc_put_enum_double - enumerated double mixer put callback | |
83 | * @kcontrol: mixer control | |
84 | * @ucontrol: control element information | |
85 | * | |
86 | * Callback to set the value of a double enumerated mixer. | |
87 | * | |
88 | * Returns 0 for success. | |
89 | */ | |
90 | int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol, | |
91 | struct snd_ctl_elem_value *ucontrol) | |
92 | { | |
93 | struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); | |
94 | struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; | |
95 | unsigned int *item = ucontrol->value.enumerated.item; | |
96 | unsigned int val; | |
97 | unsigned int mask; | |
98 | ||
99 | if (item[0] >= e->items) | |
100 | return -EINVAL; | |
101 | val = snd_soc_enum_item_to_val(e, item[0]) << e->shift_l; | |
102 | mask = e->mask << e->shift_l; | |
103 | if (e->shift_l != e->shift_r) { | |
104 | if (item[1] >= e->items) | |
105 | return -EINVAL; | |
106 | val |= snd_soc_enum_item_to_val(e, item[1]) << e->shift_r; | |
107 | mask |= e->mask << e->shift_r; | |
108 | } | |
109 | ||
110 | return snd_soc_component_update_bits(component, e->reg, mask, val); | |
111 | } | |
112 | EXPORT_SYMBOL_GPL(snd_soc_put_enum_double); | |
113 | ||
114 | /** | |
8abab35f | 115 | * snd_soc_read_signed - Read a codec register and interpret as signed value |
7077148f MB |
116 | * @component: component |
117 | * @reg: Register to read | |
118 | * @mask: Mask to use after shifting the register value | |
119 | * @shift: Right shift of register value | |
120 | * @sign_bit: Bit that describes if a number is negative or not. | |
121 | * @signed_val: Pointer to where the read value should be stored | |
122 | * | |
123 | * This functions reads a codec register. The register value is shifted right | |
124 | * by 'shift' bits and masked with the given 'mask'. Afterwards it translates | |
125 | * the given registervalue into a signed integer if sign_bit is non-zero. | |
126 | * | |
127 | * Returns 0 on sucess, otherwise an error value | |
128 | */ | |
129 | static int snd_soc_read_signed(struct snd_soc_component *component, | |
130 | unsigned int reg, unsigned int mask, unsigned int shift, | |
131 | unsigned int sign_bit, int *signed_val) | |
132 | { | |
133 | int ret; | |
134 | unsigned int val; | |
135 | ||
cf6e26c7 | 136 | val = snd_soc_component_read(component, reg); |
7077148f MB |
137 | val = (val >> shift) & mask; |
138 | ||
139 | if (!sign_bit) { | |
140 | *signed_val = val; | |
141 | return 0; | |
142 | } | |
143 | ||
144 | /* non-negative number */ | |
145 | if (!(val & BIT(sign_bit))) { | |
146 | *signed_val = val; | |
147 | return 0; | |
148 | } | |
149 | ||
150 | ret = val; | |
151 | ||
152 | /* | |
153 | * The register most probably does not contain a full-sized int. | |
154 | * Instead we have an arbitrary number of bits in a signed | |
155 | * representation which has to be translated into a full-sized int. | |
156 | * This is done by filling up all bits above the sign-bit. | |
157 | */ | |
158 | ret |= ~((int)(BIT(sign_bit) - 1)); | |
159 | ||
160 | *signed_val = ret; | |
161 | ||
162 | return 0; | |
163 | } | |
164 | ||
165 | /** | |
166 | * snd_soc_info_volsw - single mixer info callback | |
167 | * @kcontrol: mixer control | |
168 | * @uinfo: control element information | |
169 | * | |
170 | * Callback to provide information about a single mixer control, or a double | |
171 | * mixer control that spans 2 registers. | |
172 | * | |
173 | * Returns 0 for success. | |
174 | */ | |
175 | int snd_soc_info_volsw(struct snd_kcontrol *kcontrol, | |
176 | struct snd_ctl_elem_info *uinfo) | |
177 | { | |
178 | struct soc_mixer_control *mc = | |
179 | (struct soc_mixer_control *)kcontrol->private_value; | |
180 | int platform_max; | |
181 | ||
182 | if (!mc->platform_max) | |
183 | mc->platform_max = mc->max; | |
184 | platform_max = mc->platform_max; | |
185 | ||
186 | if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume")) | |
187 | uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; | |
188 | else | |
189 | uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; | |
190 | ||
191 | uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1; | |
192 | uinfo->value.integer.min = 0; | |
193 | uinfo->value.integer.max = platform_max - mc->min; | |
194 | return 0; | |
195 | } | |
196 | EXPORT_SYMBOL_GPL(snd_soc_info_volsw); | |
197 | ||
34198710 CK |
198 | /** |
199 | * snd_soc_info_volsw_sx - Mixer info callback for SX TLV controls | |
200 | * @kcontrol: mixer control | |
201 | * @uinfo: control element information | |
202 | * | |
203 | * Callback to provide information about a single mixer control, or a double | |
204 | * mixer control that spans 2 registers of the SX TLV type. SX TLV controls | |
205 | * have a range that represents both positive and negative values either side | |
206 | * of zero but without a sign bit. | |
207 | * | |
208 | * Returns 0 for success. | |
209 | */ | |
210 | int snd_soc_info_volsw_sx(struct snd_kcontrol *kcontrol, | |
211 | struct snd_ctl_elem_info *uinfo) | |
212 | { | |
213 | struct soc_mixer_control *mc = | |
214 | (struct soc_mixer_control *)kcontrol->private_value; | |
215 | ||
216 | snd_soc_info_volsw(kcontrol, uinfo); | |
217 | /* Max represents the number of levels in an SX control not the | |
218 | * maximum value, so add the minimum value back on | |
219 | */ | |
220 | uinfo->value.integer.max += mc->min; | |
221 | ||
222 | return 0; | |
223 | } | |
224 | EXPORT_SYMBOL_GPL(snd_soc_info_volsw_sx); | |
225 | ||
7077148f MB |
226 | /** |
227 | * snd_soc_get_volsw - single mixer get callback | |
228 | * @kcontrol: mixer control | |
229 | * @ucontrol: control element information | |
230 | * | |
231 | * Callback to get the value of a single mixer control, or a double mixer | |
232 | * control that spans 2 registers. | |
233 | * | |
234 | * Returns 0 for success. | |
235 | */ | |
236 | int snd_soc_get_volsw(struct snd_kcontrol *kcontrol, | |
237 | struct snd_ctl_elem_value *ucontrol) | |
238 | { | |
239 | struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); | |
240 | struct soc_mixer_control *mc = | |
241 | (struct soc_mixer_control *)kcontrol->private_value; | |
242 | unsigned int reg = mc->reg; | |
243 | unsigned int reg2 = mc->rreg; | |
244 | unsigned int shift = mc->shift; | |
245 | unsigned int rshift = mc->rshift; | |
246 | int max = mc->max; | |
247 | int min = mc->min; | |
248 | int sign_bit = mc->sign_bit; | |
249 | unsigned int mask = (1 << fls(max)) - 1; | |
250 | unsigned int invert = mc->invert; | |
251 | int val; | |
252 | int ret; | |
253 | ||
254 | if (sign_bit) | |
255 | mask = BIT(sign_bit + 1) - 1; | |
256 | ||
257 | ret = snd_soc_read_signed(component, reg, mask, shift, sign_bit, &val); | |
258 | if (ret) | |
259 | return ret; | |
260 | ||
261 | ucontrol->value.integer.value[0] = val - min; | |
262 | if (invert) | |
263 | ucontrol->value.integer.value[0] = | |
264 | max - ucontrol->value.integer.value[0]; | |
265 | ||
266 | if (snd_soc_volsw_is_stereo(mc)) { | |
267 | if (reg == reg2) | |
268 | ret = snd_soc_read_signed(component, reg, mask, rshift, | |
269 | sign_bit, &val); | |
270 | else | |
271 | ret = snd_soc_read_signed(component, reg2, mask, shift, | |
272 | sign_bit, &val); | |
273 | if (ret) | |
274 | return ret; | |
275 | ||
276 | ucontrol->value.integer.value[1] = val - min; | |
277 | if (invert) | |
278 | ucontrol->value.integer.value[1] = | |
279 | max - ucontrol->value.integer.value[1]; | |
280 | } | |
281 | ||
282 | return 0; | |
283 | } | |
284 | EXPORT_SYMBOL_GPL(snd_soc_get_volsw); | |
285 | ||
286 | /** | |
287 | * snd_soc_put_volsw - single mixer put callback | |
288 | * @kcontrol: mixer control | |
289 | * @ucontrol: control element information | |
290 | * | |
291 | * Callback to set the value of a single mixer control, or a double mixer | |
292 | * control that spans 2 registers. | |
293 | * | |
294 | * Returns 0 for success. | |
295 | */ | |
296 | int snd_soc_put_volsw(struct snd_kcontrol *kcontrol, | |
297 | struct snd_ctl_elem_value *ucontrol) | |
298 | { | |
299 | struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); | |
300 | struct soc_mixer_control *mc = | |
301 | (struct soc_mixer_control *)kcontrol->private_value; | |
302 | unsigned int reg = mc->reg; | |
303 | unsigned int reg2 = mc->rreg; | |
304 | unsigned int shift = mc->shift; | |
305 | unsigned int rshift = mc->rshift; | |
306 | int max = mc->max; | |
307 | int min = mc->min; | |
308 | unsigned int sign_bit = mc->sign_bit; | |
309 | unsigned int mask = (1 << fls(max)) - 1; | |
310 | unsigned int invert = mc->invert; | |
564778d7 | 311 | int err, ret; |
7077148f MB |
312 | bool type_2r = false; |
313 | unsigned int val2 = 0; | |
314 | unsigned int val, val_mask; | |
315 | ||
316 | if (sign_bit) | |
317 | mask = BIT(sign_bit + 1) - 1; | |
318 | ||
1601033d MB |
319 | if (ucontrol->value.integer.value[0] < 0) |
320 | return -EINVAL; | |
817f7c93 MB |
321 | val = ucontrol->value.integer.value[0]; |
322 | if (mc->platform_max && val > mc->platform_max) | |
323 | return -EINVAL; | |
324 | if (val > max - min) | |
325 | return -EINVAL; | |
817f7c93 | 326 | val = (val + min) & mask; |
7077148f MB |
327 | if (invert) |
328 | val = max - val; | |
329 | val_mask = mask << shift; | |
330 | val = val << shift; | |
331 | if (snd_soc_volsw_is_stereo(mc)) { | |
1601033d MB |
332 | if (ucontrol->value.integer.value[1] < 0) |
333 | return -EINVAL; | |
817f7c93 MB |
334 | val2 = ucontrol->value.integer.value[1]; |
335 | if (mc->platform_max && val2 > mc->platform_max) | |
336 | return -EINVAL; | |
337 | if (val2 > max - min) | |
338 | return -EINVAL; | |
817f7c93 | 339 | val2 = (val2 + min) & mask; |
7077148f MB |
340 | if (invert) |
341 | val2 = max - val2; | |
342 | if (reg == reg2) { | |
343 | val_mask |= mask << rshift; | |
344 | val |= val2 << rshift; | |
345 | } else { | |
346 | val2 = val2 << shift; | |
347 | type_2r = true; | |
348 | } | |
349 | } | |
350 | err = snd_soc_component_update_bits(component, reg, val_mask, val); | |
351 | if (err < 0) | |
352 | return err; | |
564778d7 | 353 | ret = err; |
7077148f | 354 | |
564778d7 | 355 | if (type_2r) { |
7077148f | 356 | err = snd_soc_component_update_bits(component, reg2, val_mask, |
564778d7 MB |
357 | val2); |
358 | /* Don't discard any error code or drop change flag */ | |
359 | if (ret == 0 || err < 0) { | |
360 | ret = err; | |
361 | } | |
362 | } | |
7077148f | 363 | |
564778d7 | 364 | return ret; |
7077148f MB |
365 | } |
366 | EXPORT_SYMBOL_GPL(snd_soc_put_volsw); | |
367 | ||
368 | /** | |
369 | * snd_soc_get_volsw_sx - single mixer get callback | |
370 | * @kcontrol: mixer control | |
371 | * @ucontrol: control element information | |
372 | * | |
373 | * Callback to get the value of a single mixer control, or a double mixer | |
374 | * control that spans 2 registers. | |
375 | * | |
376 | * Returns 0 for success. | |
377 | */ | |
378 | int snd_soc_get_volsw_sx(struct snd_kcontrol *kcontrol, | |
379 | struct snd_ctl_elem_value *ucontrol) | |
380 | { | |
381 | struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); | |
382 | struct soc_mixer_control *mc = | |
383 | (struct soc_mixer_control *)kcontrol->private_value; | |
384 | unsigned int reg = mc->reg; | |
385 | unsigned int reg2 = mc->rreg; | |
386 | unsigned int shift = mc->shift; | |
387 | unsigned int rshift = mc->rshift; | |
388 | int max = mc->max; | |
389 | int min = mc->min; | |
ae7d1247 | 390 | unsigned int mask = (1U << (fls(min + max) - 1)) - 1; |
7077148f | 391 | unsigned int val; |
7077148f | 392 | |
cf6e26c7 | 393 | val = snd_soc_component_read(component, reg); |
7077148f MB |
394 | ucontrol->value.integer.value[0] = ((val >> shift) - min) & mask; |
395 | ||
396 | if (snd_soc_volsw_is_stereo(mc)) { | |
cf6e26c7 | 397 | val = snd_soc_component_read(component, reg2); |
7077148f MB |
398 | val = ((val >> rshift) - min) & mask; |
399 | ucontrol->value.integer.value[1] = val; | |
400 | } | |
401 | ||
402 | return 0; | |
403 | } | |
404 | EXPORT_SYMBOL_GPL(snd_soc_get_volsw_sx); | |
405 | ||
406 | /** | |
407 | * snd_soc_put_volsw_sx - double mixer set callback | |
408 | * @kcontrol: mixer control | |
9a11ef7f | 409 | * @ucontrol: control element information |
7077148f MB |
410 | * |
411 | * Callback to set the value of a double mixer control that spans 2 registers. | |
412 | * | |
413 | * Returns 0 for success. | |
414 | */ | |
415 | int snd_soc_put_volsw_sx(struct snd_kcontrol *kcontrol, | |
416 | struct snd_ctl_elem_value *ucontrol) | |
417 | { | |
418 | struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); | |
419 | struct soc_mixer_control *mc = | |
420 | (struct soc_mixer_control *)kcontrol->private_value; | |
421 | ||
422 | unsigned int reg = mc->reg; | |
423 | unsigned int reg2 = mc->rreg; | |
424 | unsigned int shift = mc->shift; | |
425 | unsigned int rshift = mc->rshift; | |
426 | int max = mc->max; | |
427 | int min = mc->min; | |
ae7d1247 | 428 | unsigned int mask = (1U << (fls(min + max) - 1)) - 1; |
7077148f | 429 | int err = 0; |
7f3d90a3 | 430 | int ret; |
58f42dfd | 431 | unsigned int val, val_mask; |
7077148f | 432 | |
1601033d MB |
433 | if (ucontrol->value.integer.value[0] < 0) |
434 | return -EINVAL; | |
4f1e50d6 MB |
435 | val = ucontrol->value.integer.value[0]; |
436 | if (mc->platform_max && val > mc->platform_max) | |
437 | return -EINVAL; | |
438 | if (val > max - min) | |
439 | return -EINVAL; | |
7077148f | 440 | val_mask = mask << shift; |
4f1e50d6 | 441 | val = (val + min) & mask; |
7077148f MB |
442 | val = val << shift; |
443 | ||
444 | err = snd_soc_component_update_bits(component, reg, val_mask, val); | |
445 | if (err < 0) | |
446 | return err; | |
7f3d90a3 | 447 | ret = err; |
7077148f MB |
448 | |
449 | if (snd_soc_volsw_is_stereo(mc)) { | |
58f42dfd KM |
450 | unsigned int val2; |
451 | ||
7077148f MB |
452 | val_mask = mask << rshift; |
453 | val2 = (ucontrol->value.integer.value[1] + min) & mask; | |
454 | val2 = val2 << rshift; | |
455 | ||
456 | err = snd_soc_component_update_bits(component, reg2, val_mask, | |
457 | val2); | |
7f3d90a3 MB |
458 | |
459 | /* Don't discard any error code or drop change flag */ | |
460 | if (ret == 0 || err < 0) { | |
461 | ret = err; | |
462 | } | |
7077148f MB |
463 | } |
464 | return err; | |
465 | } | |
466 | EXPORT_SYMBOL_GPL(snd_soc_put_volsw_sx); | |
467 | ||
468 | /** | |
469 | * snd_soc_info_volsw_range - single mixer info callback with range. | |
470 | * @kcontrol: mixer control | |
471 | * @uinfo: control element information | |
472 | * | |
473 | * Callback to provide information, within a range, about a single | |
474 | * mixer control. | |
475 | * | |
476 | * returns 0 for success. | |
477 | */ | |
478 | int snd_soc_info_volsw_range(struct snd_kcontrol *kcontrol, | |
479 | struct snd_ctl_elem_info *uinfo) | |
480 | { | |
481 | struct soc_mixer_control *mc = | |
482 | (struct soc_mixer_control *)kcontrol->private_value; | |
483 | int platform_max; | |
484 | int min = mc->min; | |
485 | ||
486 | if (!mc->platform_max) | |
487 | mc->platform_max = mc->max; | |
488 | platform_max = mc->platform_max; | |
489 | ||
490 | uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; | |
491 | uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1; | |
492 | uinfo->value.integer.min = 0; | |
493 | uinfo->value.integer.max = platform_max - min; | |
494 | ||
495 | return 0; | |
496 | } | |
497 | EXPORT_SYMBOL_GPL(snd_soc_info_volsw_range); | |
498 | ||
499 | /** | |
500 | * snd_soc_put_volsw_range - single mixer put value callback with range. | |
501 | * @kcontrol: mixer control | |
502 | * @ucontrol: control element information | |
503 | * | |
504 | * Callback to set the value, within a range, for a single mixer control. | |
505 | * | |
506 | * Returns 0 for success. | |
507 | */ | |
508 | int snd_soc_put_volsw_range(struct snd_kcontrol *kcontrol, | |
509 | struct snd_ctl_elem_value *ucontrol) | |
510 | { | |
511 | struct soc_mixer_control *mc = | |
512 | (struct soc_mixer_control *)kcontrol->private_value; | |
513 | struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); | |
514 | unsigned int reg = mc->reg; | |
515 | unsigned int rreg = mc->rreg; | |
516 | unsigned int shift = mc->shift; | |
517 | int min = mc->min; | |
518 | int max = mc->max; | |
519 | unsigned int mask = (1 << fls(max)) - 1; | |
520 | unsigned int invert = mc->invert; | |
521 | unsigned int val, val_mask; | |
522 | int ret; | |
523 | ||
524 | if (invert) | |
525 | val = (max - ucontrol->value.integer.value[0]) & mask; | |
526 | else | |
527 | val = ((ucontrol->value.integer.value[0] + min) & mask); | |
528 | val_mask = mask << shift; | |
529 | val = val << shift; | |
530 | ||
531 | ret = snd_soc_component_update_bits(component, reg, val_mask, val); | |
532 | if (ret < 0) | |
533 | return ret; | |
534 | ||
535 | if (snd_soc_volsw_is_stereo(mc)) { | |
536 | if (invert) | |
537 | val = (max - ucontrol->value.integer.value[1]) & mask; | |
538 | else | |
539 | val = ((ucontrol->value.integer.value[1] + min) & mask); | |
540 | val_mask = mask << shift; | |
541 | val = val << shift; | |
542 | ||
543 | ret = snd_soc_component_update_bits(component, rreg, val_mask, | |
544 | val); | |
545 | } | |
546 | ||
547 | return ret; | |
548 | } | |
549 | EXPORT_SYMBOL_GPL(snd_soc_put_volsw_range); | |
550 | ||
551 | /** | |
552 | * snd_soc_get_volsw_range - single mixer get callback with range | |
553 | * @kcontrol: mixer control | |
554 | * @ucontrol: control element information | |
555 | * | |
556 | * Callback to get the value, within a range, of a single mixer control. | |
557 | * | |
558 | * Returns 0 for success. | |
559 | */ | |
560 | int snd_soc_get_volsw_range(struct snd_kcontrol *kcontrol, | |
561 | struct snd_ctl_elem_value *ucontrol) | |
562 | { | |
563 | struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); | |
564 | struct soc_mixer_control *mc = | |
565 | (struct soc_mixer_control *)kcontrol->private_value; | |
566 | unsigned int reg = mc->reg; | |
567 | unsigned int rreg = mc->rreg; | |
568 | unsigned int shift = mc->shift; | |
569 | int min = mc->min; | |
570 | int max = mc->max; | |
571 | unsigned int mask = (1 << fls(max)) - 1; | |
572 | unsigned int invert = mc->invert; | |
573 | unsigned int val; | |
7077148f | 574 | |
cf6e26c7 | 575 | val = snd_soc_component_read(component, reg); |
7077148f MB |
576 | ucontrol->value.integer.value[0] = (val >> shift) & mask; |
577 | if (invert) | |
578 | ucontrol->value.integer.value[0] = | |
579 | max - ucontrol->value.integer.value[0]; | |
580 | else | |
581 | ucontrol->value.integer.value[0] = | |
582 | ucontrol->value.integer.value[0] - min; | |
583 | ||
584 | if (snd_soc_volsw_is_stereo(mc)) { | |
cf6e26c7 | 585 | val = snd_soc_component_read(component, rreg); |
7077148f MB |
586 | ucontrol->value.integer.value[1] = (val >> shift) & mask; |
587 | if (invert) | |
588 | ucontrol->value.integer.value[1] = | |
589 | max - ucontrol->value.integer.value[1]; | |
590 | else | |
591 | ucontrol->value.integer.value[1] = | |
592 | ucontrol->value.integer.value[1] - min; | |
593 | } | |
594 | ||
595 | return 0; | |
596 | } | |
597 | EXPORT_SYMBOL_GPL(snd_soc_get_volsw_range); | |
598 | ||
599 | /** | |
600 | * snd_soc_limit_volume - Set new limit to an existing volume control. | |
601 | * | |
26d9ca34 | 602 | * @card: where to look for the control |
7077148f MB |
603 | * @name: Name of the control |
604 | * @max: new maximum limit | |
605 | * | |
606 | * Return 0 for success, else error. | |
607 | */ | |
26d9ca34 | 608 | int snd_soc_limit_volume(struct snd_soc_card *card, |
7077148f MB |
609 | const char *name, int max) |
610 | { | |
7077148f | 611 | struct snd_kcontrol *kctl; |
7077148f MB |
612 | int ret = -EINVAL; |
613 | ||
614 | /* Sanity check for name and max */ | |
615 | if (unlikely(!name || max <= 0)) | |
616 | return -EINVAL; | |
617 | ||
0881ab6e KM |
618 | kctl = snd_soc_card_get_kcontrol(card, name); |
619 | if (kctl) { | |
872040f7 | 620 | struct soc_mixer_control *mc = (struct soc_mixer_control *)kctl->private_value; |
7077148f MB |
621 | if (max <= mc->max) { |
622 | mc->platform_max = max; | |
623 | ret = 0; | |
624 | } | |
625 | } | |
626 | return ret; | |
627 | } | |
628 | EXPORT_SYMBOL_GPL(snd_soc_limit_volume); | |
629 | ||
630 | int snd_soc_bytes_info(struct snd_kcontrol *kcontrol, | |
631 | struct snd_ctl_elem_info *uinfo) | |
632 | { | |
633 | struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); | |
634 | struct soc_bytes *params = (void *)kcontrol->private_value; | |
635 | ||
636 | uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES; | |
637 | uinfo->count = params->num_regs * component->val_bytes; | |
638 | ||
639 | return 0; | |
640 | } | |
641 | EXPORT_SYMBOL_GPL(snd_soc_bytes_info); | |
642 | ||
643 | int snd_soc_bytes_get(struct snd_kcontrol *kcontrol, | |
644 | struct snd_ctl_elem_value *ucontrol) | |
645 | { | |
646 | struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); | |
647 | struct soc_bytes *params = (void *)kcontrol->private_value; | |
648 | int ret; | |
649 | ||
650 | if (component->regmap) | |
651 | ret = regmap_raw_read(component->regmap, params->base, | |
652 | ucontrol->value.bytes.data, | |
653 | params->num_regs * component->val_bytes); | |
654 | else | |
655 | ret = -EINVAL; | |
656 | ||
657 | /* Hide any masked bytes to ensure consistent data reporting */ | |
658 | if (ret == 0 && params->mask) { | |
659 | switch (component->val_bytes) { | |
660 | case 1: | |
661 | ucontrol->value.bytes.data[0] &= ~params->mask; | |
662 | break; | |
663 | case 2: | |
664 | ((u16 *)(&ucontrol->value.bytes.data))[0] | |
665 | &= cpu_to_be16(~params->mask); | |
666 | break; | |
667 | case 4: | |
668 | ((u32 *)(&ucontrol->value.bytes.data))[0] | |
669 | &= cpu_to_be32(~params->mask); | |
670 | break; | |
671 | default: | |
672 | return -EINVAL; | |
673 | } | |
674 | } | |
675 | ||
676 | return ret; | |
677 | } | |
678 | EXPORT_SYMBOL_GPL(snd_soc_bytes_get); | |
679 | ||
680 | int snd_soc_bytes_put(struct snd_kcontrol *kcontrol, | |
681 | struct snd_ctl_elem_value *ucontrol) | |
682 | { | |
683 | struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); | |
684 | struct soc_bytes *params = (void *)kcontrol->private_value; | |
685 | int ret, len; | |
686 | unsigned int val, mask; | |
687 | void *data; | |
688 | ||
689 | if (!component->regmap || !params->num_regs) | |
690 | return -EINVAL; | |
691 | ||
692 | len = params->num_regs * component->val_bytes; | |
693 | ||
694 | data = kmemdup(ucontrol->value.bytes.data, len, GFP_KERNEL | GFP_DMA); | |
695 | if (!data) | |
696 | return -ENOMEM; | |
697 | ||
698 | /* | |
699 | * If we've got a mask then we need to preserve the register | |
700 | * bits. We shouldn't modify the incoming data so take a | |
701 | * copy. | |
702 | */ | |
703 | if (params->mask) { | |
704 | ret = regmap_read(component->regmap, params->base, &val); | |
705 | if (ret != 0) | |
706 | goto out; | |
707 | ||
708 | val &= params->mask; | |
709 | ||
710 | switch (component->val_bytes) { | |
711 | case 1: | |
712 | ((u8 *)data)[0] &= ~params->mask; | |
713 | ((u8 *)data)[0] |= val; | |
714 | break; | |
715 | case 2: | |
716 | mask = ~params->mask; | |
717 | ret = regmap_parse_val(component->regmap, | |
718 | &mask, &mask); | |
719 | if (ret != 0) | |
720 | goto out; | |
721 | ||
722 | ((u16 *)data)[0] &= mask; | |
723 | ||
724 | ret = regmap_parse_val(component->regmap, | |
725 | &val, &val); | |
726 | if (ret != 0) | |
727 | goto out; | |
728 | ||
729 | ((u16 *)data)[0] |= val; | |
730 | break; | |
731 | case 4: | |
732 | mask = ~params->mask; | |
733 | ret = regmap_parse_val(component->regmap, | |
734 | &mask, &mask); | |
735 | if (ret != 0) | |
736 | goto out; | |
737 | ||
738 | ((u32 *)data)[0] &= mask; | |
739 | ||
740 | ret = regmap_parse_val(component->regmap, | |
741 | &val, &val); | |
742 | if (ret != 0) | |
743 | goto out; | |
744 | ||
745 | ((u32 *)data)[0] |= val; | |
746 | break; | |
747 | default: | |
748 | ret = -EINVAL; | |
749 | goto out; | |
750 | } | |
751 | } | |
752 | ||
753 | ret = regmap_raw_write(component->regmap, params->base, | |
754 | data, len); | |
755 | ||
756 | out: | |
757 | kfree(data); | |
758 | ||
759 | return ret; | |
760 | } | |
761 | EXPORT_SYMBOL_GPL(snd_soc_bytes_put); | |
762 | ||
763 | int snd_soc_bytes_info_ext(struct snd_kcontrol *kcontrol, | |
764 | struct snd_ctl_elem_info *ucontrol) | |
765 | { | |
766 | struct soc_bytes_ext *params = (void *)kcontrol->private_value; | |
767 | ||
768 | ucontrol->type = SNDRV_CTL_ELEM_TYPE_BYTES; | |
769 | ucontrol->count = params->max; | |
770 | ||
771 | return 0; | |
772 | } | |
773 | EXPORT_SYMBOL_GPL(snd_soc_bytes_info_ext); | |
774 | ||
775 | int snd_soc_bytes_tlv_callback(struct snd_kcontrol *kcontrol, int op_flag, | |
776 | unsigned int size, unsigned int __user *tlv) | |
777 | { | |
778 | struct soc_bytes_ext *params = (void *)kcontrol->private_value; | |
779 | unsigned int count = size < params->max ? size : params->max; | |
780 | int ret = -ENXIO; | |
781 | ||
782 | switch (op_flag) { | |
783 | case SNDRV_CTL_TLV_OP_READ: | |
784 | if (params->get) | |
a1e5e7e9 | 785 | ret = params->get(kcontrol, tlv, count); |
7077148f MB |
786 | break; |
787 | case SNDRV_CTL_TLV_OP_WRITE: | |
788 | if (params->put) | |
a1e5e7e9 | 789 | ret = params->put(kcontrol, tlv, count); |
7077148f MB |
790 | break; |
791 | } | |
792 | return ret; | |
793 | } | |
794 | EXPORT_SYMBOL_GPL(snd_soc_bytes_tlv_callback); | |
795 | ||
796 | /** | |
797 | * snd_soc_info_xr_sx - signed multi register info callback | |
798 | * @kcontrol: mreg control | |
799 | * @uinfo: control element information | |
800 | * | |
801 | * Callback to provide information of a control that can | |
802 | * span multiple codec registers which together | |
803 | * forms a single signed value in a MSB/LSB manner. | |
804 | * | |
805 | * Returns 0 for success. | |
806 | */ | |
807 | int snd_soc_info_xr_sx(struct snd_kcontrol *kcontrol, | |
808 | struct snd_ctl_elem_info *uinfo) | |
809 | { | |
810 | struct soc_mreg_control *mc = | |
811 | (struct soc_mreg_control *)kcontrol->private_value; | |
812 | uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; | |
813 | uinfo->count = 1; | |
814 | uinfo->value.integer.min = mc->min; | |
815 | uinfo->value.integer.max = mc->max; | |
816 | ||
817 | return 0; | |
818 | } | |
819 | EXPORT_SYMBOL_GPL(snd_soc_info_xr_sx); | |
820 | ||
821 | /** | |
822 | * snd_soc_get_xr_sx - signed multi register get callback | |
823 | * @kcontrol: mreg control | |
824 | * @ucontrol: control element information | |
825 | * | |
826 | * Callback to get the value of a control that can span | |
827 | * multiple codec registers which together forms a single | |
828 | * signed value in a MSB/LSB manner. The control supports | |
829 | * specifying total no of bits used to allow for bitfields | |
830 | * across the multiple codec registers. | |
831 | * | |
832 | * Returns 0 for success. | |
833 | */ | |
834 | int snd_soc_get_xr_sx(struct snd_kcontrol *kcontrol, | |
835 | struct snd_ctl_elem_value *ucontrol) | |
836 | { | |
837 | struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); | |
838 | struct soc_mreg_control *mc = | |
839 | (struct soc_mreg_control *)kcontrol->private_value; | |
840 | unsigned int regbase = mc->regbase; | |
841 | unsigned int regcount = mc->regcount; | |
842 | unsigned int regwshift = component->val_bytes * BITS_PER_BYTE; | |
0ab07091 | 843 | unsigned int regwmask = (1UL<<regwshift)-1; |
7077148f MB |
844 | unsigned int invert = mc->invert; |
845 | unsigned long mask = (1UL<<mc->nbits)-1; | |
846 | long min = mc->min; | |
847 | long max = mc->max; | |
848 | long val = 0; | |
7077148f | 849 | unsigned int i; |
7077148f MB |
850 | |
851 | for (i = 0; i < regcount; i++) { | |
b1ebecb9 | 852 | unsigned int regval = snd_soc_component_read(component, regbase+i); |
7077148f MB |
853 | val |= (regval & regwmask) << (regwshift*(regcount-i-1)); |
854 | } | |
855 | val &= mask; | |
856 | if (min < 0 && val > max) | |
857 | val |= ~mask; | |
858 | if (invert) | |
859 | val = max - val; | |
860 | ucontrol->value.integer.value[0] = val; | |
861 | ||
862 | return 0; | |
863 | } | |
864 | EXPORT_SYMBOL_GPL(snd_soc_get_xr_sx); | |
865 | ||
866 | /** | |
867 | * snd_soc_put_xr_sx - signed multi register get callback | |
868 | * @kcontrol: mreg control | |
869 | * @ucontrol: control element information | |
870 | * | |
871 | * Callback to set the value of a control that can span | |
872 | * multiple codec registers which together forms a single | |
873 | * signed value in a MSB/LSB manner. The control supports | |
874 | * specifying total no of bits used to allow for bitfields | |
875 | * across the multiple codec registers. | |
876 | * | |
877 | * Returns 0 for success. | |
878 | */ | |
879 | int snd_soc_put_xr_sx(struct snd_kcontrol *kcontrol, | |
880 | struct snd_ctl_elem_value *ucontrol) | |
881 | { | |
882 | struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); | |
883 | struct soc_mreg_control *mc = | |
884 | (struct soc_mreg_control *)kcontrol->private_value; | |
885 | unsigned int regbase = mc->regbase; | |
886 | unsigned int regcount = mc->regcount; | |
887 | unsigned int regwshift = component->val_bytes * BITS_PER_BYTE; | |
0ab07091 | 888 | unsigned int regwmask = (1UL<<regwshift)-1; |
7077148f MB |
889 | unsigned int invert = mc->invert; |
890 | unsigned long mask = (1UL<<mc->nbits)-1; | |
891 | long max = mc->max; | |
892 | long val = ucontrol->value.integer.value[0]; | |
b285b510 | 893 | unsigned int i; |
7077148f | 894 | |
4cf28e9a MB |
895 | if (val < mc->min || val > mc->max) |
896 | return -EINVAL; | |
7077148f MB |
897 | if (invert) |
898 | val = max - val; | |
899 | val &= mask; | |
900 | for (i = 0; i < regcount; i++) { | |
b285b510 KM |
901 | unsigned int regval = (val >> (regwshift*(regcount-i-1))) & regwmask; |
902 | unsigned int regmask = (mask >> (regwshift*(regcount-i-1))) & regwmask; | |
903 | int err = snd_soc_component_update_bits(component, regbase+i, | |
904 | regmask, regval); | |
7077148f MB |
905 | if (err < 0) |
906 | return err; | |
907 | } | |
908 | ||
909 | return 0; | |
910 | } | |
911 | EXPORT_SYMBOL_GPL(snd_soc_put_xr_sx); | |
912 | ||
913 | /** | |
914 | * snd_soc_get_strobe - strobe get callback | |
915 | * @kcontrol: mixer control | |
916 | * @ucontrol: control element information | |
917 | * | |
918 | * Callback get the value of a strobe mixer control. | |
919 | * | |
920 | * Returns 0 for success. | |
921 | */ | |
922 | int snd_soc_get_strobe(struct snd_kcontrol *kcontrol, | |
923 | struct snd_ctl_elem_value *ucontrol) | |
924 | { | |
925 | struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); | |
926 | struct soc_mixer_control *mc = | |
927 | (struct soc_mixer_control *)kcontrol->private_value; | |
928 | unsigned int reg = mc->reg; | |
929 | unsigned int shift = mc->shift; | |
930 | unsigned int mask = 1 << shift; | |
931 | unsigned int invert = mc->invert != 0; | |
932 | unsigned int val; | |
7077148f | 933 | |
cf6e26c7 | 934 | val = snd_soc_component_read(component, reg); |
7077148f MB |
935 | val &= mask; |
936 | ||
937 | if (shift != 0 && val != 0) | |
938 | val = val >> shift; | |
939 | ucontrol->value.enumerated.item[0] = val ^ invert; | |
940 | ||
941 | return 0; | |
942 | } | |
943 | EXPORT_SYMBOL_GPL(snd_soc_get_strobe); | |
944 | ||
945 | /** | |
946 | * snd_soc_put_strobe - strobe put callback | |
947 | * @kcontrol: mixer control | |
948 | * @ucontrol: control element information | |
949 | * | |
950 | * Callback strobe a register bit to high then low (or the inverse) | |
951 | * in one pass of a single mixer enum control. | |
952 | * | |
953 | * Returns 1 for success. | |
954 | */ | |
955 | int snd_soc_put_strobe(struct snd_kcontrol *kcontrol, | |
956 | struct snd_ctl_elem_value *ucontrol) | |
957 | { | |
958 | struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); | |
959 | struct soc_mixer_control *mc = | |
960 | (struct soc_mixer_control *)kcontrol->private_value; | |
961 | unsigned int reg = mc->reg; | |
962 | unsigned int shift = mc->shift; | |
963 | unsigned int mask = 1 << shift; | |
964 | unsigned int invert = mc->invert != 0; | |
965 | unsigned int strobe = ucontrol->value.enumerated.item[0] != 0; | |
966 | unsigned int val1 = (strobe ^ invert) ? mask : 0; | |
967 | unsigned int val2 = (strobe ^ invert) ? 0 : mask; | |
968 | int err; | |
969 | ||
970 | err = snd_soc_component_update_bits(component, reg, mask, val1); | |
971 | if (err < 0) | |
972 | return err; | |
973 | ||
974 | return snd_soc_component_update_bits(component, reg, mask, val2); | |
975 | } | |
976 | EXPORT_SYMBOL_GPL(snd_soc_put_strobe); |