xref: /openbmc/linux/sound/soc/soc-ops.c (revision 83a530e1)
1 /*
2  * soc-ops.c  --  Generic ASoC operations
3  *
4  * Copyright 2005 Wolfson Microelectronics PLC.
5  * Copyright 2005 Openedhand Ltd.
6  * Copyright (C) 2010 Slimlogic Ltd.
7  * Copyright (C) 2010 Texas Instruments Inc.
8  *
9  * Author: Liam Girdwood <lrg@slimlogic.co.uk>
10  *         with code, comments and ideas from :-
11  *         Richard Purdie <richard@openedhand.com>
12  *
13  *  This program is free software; you can redistribute  it and/or modify it
14  *  under  the terms of  the GNU General  Public License as published by the
15  *  Free Software Foundation;  either version 2 of the  License, or (at your
16  *  option) any later version.
17  */
18 
19 #include <linux/module.h>
20 #include <linux/moduleparam.h>
21 #include <linux/init.h>
22 #include <linux/delay.h>
23 #include <linux/pm.h>
24 #include <linux/bitops.h>
25 #include <linux/ctype.h>
26 #include <linux/slab.h>
27 #include <sound/core.h>
28 #include <sound/jack.h>
29 #include <sound/pcm.h>
30 #include <sound/pcm_params.h>
31 #include <sound/soc.h>
32 #include <sound/soc-dpcm.h>
33 #include <sound/initval.h>
34 
35 /**
36  * snd_soc_info_enum_double - enumerated double mixer info callback
37  * @kcontrol: mixer control
38  * @uinfo: control element information
39  *
40  * Callback to provide information about a double enumerated
41  * mixer control.
42  *
43  * Returns 0 for success.
44  */
45 int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol,
46 	struct snd_ctl_elem_info *uinfo)
47 {
48 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
49 
50 	return snd_ctl_enum_info(uinfo, e->shift_l == e->shift_r ? 1 : 2,
51 				 e->items, e->texts);
52 }
53 EXPORT_SYMBOL_GPL(snd_soc_info_enum_double);
54 
55 /**
56  * snd_soc_get_enum_double - enumerated double mixer get callback
57  * @kcontrol: mixer control
58  * @ucontrol: control element information
59  *
60  * Callback to get the value of a double enumerated mixer.
61  *
62  * Returns 0 for success.
63  */
64 int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol,
65 	struct snd_ctl_elem_value *ucontrol)
66 {
67 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
68 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
69 	unsigned int val, item;
70 	unsigned int reg_val;
71 	int ret;
72 
73 	ret = snd_soc_component_read(component, e->reg, &reg_val);
74 	if (ret)
75 		return ret;
76 	val = (reg_val >> e->shift_l) & e->mask;
77 	item = snd_soc_enum_val_to_item(e, val);
78 	ucontrol->value.enumerated.item[0] = item;
79 	if (e->shift_l != e->shift_r) {
80 		val = (reg_val >> e->shift_r) & e->mask;
81 		item = snd_soc_enum_val_to_item(e, val);
82 		ucontrol->value.enumerated.item[1] = item;
83 	}
84 
85 	return 0;
86 }
87 EXPORT_SYMBOL_GPL(snd_soc_get_enum_double);
88 
89 /**
90  * snd_soc_put_enum_double - enumerated double mixer put callback
91  * @kcontrol: mixer control
92  * @ucontrol: control element information
93  *
94  * Callback to set the value of a double enumerated mixer.
95  *
96  * Returns 0 for success.
97  */
98 int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol,
99 	struct snd_ctl_elem_value *ucontrol)
100 {
101 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
102 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
103 	unsigned int *item = ucontrol->value.enumerated.item;
104 	unsigned int val;
105 	unsigned int mask;
106 
107 	if (item[0] >= e->items)
108 		return -EINVAL;
109 	val = snd_soc_enum_item_to_val(e, item[0]) << e->shift_l;
110 	mask = e->mask << e->shift_l;
111 	if (e->shift_l != e->shift_r) {
112 		if (item[1] >= e->items)
113 			return -EINVAL;
114 		val |= snd_soc_enum_item_to_val(e, item[1]) << e->shift_r;
115 		mask |= e->mask << e->shift_r;
116 	}
117 
118 	return snd_soc_component_update_bits(component, e->reg, mask, val);
119 }
120 EXPORT_SYMBOL_GPL(snd_soc_put_enum_double);
121 
122 /**
123  * snd_soc_read_signed - Read a codec register and interpret as signed value
124  * @component: component
125  * @reg: Register to read
126  * @mask: Mask to use after shifting the register value
127  * @shift: Right shift of register value
128  * @sign_bit: Bit that describes if a number is negative or not.
129  * @signed_val: Pointer to where the read value should be stored
130  *
131  * This functions reads a codec register. The register value is shifted right
132  * by 'shift' bits and masked with the given 'mask'. Afterwards it translates
133  * the given registervalue into a signed integer if sign_bit is non-zero.
134  *
135  * Returns 0 on sucess, otherwise an error value
136  */
137 static int snd_soc_read_signed(struct snd_soc_component *component,
138 	unsigned int reg, unsigned int mask, unsigned int shift,
139 	unsigned int sign_bit, int *signed_val)
140 {
141 	int ret;
142 	unsigned int val;
143 
144 	ret = snd_soc_component_read(component, reg, &val);
145 	if (ret < 0)
146 		return ret;
147 
148 	val = (val >> shift) & mask;
149 
150 	if (!sign_bit) {
151 		*signed_val = val;
152 		return 0;
153 	}
154 
155 	/* non-negative number */
156 	if (!(val & BIT(sign_bit))) {
157 		*signed_val = val;
158 		return 0;
159 	}
160 
161 	ret = val;
162 
163 	/*
164 	 * The register most probably does not contain a full-sized int.
165 	 * Instead we have an arbitrary number of bits in a signed
166 	 * representation which has to be translated into a full-sized int.
167 	 * This is done by filling up all bits above the sign-bit.
168 	 */
169 	ret |= ~((int)(BIT(sign_bit) - 1));
170 
171 	*signed_val = ret;
172 
173 	return 0;
174 }
175 
176 /**
177  * snd_soc_info_volsw - single mixer info callback
178  * @kcontrol: mixer control
179  * @uinfo: control element information
180  *
181  * Callback to provide information about a single mixer control, or a double
182  * mixer control that spans 2 registers.
183  *
184  * Returns 0 for success.
185  */
186 int snd_soc_info_volsw(struct snd_kcontrol *kcontrol,
187 	struct snd_ctl_elem_info *uinfo)
188 {
189 	struct soc_mixer_control *mc =
190 		(struct soc_mixer_control *)kcontrol->private_value;
191 	int platform_max;
192 
193 	if (!mc->platform_max)
194 		mc->platform_max = mc->max;
195 	platform_max = mc->platform_max;
196 
197 	if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume"))
198 		uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
199 	else
200 		uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
201 
202 	uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1;
203 	uinfo->value.integer.min = 0;
204 	uinfo->value.integer.max = platform_max - mc->min;
205 	return 0;
206 }
207 EXPORT_SYMBOL_GPL(snd_soc_info_volsw);
208 
209 /**
210  * snd_soc_info_volsw_sx - Mixer info callback for SX TLV controls
211  * @kcontrol: mixer control
212  * @uinfo: control element information
213  *
214  * Callback to provide information about a single mixer control, or a double
215  * mixer control that spans 2 registers of the SX TLV type. SX TLV controls
216  * have a range that represents both positive and negative values either side
217  * of zero but without a sign bit.
218  *
219  * Returns 0 for success.
220  */
221 int snd_soc_info_volsw_sx(struct snd_kcontrol *kcontrol,
222 			  struct snd_ctl_elem_info *uinfo)
223 {
224 	struct soc_mixer_control *mc =
225 		(struct soc_mixer_control *)kcontrol->private_value;
226 
227 	snd_soc_info_volsw(kcontrol, uinfo);
228 	/* Max represents the number of levels in an SX control not the
229 	 * maximum value, so add the minimum value back on
230 	 */
231 	uinfo->value.integer.max += mc->min;
232 
233 	return 0;
234 }
235 EXPORT_SYMBOL_GPL(snd_soc_info_volsw_sx);
236 
237 /**
238  * snd_soc_get_volsw - single mixer get callback
239  * @kcontrol: mixer control
240  * @ucontrol: control element information
241  *
242  * Callback to get the value of a single mixer control, or a double mixer
243  * control that spans 2 registers.
244  *
245  * Returns 0 for success.
246  */
247 int snd_soc_get_volsw(struct snd_kcontrol *kcontrol,
248 	struct snd_ctl_elem_value *ucontrol)
249 {
250 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
251 	struct soc_mixer_control *mc =
252 		(struct soc_mixer_control *)kcontrol->private_value;
253 	unsigned int reg = mc->reg;
254 	unsigned int reg2 = mc->rreg;
255 	unsigned int shift = mc->shift;
256 	unsigned int rshift = mc->rshift;
257 	int max = mc->max;
258 	int min = mc->min;
259 	int sign_bit = mc->sign_bit;
260 	unsigned int mask = (1 << fls(max)) - 1;
261 	unsigned int invert = mc->invert;
262 	int val;
263 	int ret;
264 
265 	if (sign_bit)
266 		mask = BIT(sign_bit + 1) - 1;
267 
268 	ret = snd_soc_read_signed(component, reg, mask, shift, sign_bit, &val);
269 	if (ret)
270 		return ret;
271 
272 	ucontrol->value.integer.value[0] = val - min;
273 	if (invert)
274 		ucontrol->value.integer.value[0] =
275 			max - ucontrol->value.integer.value[0];
276 
277 	if (snd_soc_volsw_is_stereo(mc)) {
278 		if (reg == reg2)
279 			ret = snd_soc_read_signed(component, reg, mask, rshift,
280 				sign_bit, &val);
281 		else
282 			ret = snd_soc_read_signed(component, reg2, mask, shift,
283 				sign_bit, &val);
284 		if (ret)
285 			return ret;
286 
287 		ucontrol->value.integer.value[1] = val - min;
288 		if (invert)
289 			ucontrol->value.integer.value[1] =
290 				max - ucontrol->value.integer.value[1];
291 	}
292 
293 	return 0;
294 }
295 EXPORT_SYMBOL_GPL(snd_soc_get_volsw);
296 
297 /**
298  * snd_soc_put_volsw - single mixer put callback
299  * @kcontrol: mixer control
300  * @ucontrol: control element information
301  *
302  * Callback to set the value of a single mixer control, or a double mixer
303  * control that spans 2 registers.
304  *
305  * Returns 0 for success.
306  */
307 int snd_soc_put_volsw(struct snd_kcontrol *kcontrol,
308 	struct snd_ctl_elem_value *ucontrol)
309 {
310 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
311 	struct soc_mixer_control *mc =
312 		(struct soc_mixer_control *)kcontrol->private_value;
313 	unsigned int reg = mc->reg;
314 	unsigned int reg2 = mc->rreg;
315 	unsigned int shift = mc->shift;
316 	unsigned int rshift = mc->rshift;
317 	int max = mc->max;
318 	int min = mc->min;
319 	unsigned int sign_bit = mc->sign_bit;
320 	unsigned int mask = (1 << fls(max)) - 1;
321 	unsigned int invert = mc->invert;
322 	int err;
323 	bool type_2r = false;
324 	unsigned int val2 = 0;
325 	unsigned int val, val_mask;
326 
327 	if (sign_bit)
328 		mask = BIT(sign_bit + 1) - 1;
329 
330 	val = ((ucontrol->value.integer.value[0] + min) & mask);
331 	if (invert)
332 		val = max - val;
333 	val_mask = mask << shift;
334 	val = val << shift;
335 	if (snd_soc_volsw_is_stereo(mc)) {
336 		val2 = ((ucontrol->value.integer.value[1] + min) & mask);
337 		if (invert)
338 			val2 = max - val2;
339 		if (reg == reg2) {
340 			val_mask |= mask << rshift;
341 			val |= val2 << rshift;
342 		} else {
343 			val2 = val2 << shift;
344 			type_2r = true;
345 		}
346 	}
347 	err = snd_soc_component_update_bits(component, reg, val_mask, val);
348 	if (err < 0)
349 		return err;
350 
351 	if (type_2r)
352 		err = snd_soc_component_update_bits(component, reg2, val_mask,
353 			val2);
354 
355 	return err;
356 }
357 EXPORT_SYMBOL_GPL(snd_soc_put_volsw);
358 
359 /**
360  * snd_soc_get_volsw_sx - single mixer get callback
361  * @kcontrol: mixer control
362  * @ucontrol: control element information
363  *
364  * Callback to get the value of a single mixer control, or a double mixer
365  * control that spans 2 registers.
366  *
367  * Returns 0 for success.
368  */
369 int snd_soc_get_volsw_sx(struct snd_kcontrol *kcontrol,
370 		      struct snd_ctl_elem_value *ucontrol)
371 {
372 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
373 	struct soc_mixer_control *mc =
374 	    (struct soc_mixer_control *)kcontrol->private_value;
375 	unsigned int reg = mc->reg;
376 	unsigned int reg2 = mc->rreg;
377 	unsigned int shift = mc->shift;
378 	unsigned int rshift = mc->rshift;
379 	int max = mc->max;
380 	int min = mc->min;
381 	unsigned int mask = (1 << (fls(min + max) - 1)) - 1;
382 	unsigned int val;
383 	int ret;
384 
385 	ret = snd_soc_component_read(component, reg, &val);
386 	if (ret < 0)
387 		return ret;
388 
389 	ucontrol->value.integer.value[0] = ((val >> shift) - min) & mask;
390 
391 	if (snd_soc_volsw_is_stereo(mc)) {
392 		ret = snd_soc_component_read(component, reg2, &val);
393 		if (ret < 0)
394 			return ret;
395 
396 		val = ((val >> rshift) - min) & mask;
397 		ucontrol->value.integer.value[1] = val;
398 	}
399 
400 	return 0;
401 }
402 EXPORT_SYMBOL_GPL(snd_soc_get_volsw_sx);
403 
404 /**
405  * snd_soc_put_volsw_sx - double mixer set callback
406  * @kcontrol: mixer control
407  * @ucontrol: control element information
408  *
409  * Callback to set the value of a double mixer control that spans 2 registers.
410  *
411  * Returns 0 for success.
412  */
413 int snd_soc_put_volsw_sx(struct snd_kcontrol *kcontrol,
414 			 struct snd_ctl_elem_value *ucontrol)
415 {
416 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
417 	struct soc_mixer_control *mc =
418 	    (struct soc_mixer_control *)kcontrol->private_value;
419 
420 	unsigned int reg = mc->reg;
421 	unsigned int reg2 = mc->rreg;
422 	unsigned int shift = mc->shift;
423 	unsigned int rshift = mc->rshift;
424 	int max = mc->max;
425 	int min = mc->min;
426 	unsigned int mask = (1 << (fls(min + max) - 1)) - 1;
427 	int err = 0;
428 	unsigned int val, val_mask, val2 = 0;
429 
430 	val_mask = mask << shift;
431 	val = (ucontrol->value.integer.value[0] + min) & mask;
432 	val = val << shift;
433 
434 	err = snd_soc_component_update_bits(component, reg, val_mask, val);
435 	if (err < 0)
436 		return err;
437 
438 	if (snd_soc_volsw_is_stereo(mc)) {
439 		val_mask = mask << rshift;
440 		val2 = (ucontrol->value.integer.value[1] + min) & mask;
441 		val2 = val2 << rshift;
442 
443 		err = snd_soc_component_update_bits(component, reg2, val_mask,
444 			val2);
445 	}
446 	return err;
447 }
448 EXPORT_SYMBOL_GPL(snd_soc_put_volsw_sx);
449 
450 /**
451  * snd_soc_info_volsw_range - single mixer info callback with range.
452  * @kcontrol: mixer control
453  * @uinfo: control element information
454  *
455  * Callback to provide information, within a range, about a single
456  * mixer control.
457  *
458  * returns 0 for success.
459  */
460 int snd_soc_info_volsw_range(struct snd_kcontrol *kcontrol,
461 	struct snd_ctl_elem_info *uinfo)
462 {
463 	struct soc_mixer_control *mc =
464 		(struct soc_mixer_control *)kcontrol->private_value;
465 	int platform_max;
466 	int min = mc->min;
467 
468 	if (!mc->platform_max)
469 		mc->platform_max = mc->max;
470 	platform_max = mc->platform_max;
471 
472 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
473 	uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1;
474 	uinfo->value.integer.min = 0;
475 	uinfo->value.integer.max = platform_max - min;
476 
477 	return 0;
478 }
479 EXPORT_SYMBOL_GPL(snd_soc_info_volsw_range);
480 
481 /**
482  * snd_soc_put_volsw_range - single mixer put value callback with range.
483  * @kcontrol: mixer control
484  * @ucontrol: control element information
485  *
486  * Callback to set the value, within a range, for a single mixer control.
487  *
488  * Returns 0 for success.
489  */
490 int snd_soc_put_volsw_range(struct snd_kcontrol *kcontrol,
491 	struct snd_ctl_elem_value *ucontrol)
492 {
493 	struct soc_mixer_control *mc =
494 		(struct soc_mixer_control *)kcontrol->private_value;
495 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
496 	unsigned int reg = mc->reg;
497 	unsigned int rreg = mc->rreg;
498 	unsigned int shift = mc->shift;
499 	int min = mc->min;
500 	int max = mc->max;
501 	unsigned int mask = (1 << fls(max)) - 1;
502 	unsigned int invert = mc->invert;
503 	unsigned int val, val_mask;
504 	int ret;
505 
506 	if (invert)
507 		val = (max - ucontrol->value.integer.value[0]) & mask;
508 	else
509 		val = ((ucontrol->value.integer.value[0] + min) & mask);
510 	val_mask = mask << shift;
511 	val = val << shift;
512 
513 	ret = snd_soc_component_update_bits(component, reg, val_mask, val);
514 	if (ret < 0)
515 		return ret;
516 
517 	if (snd_soc_volsw_is_stereo(mc)) {
518 		if (invert)
519 			val = (max - ucontrol->value.integer.value[1]) & mask;
520 		else
521 			val = ((ucontrol->value.integer.value[1] + min) & mask);
522 		val_mask = mask << shift;
523 		val = val << shift;
524 
525 		ret = snd_soc_component_update_bits(component, rreg, val_mask,
526 			val);
527 	}
528 
529 	return ret;
530 }
531 EXPORT_SYMBOL_GPL(snd_soc_put_volsw_range);
532 
533 /**
534  * snd_soc_get_volsw_range - single mixer get callback with range
535  * @kcontrol: mixer control
536  * @ucontrol: control element information
537  *
538  * Callback to get the value, within a range, of a single mixer control.
539  *
540  * Returns 0 for success.
541  */
542 int snd_soc_get_volsw_range(struct snd_kcontrol *kcontrol,
543 	struct snd_ctl_elem_value *ucontrol)
544 {
545 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
546 	struct soc_mixer_control *mc =
547 		(struct soc_mixer_control *)kcontrol->private_value;
548 	unsigned int reg = mc->reg;
549 	unsigned int rreg = mc->rreg;
550 	unsigned int shift = mc->shift;
551 	int min = mc->min;
552 	int max = mc->max;
553 	unsigned int mask = (1 << fls(max)) - 1;
554 	unsigned int invert = mc->invert;
555 	unsigned int val;
556 	int ret;
557 
558 	ret = snd_soc_component_read(component, reg, &val);
559 	if (ret)
560 		return ret;
561 
562 	ucontrol->value.integer.value[0] = (val >> shift) & mask;
563 	if (invert)
564 		ucontrol->value.integer.value[0] =
565 			max - ucontrol->value.integer.value[0];
566 	else
567 		ucontrol->value.integer.value[0] =
568 			ucontrol->value.integer.value[0] - min;
569 
570 	if (snd_soc_volsw_is_stereo(mc)) {
571 		ret = snd_soc_component_read(component, rreg, &val);
572 		if (ret)
573 			return ret;
574 
575 		ucontrol->value.integer.value[1] = (val >> shift) & mask;
576 		if (invert)
577 			ucontrol->value.integer.value[1] =
578 				max - ucontrol->value.integer.value[1];
579 		else
580 			ucontrol->value.integer.value[1] =
581 				ucontrol->value.integer.value[1] - min;
582 	}
583 
584 	return 0;
585 }
586 EXPORT_SYMBOL_GPL(snd_soc_get_volsw_range);
587 
588 /**
589  * snd_soc_limit_volume - Set new limit to an existing volume control.
590  *
591  * @card: where to look for the control
592  * @name: Name of the control
593  * @max: new maximum limit
594  *
595  * Return 0 for success, else error.
596  */
597 int snd_soc_limit_volume(struct snd_soc_card *card,
598 	const char *name, int max)
599 {
600 	struct snd_card *snd_card = card->snd_card;
601 	struct snd_kcontrol *kctl;
602 	struct soc_mixer_control *mc;
603 	int found = 0;
604 	int ret = -EINVAL;
605 
606 	/* Sanity check for name and max */
607 	if (unlikely(!name || max <= 0))
608 		return -EINVAL;
609 
610 	list_for_each_entry(kctl, &snd_card->controls, list) {
611 		if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name))) {
612 			found = 1;
613 			break;
614 		}
615 	}
616 	if (found) {
617 		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 }
625 EXPORT_SYMBOL_GPL(snd_soc_limit_volume);
626 
627 int 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 }
638 EXPORT_SYMBOL_GPL(snd_soc_bytes_info);
639 
640 int 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 }
675 EXPORT_SYMBOL_GPL(snd_soc_bytes_get);
676 
677 int 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 
753 out:
754 	kfree(data);
755 
756 	return ret;
757 }
758 EXPORT_SYMBOL_GPL(snd_soc_bytes_put);
759 
760 int 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 }
770 EXPORT_SYMBOL_GPL(snd_soc_bytes_info_ext);
771 
772 int 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 }
791 EXPORT_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  */
804 int 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 }
816 EXPORT_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  */
831 int 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;
840 	unsigned int regwmask = (1<<regwshift)-1;
841 	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;
848 	int ret;
849 
850 	for (i = 0; i < regcount; i++) {
851 		ret = snd_soc_component_read(component, regbase+i, &regval);
852 		if (ret)
853 			return ret;
854 		val |= (regval & regwmask) << (regwshift*(regcount-i-1));
855 	}
856 	val &= mask;
857 	if (min < 0 && val > max)
858 		val |= ~mask;
859 	if (invert)
860 		val = max - val;
861 	ucontrol->value.integer.value[0] = val;
862 
863 	return 0;
864 }
865 EXPORT_SYMBOL_GPL(snd_soc_get_xr_sx);
866 
867 /**
868  * snd_soc_put_xr_sx - signed multi register get callback
869  * @kcontrol: mreg control
870  * @ucontrol: control element information
871  *
872  * Callback to set the value of a control that can span
873  * multiple codec registers which together forms a single
874  * signed value in a MSB/LSB manner. The control supports
875  * specifying total no of bits used to allow for bitfields
876  * across the multiple codec registers.
877  *
878  * Returns 0 for success.
879  */
880 int snd_soc_put_xr_sx(struct snd_kcontrol *kcontrol,
881 	struct snd_ctl_elem_value *ucontrol)
882 {
883 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
884 	struct soc_mreg_control *mc =
885 		(struct soc_mreg_control *)kcontrol->private_value;
886 	unsigned int regbase = mc->regbase;
887 	unsigned int regcount = mc->regcount;
888 	unsigned int regwshift = component->val_bytes * BITS_PER_BYTE;
889 	unsigned int regwmask = (1<<regwshift)-1;
890 	unsigned int invert = mc->invert;
891 	unsigned long mask = (1UL<<mc->nbits)-1;
892 	long max = mc->max;
893 	long val = ucontrol->value.integer.value[0];
894 	unsigned int i, regval, regmask;
895 	int err;
896 
897 	if (invert)
898 		val = max - val;
899 	val &= mask;
900 	for (i = 0; i < regcount; i++) {
901 		regval = (val >> (regwshift*(regcount-i-1))) & regwmask;
902 		regmask = (mask >> (regwshift*(regcount-i-1))) & regwmask;
903 		err = snd_soc_component_update_bits(component, regbase+i,
904 				regmask, regval);
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;
933 	int ret;
934 
935 	ret = snd_soc_component_read(component, reg, &val);
936 	if (ret)
937 		return ret;
938 
939 	val &= mask;
940 
941 	if (shift != 0 && val != 0)
942 		val = val >> shift;
943 	ucontrol->value.enumerated.item[0] = val ^ invert;
944 
945 	return 0;
946 }
947 EXPORT_SYMBOL_GPL(snd_soc_get_strobe);
948 
949 /**
950  * snd_soc_put_strobe - strobe put callback
951  * @kcontrol: mixer control
952  * @ucontrol: control element information
953  *
954  * Callback strobe a register bit to high then low (or the inverse)
955  * in one pass of a single mixer enum control.
956  *
957  * Returns 1 for success.
958  */
959 int snd_soc_put_strobe(struct snd_kcontrol *kcontrol,
960 	struct snd_ctl_elem_value *ucontrol)
961 {
962 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
963 	struct soc_mixer_control *mc =
964 		(struct soc_mixer_control *)kcontrol->private_value;
965 	unsigned int reg = mc->reg;
966 	unsigned int shift = mc->shift;
967 	unsigned int mask = 1 << shift;
968 	unsigned int invert = mc->invert != 0;
969 	unsigned int strobe = ucontrol->value.enumerated.item[0] != 0;
970 	unsigned int val1 = (strobe ^ invert) ? mask : 0;
971 	unsigned int val2 = (strobe ^ invert) ? 0 : mask;
972 	int err;
973 
974 	err = snd_soc_component_update_bits(component, reg, mask, val1);
975 	if (err < 0)
976 		return err;
977 
978 	return snd_soc_component_update_bits(component, reg, mask, val2);
979 }
980 EXPORT_SYMBOL_GPL(snd_soc_put_strobe);
981