ALSA: pcm : Call kill_fasync() in stream lock
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / sound / core / vmaster.c
CommitLineData
3b0a5f22
TI
1/*
2 * Virtual master and slave controls
3 *
4 * Copyright (c) 2008 by Takashi Iwai <tiwai@suse.de>
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License as
8 * published by the Free Software Foundation, version 2.
9 *
10 */
11
12#include <linux/slab.h>
d81a6d71 13#include <linux/export.h>
3b0a5f22
TI
14#include <sound/core.h>
15#include <sound/control.h>
1c82ed1b 16#include <sound/tlv.h>
3b0a5f22
TI
17
18/*
19 * a subset of information returned via ctl info callback
20 */
21struct link_ctl_info {
fea952e5 22 snd_ctl_elem_type_t type; /* value type */
3b0a5f22
TI
23 int count; /* item count */
24 int min_val, max_val; /* min, max values */
25};
26
27/*
28 * link master - this contains a list of slave controls that are
29 * identical types, i.e. info returns the same value type and value
30 * ranges, but may have different number of counts.
31 *
32 * The master control is so far only mono volume/switch for simplicity.
33 * The same value will be applied to all slaves.
34 */
35struct link_master {
36 struct list_head slaves;
37 struct link_ctl_info info;
38 int val; /* the master value */
1c82ed1b 39 unsigned int tlv[4];
2ad787e9
TI
40 void (*hook)(void *private_data, int);
41 void *hook_private_data;
3b0a5f22
TI
42};
43
44/*
45 * link slave - this contains a slave control element
46 *
47 * It fakes the control callbacsk with additional attenuation by the
48 * master control. A slave may have either one or two channels.
49 */
50
51struct link_slave {
52 struct list_head list;
53 struct link_master *master;
54 struct link_ctl_info info;
55 int vals[2]; /* current values */
f5b1db63 56 unsigned int flags;
9e226b4b 57 struct snd_kcontrol *kctl; /* original kcontrol pointer */
3b0a5f22
TI
58 struct snd_kcontrol slave; /* the copy of original control entry */
59};
60
f5b1db63
TI
61static int slave_update(struct link_slave *slave)
62{
63 struct snd_ctl_elem_value *uctl;
64 int err, ch;
65
66 uctl = kmalloc(sizeof(*uctl), GFP_KERNEL);
67 if (!uctl)
68 return -ENOMEM;
69 uctl->id = slave->slave.id;
70 err = slave->slave.get(&slave->slave, uctl);
71 for (ch = 0; ch < slave->info.count; ch++)
72 slave->vals[ch] = uctl->value.integer.value[ch];
73 kfree(uctl);
74 return 0;
75}
76
3b0a5f22
TI
77/* get the slave ctl info and save the initial values */
78static int slave_init(struct link_slave *slave)
79{
80 struct snd_ctl_elem_info *uinfo;
f5b1db63 81 int err;
3b0a5f22 82
f5b1db63
TI
83 if (slave->info.count) {
84 /* already initialized */
85 if (slave->flags & SND_CTL_SLAVE_NEED_UPDATE)
86 return slave_update(slave);
87 return 0;
88 }
3b0a5f22
TI
89
90 uinfo = kmalloc(sizeof(*uinfo), GFP_KERNEL);
91 if (!uinfo)
92 return -ENOMEM;
93 uinfo->id = slave->slave.id;
94 err = slave->slave.info(&slave->slave, uinfo);
95 if (err < 0) {
96 kfree(uinfo);
97 return err;
98 }
99 slave->info.type = uinfo->type;
100 slave->info.count = uinfo->count;
101 if (slave->info.count > 2 ||
102 (slave->info.type != SNDRV_CTL_ELEM_TYPE_INTEGER &&
103 slave->info.type != SNDRV_CTL_ELEM_TYPE_BOOLEAN)) {
104 snd_printk(KERN_ERR "invalid slave element\n");
105 kfree(uinfo);
106 return -EINVAL;
107 }
108 slave->info.min_val = uinfo->value.integer.min;
109 slave->info.max_val = uinfo->value.integer.max;
110 kfree(uinfo);
111
f5b1db63 112 return slave_update(slave);
3b0a5f22
TI
113}
114
115/* initialize master volume */
116static int master_init(struct link_master *master)
117{
118 struct link_slave *slave;
119
120 if (master->info.count)
121 return 0; /* already initialized */
122
123 list_for_each_entry(slave, &master->slaves, list) {
124 int err = slave_init(slave);
125 if (err < 0)
126 return err;
127 master->info = slave->info;
128 master->info.count = 1; /* always mono */
129 /* set full volume as default (= no attenuation) */
130 master->val = master->info.max_val;
2ad787e9
TI
131 if (master->hook)
132 master->hook(master->hook_private_data, master->val);
133 return 1;
3b0a5f22
TI
134 }
135 return -ENOENT;
136}
137
138static int slave_get_val(struct link_slave *slave,
139 struct snd_ctl_elem_value *ucontrol)
140{
141 int err, ch;
142
143 err = slave_init(slave);
144 if (err < 0)
145 return err;
146 for (ch = 0; ch < slave->info.count; ch++)
147 ucontrol->value.integer.value[ch] = slave->vals[ch];
148 return 0;
149}
150
151static int slave_put_val(struct link_slave *slave,
152 struct snd_ctl_elem_value *ucontrol)
153{
154 int err, ch, vol;
155
156 err = master_init(slave->master);
157 if (err < 0)
158 return err;
159
160 switch (slave->info.type) {
161 case SNDRV_CTL_ELEM_TYPE_BOOLEAN:
162 for (ch = 0; ch < slave->info.count; ch++)
163 ucontrol->value.integer.value[ch] &=
164 !!slave->master->val;
165 break;
166 case SNDRV_CTL_ELEM_TYPE_INTEGER:
167 for (ch = 0; ch < slave->info.count; ch++) {
168 /* max master volume is supposed to be 0 dB */
169 vol = ucontrol->value.integer.value[ch];
170 vol += slave->master->val - slave->master->info.max_val;
171 if (vol < slave->info.min_val)
172 vol = slave->info.min_val;
173 else if (vol > slave->info.max_val)
174 vol = slave->info.max_val;
175 ucontrol->value.integer.value[ch] = vol;
176 }
177 break;
178 }
179 return slave->slave.put(&slave->slave, ucontrol);
180}
181
182/*
183 * ctl callbacks for slaves
184 */
185static int slave_info(struct snd_kcontrol *kcontrol,
186 struct snd_ctl_elem_info *uinfo)
187{
188 struct link_slave *slave = snd_kcontrol_chip(kcontrol);
189 return slave->slave.info(&slave->slave, uinfo);
190}
191
192static int slave_get(struct snd_kcontrol *kcontrol,
193 struct snd_ctl_elem_value *ucontrol)
194{
195 struct link_slave *slave = snd_kcontrol_chip(kcontrol);
196 return slave_get_val(slave, ucontrol);
197}
198
199static int slave_put(struct snd_kcontrol *kcontrol,
200 struct snd_ctl_elem_value *ucontrol)
201{
202 struct link_slave *slave = snd_kcontrol_chip(kcontrol);
203 int err, ch, changed = 0;
204
205 err = slave_init(slave);
206 if (err < 0)
207 return err;
208 for (ch = 0; ch < slave->info.count; ch++) {
209 if (slave->vals[ch] != ucontrol->value.integer.value[ch]) {
210 changed = 1;
211 slave->vals[ch] = ucontrol->value.integer.value[ch];
212 }
213 }
214 if (!changed)
215 return 0;
2069d483
TI
216 err = slave_put_val(slave, ucontrol);
217 if (err < 0)
218 return err;
219 return 1;
3b0a5f22
TI
220}
221
222static int slave_tlv_cmd(struct snd_kcontrol *kcontrol,
223 int op_flag, unsigned int size,
224 unsigned int __user *tlv)
225{
226 struct link_slave *slave = snd_kcontrol_chip(kcontrol);
227 /* FIXME: this assumes that the max volume is 0 dB */
228 return slave->slave.tlv.c(&slave->slave, op_flag, size, tlv);
229}
230
231static void slave_free(struct snd_kcontrol *kcontrol)
232{
233 struct link_slave *slave = snd_kcontrol_chip(kcontrol);
234 if (slave->slave.private_free)
235 slave->slave.private_free(&slave->slave);
236 if (slave->master)
237 list_del(&slave->list);
238 kfree(slave);
239}
240
241/*
242 * Add a slave control to the group with the given master control
243 *
244 * All slaves must be the same type (returning the same information
25985edc 245 * via info callback). The function doesn't check it, so it's your
3b0a5f22
TI
246 * responsibility.
247 *
248 * Also, some additional limitations:
249 * - at most two channels
250 * - logarithmic volume control (dB level), no linear volume
251 * - master can only attenuate the volume, no gain
252 */
f5b1db63
TI
253int _snd_ctl_add_slave(struct snd_kcontrol *master, struct snd_kcontrol *slave,
254 unsigned int flags)
3b0a5f22
TI
255{
256 struct link_master *master_link = snd_kcontrol_chip(master);
257 struct link_slave *srec;
258
259 srec = kzalloc(sizeof(*srec) +
260 slave->count * sizeof(*slave->vd), GFP_KERNEL);
261 if (!srec)
262 return -ENOMEM;
9e226b4b 263 srec->kctl = slave;
3b0a5f22
TI
264 srec->slave = *slave;
265 memcpy(srec->slave.vd, slave->vd, slave->count * sizeof(*slave->vd));
266 srec->master = master_link;
f5b1db63 267 srec->flags = flags;
3b0a5f22
TI
268
269 /* override callbacks */
270 slave->info = slave_info;
271 slave->get = slave_get;
272 slave->put = slave_put;
273 if (slave->vd[0].access & SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK)
274 slave->tlv.c = slave_tlv_cmd;
275 slave->private_data = srec;
276 slave->private_free = slave_free;
277
278 list_add_tail(&srec->list, &master_link->slaves);
279 return 0;
280}
f5b1db63 281EXPORT_SYMBOL(_snd_ctl_add_slave);
e922b002 282
3b0a5f22
TI
283/*
284 * ctl callbacks for master controls
285 */
286static int master_info(struct snd_kcontrol *kcontrol,
287 struct snd_ctl_elem_info *uinfo)
288{
289 struct link_master *master = snd_kcontrol_chip(kcontrol);
290 int ret;
291
292 ret = master_init(master);
293 if (ret < 0)
294 return ret;
295 uinfo->type = master->info.type;
296 uinfo->count = master->info.count;
297 uinfo->value.integer.min = master->info.min_val;
298 uinfo->value.integer.max = master->info.max_val;
299 return 0;
300}
301
302static int master_get(struct snd_kcontrol *kcontrol,
303 struct snd_ctl_elem_value *ucontrol)
304{
305 struct link_master *master = snd_kcontrol_chip(kcontrol);
306 int err = master_init(master);
307 if (err < 0)
308 return err;
309 ucontrol->value.integer.value[0] = master->val;
310 return 0;
311}
312
313static int master_put(struct snd_kcontrol *kcontrol,
314 struct snd_ctl_elem_value *ucontrol)
315{
316 struct link_master *master = snd_kcontrol_chip(kcontrol);
317 struct link_slave *slave;
318 struct snd_ctl_elem_value *uval;
319 int err, old_val;
320
321 err = master_init(master);
322 if (err < 0)
323 return err;
324 old_val = master->val;
325 if (ucontrol->value.integer.value[0] == old_val)
326 return 0;
327
328 uval = kmalloc(sizeof(*uval), GFP_KERNEL);
329 if (!uval)
330 return -ENOMEM;
331 list_for_each_entry(slave, &master->slaves, list) {
332 master->val = old_val;
333 uval->id = slave->slave.id;
334 slave_get_val(slave, uval);
335 master->val = ucontrol->value.integer.value[0];
336 slave_put_val(slave, uval);
337 }
338 kfree(uval);
2ad787e9
TI
339 if (master->hook && !err)
340 master->hook(master->hook_private_data, master->val);
3b0a5f22
TI
341 return 1;
342}
343
344static void master_free(struct snd_kcontrol *kcontrol)
345{
346 struct link_master *master = snd_kcontrol_chip(kcontrol);
9e226b4b
TI
347 struct link_slave *slave, *n;
348
349 /* free all slave links and retore the original slave kctls */
350 list_for_each_entry_safe(slave, n, &master->slaves, list) {
351 struct snd_kcontrol *sctl = slave->kctl;
352 struct list_head olist = sctl->list;
353 memcpy(sctl, &slave->slave, sizeof(*sctl));
354 memcpy(sctl->vd, slave->slave.vd,
355 sctl->count * sizeof(*sctl->vd));
356 sctl->list = olist; /* keep the current linked-list */
357 kfree(slave);
358 }
3b0a5f22
TI
359 kfree(master);
360}
361
362
79c7cdd5
TI
363/**
364 * snd_ctl_make_virtual_master - Create a virtual master control
365 * @name: name string of the control element to create
366 * @tlv: optional TLV int array for dB information
367 *
eb7c06e8 368 * Creates a virtual master control with the given name string.
79c7cdd5
TI
369 *
370 * After creating a vmaster element, you can add the slave controls
371 * via snd_ctl_add_slave() or snd_ctl_add_slave_uncached().
372 *
373 * The optional argument @tlv can be used to specify the TLV information
374 * for dB scale of the master control. It should be a single element
085f3065
TI
375 * with #SNDRV_CTL_TLVT_DB_SCALE, #SNDRV_CTL_TLV_DB_MINMAX or
376 * #SNDRV_CTL_TLVT_DB_MINMAX_MUTE type, and should be the max 0dB.
eb7c06e8
YB
377 *
378 * Return: The created control element, or %NULL for errors (ENOMEM).
3b0a5f22
TI
379 */
380struct snd_kcontrol *snd_ctl_make_virtual_master(char *name,
381 const unsigned int *tlv)
382{
383 struct link_master *master;
384 struct snd_kcontrol *kctl;
385 struct snd_kcontrol_new knew;
386
387 memset(&knew, 0, sizeof(knew));
388 knew.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
389 knew.name = name;
390 knew.info = master_info;
391
392 master = kzalloc(sizeof(*master), GFP_KERNEL);
393 if (!master)
394 return NULL;
395 INIT_LIST_HEAD(&master->slaves);
396
397 kctl = snd_ctl_new1(&knew, master);
398 if (!kctl) {
399 kfree(master);
400 return NULL;
401 }
402 /* override some callbacks */
403 kctl->info = master_info;
404 kctl->get = master_get;
405 kctl->put = master_put;
406 kctl->private_free = master_free;
407
408 /* additional (constant) TLV read */
085f3065
TI
409 if (tlv &&
410 (tlv[0] == SNDRV_CTL_TLVT_DB_SCALE ||
411 tlv[0] == SNDRV_CTL_TLVT_DB_MINMAX ||
412 tlv[0] == SNDRV_CTL_TLVT_DB_MINMAX_MUTE)) {
3b0a5f22 413 kctl->vd[0].access |= SNDRV_CTL_ELEM_ACCESS_TLV_READ;
1c82ed1b
TI
414 memcpy(master->tlv, tlv, sizeof(master->tlv));
415 kctl->tlv.p = master->tlv;
3b0a5f22 416 }
1c82ed1b 417
3b0a5f22
TI
418 return kctl;
419}
e922b002 420EXPORT_SYMBOL(snd_ctl_make_virtual_master);
2ad787e9
TI
421
422/**
423 * snd_ctl_add_vmaster_hook - Add a hook to a vmaster control
424 * @kcontrol: vmaster kctl element
425 * @hook: the hook function
f2ec52d4 426 * @private_data: the private_data pointer to be saved
2ad787e9
TI
427 *
428 * Adds the given hook to the vmaster control element so that it's called
429 * at each time when the value is changed.
eb7c06e8
YB
430 *
431 * Return: Zero.
2ad787e9
TI
432 */
433int snd_ctl_add_vmaster_hook(struct snd_kcontrol *kcontrol,
434 void (*hook)(void *private_data, int),
435 void *private_data)
436{
437 struct link_master *master = snd_kcontrol_chip(kcontrol);
438 master->hook = hook;
439 master->hook_private_data = private_data;
440 return 0;
441}
442EXPORT_SYMBOL_GPL(snd_ctl_add_vmaster_hook);
443
444/**
445 * snd_ctl_sync_vmaster_hook - Sync the vmaster hook
446 * @kcontrol: vmaster kctl element
447 *
448 * Call the hook function to synchronize with the current value of the given
449 * vmaster element. NOP when NULL is passed to @kcontrol or the hook doesn't
450 * exist.
451 */
452void snd_ctl_sync_vmaster_hook(struct snd_kcontrol *kcontrol)
453{
454 struct link_master *master;
455 if (!kcontrol)
456 return;
457 master = snd_kcontrol_chip(kcontrol);
458 if (master->hook)
459 master->hook(master->hook_private_data, master->val);
460}
461EXPORT_SYMBOL_GPL(snd_ctl_sync_vmaster_hook);