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