blob: 2bc9fa6a34b8faf645ef36dcce95d1a38778671c [file] [log] [blame]
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001// 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;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000066
Olivier Deprez157378f2022-04-04 15:47:50 +020067 reg_val = snd_soc_component_read(component, e->reg);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000068 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) {
72 val = (reg_val >> e->shift_r) & e->mask;
73 item = snd_soc_enum_val_to_item(e, val);
74 ucontrol->value.enumerated.item[1] = item;
75 }
76
77 return 0;
78}
79EXPORT_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 */
90int 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}
112EXPORT_SYMBOL_GPL(snd_soc_put_enum_double);
113
114/**
115 * snd_soc_read_signed - Read a codec register and interpret as signed value
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 */
129static 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
Olivier Deprez157378f2022-04-04 15:47:50 +0200136 val = snd_soc_component_read(component, reg);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000137 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 */
175int 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}
196EXPORT_SYMBOL_GPL(snd_soc_info_volsw);
197
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 */
210int 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}
224EXPORT_SYMBOL_GPL(snd_soc_info_volsw_sx);
225
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 */
236int 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}
284EXPORT_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 */
296int 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;
Olivier Deprez157378f2022-04-04 15:47:50 +0200311 int err, ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000312 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
Olivier Deprez157378f2022-04-04 15:47:50 +0200319 val = ucontrol->value.integer.value[0];
320 if (mc->platform_max && ((int)val + min) > mc->platform_max)
321 return -EINVAL;
322 if (val > max - min)
323 return -EINVAL;
324 if (val < 0)
325 return -EINVAL;
326 val = (val + min) & mask;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000327 if (invert)
328 val = max - val;
329 val_mask = mask << shift;
330 val = val << shift;
331 if (snd_soc_volsw_is_stereo(mc)) {
Olivier Deprez157378f2022-04-04 15:47:50 +0200332 val2 = ucontrol->value.integer.value[1];
333 if (mc->platform_max && ((int)val2 + min) > mc->platform_max)
334 return -EINVAL;
335 if (val2 > max - min)
336 return -EINVAL;
337 if (val2 < 0)
338 return -EINVAL;
339 val2 = (val2 + min) & mask;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000340 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;
Olivier Deprez157378f2022-04-04 15:47:50 +0200353 ret = err;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000354
Olivier Deprez157378f2022-04-04 15:47:50 +0200355 if (type_2r) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000356 err = snd_soc_component_update_bits(component, reg2, val_mask,
Olivier Deprez157378f2022-04-04 15:47:50 +0200357 val2);
358 /* Don't discard any error code or drop change flag */
359 if (ret == 0 || err < 0) {
360 ret = err;
361 }
362 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000363
Olivier Deprez157378f2022-04-04 15:47:50 +0200364 return ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000365}
366EXPORT_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 */
378int 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;
David Brazdil0f672f62019-12-10 10:32:29 +0000390 unsigned int mask = (1U << (fls(min + max) - 1)) - 1;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000391 unsigned int val;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000392
Olivier Deprez157378f2022-04-04 15:47:50 +0200393 val = snd_soc_component_read(component, reg);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000394 ucontrol->value.integer.value[0] = ((val >> shift) - min) & mask;
395
396 if (snd_soc_volsw_is_stereo(mc)) {
Olivier Deprez157378f2022-04-04 15:47:50 +0200397 val = snd_soc_component_read(component, reg2);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000398 val = ((val >> rshift) - min) & mask;
399 ucontrol->value.integer.value[1] = val;
400 }
401
402 return 0;
403}
404EXPORT_SYMBOL_GPL(snd_soc_get_volsw_sx);
405
406/**
407 * snd_soc_put_volsw_sx - double mixer set callback
408 * @kcontrol: mixer control
409 * @ucontrol: control element information
410 *
411 * Callback to set the value of a double mixer control that spans 2 registers.
412 *
413 * Returns 0 for success.
414 */
415int 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;
David Brazdil0f672f62019-12-10 10:32:29 +0000428 unsigned int mask = (1U << (fls(min + max) - 1)) - 1;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000429 int err = 0;
430 unsigned int val, val_mask, val2 = 0;
431
Olivier Deprez157378f2022-04-04 15:47:50 +0200432 val = ucontrol->value.integer.value[0];
433 if (mc->platform_max && val > mc->platform_max)
434 return -EINVAL;
435 if (val > max - min)
436 return -EINVAL;
437 if (val < 0)
438 return -EINVAL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000439 val_mask = mask << shift;
Olivier Deprez157378f2022-04-04 15:47:50 +0200440 val = (val + min) & mask;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000441 val = val << shift;
442
443 err = snd_soc_component_update_bits(component, reg, val_mask, val);
444 if (err < 0)
445 return err;
446
447 if (snd_soc_volsw_is_stereo(mc)) {
448 val_mask = mask << rshift;
449 val2 = (ucontrol->value.integer.value[1] + min) & mask;
450 val2 = val2 << rshift;
451
452 err = snd_soc_component_update_bits(component, reg2, val_mask,
453 val2);
454 }
455 return err;
456}
457EXPORT_SYMBOL_GPL(snd_soc_put_volsw_sx);
458
459/**
460 * snd_soc_info_volsw_range - single mixer info callback with range.
461 * @kcontrol: mixer control
462 * @uinfo: control element information
463 *
464 * Callback to provide information, within a range, about a single
465 * mixer control.
466 *
467 * returns 0 for success.
468 */
469int snd_soc_info_volsw_range(struct snd_kcontrol *kcontrol,
470 struct snd_ctl_elem_info *uinfo)
471{
472 struct soc_mixer_control *mc =
473 (struct soc_mixer_control *)kcontrol->private_value;
474 int platform_max;
475 int min = mc->min;
476
477 if (!mc->platform_max)
478 mc->platform_max = mc->max;
479 platform_max = mc->platform_max;
480
481 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
482 uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1;
483 uinfo->value.integer.min = 0;
484 uinfo->value.integer.max = platform_max - min;
485
486 return 0;
487}
488EXPORT_SYMBOL_GPL(snd_soc_info_volsw_range);
489
490/**
491 * snd_soc_put_volsw_range - single mixer put value callback with range.
492 * @kcontrol: mixer control
493 * @ucontrol: control element information
494 *
495 * Callback to set the value, within a range, for a single mixer control.
496 *
497 * Returns 0 for success.
498 */
499int snd_soc_put_volsw_range(struct snd_kcontrol *kcontrol,
500 struct snd_ctl_elem_value *ucontrol)
501{
502 struct soc_mixer_control *mc =
503 (struct soc_mixer_control *)kcontrol->private_value;
504 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
505 unsigned int reg = mc->reg;
506 unsigned int rreg = mc->rreg;
507 unsigned int shift = mc->shift;
508 int min = mc->min;
509 int max = mc->max;
510 unsigned int mask = (1 << fls(max)) - 1;
511 unsigned int invert = mc->invert;
512 unsigned int val, val_mask;
Olivier Deprez157378f2022-04-04 15:47:50 +0200513 int err, ret;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000514
515 if (invert)
516 val = (max - ucontrol->value.integer.value[0]) & mask;
517 else
518 val = ((ucontrol->value.integer.value[0] + min) & mask);
519 val_mask = mask << shift;
520 val = val << shift;
521
Olivier Deprez157378f2022-04-04 15:47:50 +0200522 err = snd_soc_component_update_bits(component, reg, val_mask, val);
523 if (err < 0)
524 return err;
525 ret = err;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000526
527 if (snd_soc_volsw_is_stereo(mc)) {
528 if (invert)
529 val = (max - ucontrol->value.integer.value[1]) & mask;
530 else
531 val = ((ucontrol->value.integer.value[1] + min) & mask);
532 val_mask = mask << shift;
533 val = val << shift;
534
Olivier Deprez157378f2022-04-04 15:47:50 +0200535 err = snd_soc_component_update_bits(component, rreg, val_mask,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000536 val);
Olivier Deprez157378f2022-04-04 15:47:50 +0200537 /* Don't discard any error code or drop change flag */
538 if (ret == 0 || err < 0) {
539 ret = err;
540 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000541 }
542
543 return ret;
544}
545EXPORT_SYMBOL_GPL(snd_soc_put_volsw_range);
546
547/**
548 * snd_soc_get_volsw_range - single mixer get callback with range
549 * @kcontrol: mixer control
550 * @ucontrol: control element information
551 *
552 * Callback to get the value, within a range, of a single mixer control.
553 *
554 * Returns 0 for success.
555 */
556int snd_soc_get_volsw_range(struct snd_kcontrol *kcontrol,
557 struct snd_ctl_elem_value *ucontrol)
558{
559 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
560 struct soc_mixer_control *mc =
561 (struct soc_mixer_control *)kcontrol->private_value;
562 unsigned int reg = mc->reg;
563 unsigned int rreg = mc->rreg;
564 unsigned int shift = mc->shift;
565 int min = mc->min;
566 int max = mc->max;
567 unsigned int mask = (1 << fls(max)) - 1;
568 unsigned int invert = mc->invert;
569 unsigned int val;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000570
Olivier Deprez157378f2022-04-04 15:47:50 +0200571 val = snd_soc_component_read(component, reg);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000572 ucontrol->value.integer.value[0] = (val >> shift) & mask;
573 if (invert)
574 ucontrol->value.integer.value[0] =
575 max - ucontrol->value.integer.value[0];
576 else
577 ucontrol->value.integer.value[0] =
578 ucontrol->value.integer.value[0] - min;
579
580 if (snd_soc_volsw_is_stereo(mc)) {
Olivier Deprez157378f2022-04-04 15:47:50 +0200581 val = snd_soc_component_read(component, rreg);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000582 ucontrol->value.integer.value[1] = (val >> shift) & mask;
583 if (invert)
584 ucontrol->value.integer.value[1] =
585 max - ucontrol->value.integer.value[1];
586 else
587 ucontrol->value.integer.value[1] =
588 ucontrol->value.integer.value[1] - min;
589 }
590
591 return 0;
592}
593EXPORT_SYMBOL_GPL(snd_soc_get_volsw_range);
594
595/**
596 * snd_soc_limit_volume - Set new limit to an existing volume control.
597 *
598 * @card: where to look for the control
599 * @name: Name of the control
600 * @max: new maximum limit
601 *
602 * Return 0 for success, else error.
603 */
604int snd_soc_limit_volume(struct snd_soc_card *card,
605 const char *name, int max)
606{
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000607 struct snd_kcontrol *kctl;
608 struct soc_mixer_control *mc;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000609 int ret = -EINVAL;
610
611 /* Sanity check for name and max */
612 if (unlikely(!name || max <= 0))
613 return -EINVAL;
614
Olivier Deprez157378f2022-04-04 15:47:50 +0200615 kctl = snd_soc_card_get_kcontrol(card, name);
616 if (kctl) {
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000617 mc = (struct soc_mixer_control *)kctl->private_value;
618 if (max <= mc->max) {
619 mc->platform_max = max;
620 ret = 0;
621 }
622 }
623 return ret;
624}
625EXPORT_SYMBOL_GPL(snd_soc_limit_volume);
626
627int snd_soc_bytes_info(struct snd_kcontrol *kcontrol,
628 struct snd_ctl_elem_info *uinfo)
629{
630 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
631 struct soc_bytes *params = (void *)kcontrol->private_value;
632
633 uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
634 uinfo->count = params->num_regs * component->val_bytes;
635
636 return 0;
637}
638EXPORT_SYMBOL_GPL(snd_soc_bytes_info);
639
640int snd_soc_bytes_get(struct snd_kcontrol *kcontrol,
641 struct snd_ctl_elem_value *ucontrol)
642{
643 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
644 struct soc_bytes *params = (void *)kcontrol->private_value;
645 int ret;
646
647 if (component->regmap)
648 ret = regmap_raw_read(component->regmap, params->base,
649 ucontrol->value.bytes.data,
650 params->num_regs * component->val_bytes);
651 else
652 ret = -EINVAL;
653
654 /* Hide any masked bytes to ensure consistent data reporting */
655 if (ret == 0 && params->mask) {
656 switch (component->val_bytes) {
657 case 1:
658 ucontrol->value.bytes.data[0] &= ~params->mask;
659 break;
660 case 2:
661 ((u16 *)(&ucontrol->value.bytes.data))[0]
662 &= cpu_to_be16(~params->mask);
663 break;
664 case 4:
665 ((u32 *)(&ucontrol->value.bytes.data))[0]
666 &= cpu_to_be32(~params->mask);
667 break;
668 default:
669 return -EINVAL;
670 }
671 }
672
673 return ret;
674}
675EXPORT_SYMBOL_GPL(snd_soc_bytes_get);
676
677int snd_soc_bytes_put(struct snd_kcontrol *kcontrol,
678 struct snd_ctl_elem_value *ucontrol)
679{
680 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
681 struct soc_bytes *params = (void *)kcontrol->private_value;
682 int ret, len;
683 unsigned int val, mask;
684 void *data;
685
686 if (!component->regmap || !params->num_regs)
687 return -EINVAL;
688
689 len = params->num_regs * component->val_bytes;
690
691 data = kmemdup(ucontrol->value.bytes.data, len, GFP_KERNEL | GFP_DMA);
692 if (!data)
693 return -ENOMEM;
694
695 /*
696 * If we've got a mask then we need to preserve the register
697 * bits. We shouldn't modify the incoming data so take a
698 * copy.
699 */
700 if (params->mask) {
701 ret = regmap_read(component->regmap, params->base, &val);
702 if (ret != 0)
703 goto out;
704
705 val &= params->mask;
706
707 switch (component->val_bytes) {
708 case 1:
709 ((u8 *)data)[0] &= ~params->mask;
710 ((u8 *)data)[0] |= val;
711 break;
712 case 2:
713 mask = ~params->mask;
714 ret = regmap_parse_val(component->regmap,
715 &mask, &mask);
716 if (ret != 0)
717 goto out;
718
719 ((u16 *)data)[0] &= mask;
720
721 ret = regmap_parse_val(component->regmap,
722 &val, &val);
723 if (ret != 0)
724 goto out;
725
726 ((u16 *)data)[0] |= val;
727 break;
728 case 4:
729 mask = ~params->mask;
730 ret = regmap_parse_val(component->regmap,
731 &mask, &mask);
732 if (ret != 0)
733 goto out;
734
735 ((u32 *)data)[0] &= mask;
736
737 ret = regmap_parse_val(component->regmap,
738 &val, &val);
739 if (ret != 0)
740 goto out;
741
742 ((u32 *)data)[0] |= val;
743 break;
744 default:
745 ret = -EINVAL;
746 goto out;
747 }
748 }
749
750 ret = regmap_raw_write(component->regmap, params->base,
751 data, len);
752
753out:
754 kfree(data);
755
756 return ret;
757}
758EXPORT_SYMBOL_GPL(snd_soc_bytes_put);
759
760int snd_soc_bytes_info_ext(struct snd_kcontrol *kcontrol,
761 struct snd_ctl_elem_info *ucontrol)
762{
763 struct soc_bytes_ext *params = (void *)kcontrol->private_value;
764
765 ucontrol->type = SNDRV_CTL_ELEM_TYPE_BYTES;
766 ucontrol->count = params->max;
767
768 return 0;
769}
770EXPORT_SYMBOL_GPL(snd_soc_bytes_info_ext);
771
772int snd_soc_bytes_tlv_callback(struct snd_kcontrol *kcontrol, int op_flag,
773 unsigned int size, unsigned int __user *tlv)
774{
775 struct soc_bytes_ext *params = (void *)kcontrol->private_value;
776 unsigned int count = size < params->max ? size : params->max;
777 int ret = -ENXIO;
778
779 switch (op_flag) {
780 case SNDRV_CTL_TLV_OP_READ:
781 if (params->get)
782 ret = params->get(kcontrol, tlv, count);
783 break;
784 case SNDRV_CTL_TLV_OP_WRITE:
785 if (params->put)
786 ret = params->put(kcontrol, tlv, count);
787 break;
788 }
789 return ret;
790}
791EXPORT_SYMBOL_GPL(snd_soc_bytes_tlv_callback);
792
793/**
794 * snd_soc_info_xr_sx - signed multi register info callback
795 * @kcontrol: mreg control
796 * @uinfo: control element information
797 *
798 * Callback to provide information of a control that can
799 * span multiple codec registers which together
800 * forms a single signed value in a MSB/LSB manner.
801 *
802 * Returns 0 for success.
803 */
804int snd_soc_info_xr_sx(struct snd_kcontrol *kcontrol,
805 struct snd_ctl_elem_info *uinfo)
806{
807 struct soc_mreg_control *mc =
808 (struct soc_mreg_control *)kcontrol->private_value;
809 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
810 uinfo->count = 1;
811 uinfo->value.integer.min = mc->min;
812 uinfo->value.integer.max = mc->max;
813
814 return 0;
815}
816EXPORT_SYMBOL_GPL(snd_soc_info_xr_sx);
817
818/**
819 * snd_soc_get_xr_sx - signed multi register get callback
820 * @kcontrol: mreg control
821 * @ucontrol: control element information
822 *
823 * Callback to get the value of a control that can span
824 * multiple codec registers which together forms a single
825 * signed value in a MSB/LSB manner. The control supports
826 * specifying total no of bits used to allow for bitfields
827 * across the multiple codec registers.
828 *
829 * Returns 0 for success.
830 */
831int snd_soc_get_xr_sx(struct snd_kcontrol *kcontrol,
832 struct snd_ctl_elem_value *ucontrol)
833{
834 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
835 struct soc_mreg_control *mc =
836 (struct soc_mreg_control *)kcontrol->private_value;
837 unsigned int regbase = mc->regbase;
838 unsigned int regcount = mc->regcount;
839 unsigned int regwshift = component->val_bytes * BITS_PER_BYTE;
Olivier Deprez0e641232021-09-23 10:07:05 +0200840 unsigned int regwmask = (1UL<<regwshift)-1;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000841 unsigned int invert = mc->invert;
842 unsigned long mask = (1UL<<mc->nbits)-1;
843 long min = mc->min;
844 long max = mc->max;
845 long val = 0;
846 unsigned int regval;
847 unsigned int i;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000848
849 for (i = 0; i < regcount; i++) {
Olivier Deprez157378f2022-04-04 15:47:50 +0200850 regval = snd_soc_component_read(component, regbase+i);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000851 val |= (regval & regwmask) << (regwshift*(regcount-i-1));
852 }
853 val &= mask;
854 if (min < 0 && val > max)
855 val |= ~mask;
856 if (invert)
857 val = max - val;
858 ucontrol->value.integer.value[0] = val;
859
860 return 0;
861}
862EXPORT_SYMBOL_GPL(snd_soc_get_xr_sx);
863
864/**
865 * snd_soc_put_xr_sx - signed multi register get callback
866 * @kcontrol: mreg control
867 * @ucontrol: control element information
868 *
869 * Callback to set 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_put_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;
Olivier Deprez0e641232021-09-23 10:07:05 +0200886 unsigned int regwmask = (1UL<<regwshift)-1;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000887 unsigned int invert = mc->invert;
888 unsigned long mask = (1UL<<mc->nbits)-1;
889 long max = mc->max;
890 long val = ucontrol->value.integer.value[0];
891 unsigned int i, regval, regmask;
892 int err;
893
Olivier Deprez157378f2022-04-04 15:47:50 +0200894 if (val < mc->min || val > mc->max)
895 return -EINVAL;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000896 if (invert)
897 val = max - val;
898 val &= mask;
899 for (i = 0; i < regcount; i++) {
900 regval = (val >> (regwshift*(regcount-i-1))) & regwmask;
901 regmask = (mask >> (regwshift*(regcount-i-1))) & regwmask;
902 err = snd_soc_component_update_bits(component, regbase+i,
903 regmask, regval);
904 if (err < 0)
905 return err;
906 }
907
908 return 0;
909}
910EXPORT_SYMBOL_GPL(snd_soc_put_xr_sx);
911
912/**
913 * snd_soc_get_strobe - strobe get callback
914 * @kcontrol: mixer control
915 * @ucontrol: control element information
916 *
917 * Callback get the value of a strobe mixer control.
918 *
919 * Returns 0 for success.
920 */
921int snd_soc_get_strobe(struct snd_kcontrol *kcontrol,
922 struct snd_ctl_elem_value *ucontrol)
923{
924 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
925 struct soc_mixer_control *mc =
926 (struct soc_mixer_control *)kcontrol->private_value;
927 unsigned int reg = mc->reg;
928 unsigned int shift = mc->shift;
929 unsigned int mask = 1 << shift;
930 unsigned int invert = mc->invert != 0;
931 unsigned int val;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000932
Olivier Deprez157378f2022-04-04 15:47:50 +0200933 val = snd_soc_component_read(component, reg);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000934 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);