]> code.delx.au - pulseaudio/blob - src/modules/module-combine.c
add utility functions to dump alsa PCM state
[pulseaudio] / src / modules / module-combine.c
1 /* $Id$ */
2
3 /***
4 This file is part of PulseAudio.
5
6 Copyright 2004-2006 Lennart Poettering
7
8 PulseAudio is free software; you can redistribute it and/or modify
9 it under the terms of the GNU Lesser General Public License as published
10 by the Free Software Foundation; either version 2 of the License,
11 or (at your option) any later version.
12
13 PulseAudio is distributed in the hope that it will be useful, but
14 WITHOUT ANY WARRANTY; without even the implied warranty of
15 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
16 General Public License for more details.
17
18 You should have received a copy of the GNU Lesser General Public License
19 along with PulseAudio; if not, write to the Free Software
20 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
21 USA.
22 ***/
23
24 #ifdef HAVE_CONFIG_H
25 #include <config.h>
26 #endif
27
28 #include <stdio.h>
29 #include <errno.h>
30
31 #include <pulse/timeval.h>
32 #include <pulse/xmalloc.h>
33
34 #include <pulsecore/macro.h>
35 #include <pulsecore/module.h>
36 #include <pulsecore/llist.h>
37 #include <pulsecore/sink.h>
38 #include <pulsecore/sink-input.h>
39 #include <pulsecore/memblockq.h>
40 #include <pulsecore/log.h>
41 #include <pulsecore/core-util.h>
42 #include <pulsecore/modargs.h>
43 #include <pulsecore/namereg.h>
44 #include <pulsecore/mutex.h>
45 #include <pulsecore/thread.h>
46 #include <pulsecore/thread-mq.h>
47 #include <pulsecore/rtpoll.h>
48 #include <pulsecore/rtclock.h>
49 #include <pulsecore/core-error.h>
50
51 #include "module-combine-symdef.h"
52
53 PA_MODULE_AUTHOR("Lennart Poettering");
54 PA_MODULE_DESCRIPTION("Combine multiple sinks to one");
55 PA_MODULE_VERSION(PACKAGE_VERSION);
56 PA_MODULE_LOAD_ONCE(FALSE);
57 PA_MODULE_USAGE(
58 "sink_name=<name for the sink> "
59 "master=<master sink> "
60 "slaves=<slave sinks> "
61 "adjust_time=<seconds> "
62 "resample_method=<method> "
63 "format=<sample format> "
64 "channels=<number of channels> "
65 "rate=<sample rate> "
66 "channel_map=<channel map>");
67
68 #define DEFAULT_SINK_NAME "combined"
69 #define MEMBLOCKQ_MAXLENGTH (1024*1024*16)
70
71 #define DEFAULT_ADJUST_TIME 10
72
73 static const char* const valid_modargs[] = {
74 "sink_name",
75 "master",
76 "slaves",
77 "adjust_time",
78 "resample_method",
79 "format",
80 "channels",
81 "rate",
82 "channel_map",
83 NULL
84 };
85
86 struct output {
87 struct userdata *userdata;
88
89 pa_sink *sink;
90 pa_sink_input *sink_input;
91
92 pa_asyncmsgq *inq, /* Message queue from the sink thread to this sink input */
93 *outq; /* Message queue from this sink input to the sink thread */
94 pa_rtpoll_item *inq_rtpoll_item, *outq_rtpoll_item;
95
96 pa_memblockq *memblockq;
97
98 pa_usec_t total_latency;
99
100 PA_LLIST_FIELDS(struct output);
101 };
102
103 struct userdata {
104 pa_core *core;
105 pa_module *module;
106 pa_sink *sink;
107
108 pa_thread *thread;
109 pa_thread_mq thread_mq;
110 pa_rtpoll *rtpoll;
111
112 pa_time_event *time_event;
113 uint32_t adjust_time;
114
115 pa_bool_t automatic;
116 size_t block_size;
117
118 pa_hook_slot *sink_new_slot, *sink_unlink_slot, *sink_state_changed_slot;
119
120 pa_resample_method_t resample_method;
121
122 struct timeval adjust_timestamp;
123
124 struct output *master;
125 pa_idxset* outputs; /* managed in main context */
126
127 struct {
128 PA_LLIST_HEAD(struct output, active_outputs); /* managed in IO thread context */
129 pa_atomic_t running; /* we cache that value here, so that every thread can query it cheaply */
130 struct timeval timestamp;
131 pa_bool_t in_null_mode;
132 } thread_info;
133 };
134
135 enum {
136 SINK_MESSAGE_ADD_OUTPUT = PA_SINK_MESSAGE_MAX,
137 SINK_MESSAGE_REMOVE_OUTPUT,
138 SINK_MESSAGE_NEED
139 };
140
141 enum {
142 SINK_INPUT_MESSAGE_POST = PA_SINK_INPUT_MESSAGE_MAX,
143 };
144
145 static void output_free(struct output *o);
146 static int output_create_sink_input(struct output *o);
147 static void update_master(struct userdata *u, struct output *o);
148 static void pick_master(struct userdata *u, struct output *except);
149
150 static void adjust_rates(struct userdata *u) {
151 struct output *o;
152 pa_usec_t max_sink_latency = 0, min_total_latency = (pa_usec_t) -1, target_latency;
153 uint32_t base_rate;
154 uint32_t idx;
155
156 pa_assert(u);
157 pa_sink_assert_ref(u->sink);
158
159 if (pa_idxset_size(u->outputs) <= 0)
160 return;
161
162 if (!u->master)
163 return;
164
165 if (!PA_SINK_OPENED(pa_sink_get_state(u->sink)))
166 return;
167
168 for (o = pa_idxset_first(u->outputs, &idx); o; o = pa_idxset_next(u->outputs, &idx)) {
169 pa_usec_t sink_latency;
170
171 if (!o->sink_input || !PA_SINK_OPENED(pa_sink_get_state(o->sink)))
172 continue;
173
174 sink_latency = pa_sink_get_latency(o->sink);
175 o->total_latency = sink_latency + pa_sink_input_get_latency(o->sink_input);
176
177 if (sink_latency > max_sink_latency)
178 max_sink_latency = sink_latency;
179
180 if (min_total_latency == (pa_usec_t) -1 || o->total_latency < min_total_latency)
181 min_total_latency = o->total_latency;
182 }
183
184 if (min_total_latency == (pa_usec_t) -1)
185 return;
186
187 target_latency = max_sink_latency > min_total_latency ? max_sink_latency : min_total_latency;
188
189 pa_log_info("[%s] target latency is %0.0f usec.", u->sink->name, (float) target_latency);
190 pa_log_info("[%s] master %s latency %0.0f usec.", u->sink->name, u->master->sink->name, (float) u->master->total_latency);
191
192 base_rate = u->sink->sample_spec.rate;
193
194 for (o = pa_idxset_first(u->outputs, &idx); o; o = pa_idxset_next(u->outputs, &idx)) {
195 uint32_t r = base_rate;
196
197 if (!o->sink_input || !PA_SINK_OPENED(pa_sink_get_state(o->sink)))
198 continue;
199
200 if (o->total_latency < target_latency)
201 r -= (uint32_t) (((((double) target_latency - o->total_latency))/u->adjust_time)*r/PA_USEC_PER_SEC);
202 else if (o->total_latency > target_latency)
203 r += (uint32_t) (((((double) o->total_latency - target_latency))/u->adjust_time)*r/PA_USEC_PER_SEC);
204
205 if (r < (uint32_t) (base_rate*0.9) || r > (uint32_t) (base_rate*1.1)) {
206 pa_log_warn("[%s] sample rates too different, not adjusting (%u vs. %u).", pa_proplist_gets(o->sink_input->proplist, PA_PROP_MEDIA_NAME), base_rate, r);
207 pa_sink_input_set_rate(o->sink_input, base_rate);
208 } else {
209 pa_log_info("[%s] new rate is %u Hz; ratio is %0.3f; latency is %0.0f usec.", pa_proplist_gets(o->sink_input->proplist, PA_PROP_MEDIA_NAME), r, (double) r / base_rate, (float) o->total_latency);
210 pa_sink_input_set_rate(o->sink_input, r);
211 }
212 }
213 }
214
215 static void time_callback(pa_mainloop_api*a, pa_time_event* e, const struct timeval *tv, void *userdata) {
216 struct userdata *u = userdata;
217 struct timeval n;
218
219 pa_assert(u);
220 pa_assert(a);
221 pa_assert(u->time_event == e);
222
223 adjust_rates(u);
224
225 pa_gettimeofday(&n);
226 n.tv_sec += u->adjust_time;
227 u->sink->core->mainloop->time_restart(e, &n);
228 }
229
230 static void thread_func(void *userdata) {
231 struct userdata *u = userdata;
232
233 pa_assert(u);
234
235 pa_log_debug("Thread starting up");
236
237 if (u->core->realtime_scheduling)
238 pa_make_realtime(u->core->realtime_priority+1);
239
240 pa_thread_mq_install(&u->thread_mq);
241 pa_rtpoll_install(u->rtpoll);
242
243 pa_rtclock_get(&u->thread_info.timestamp);
244 u->thread_info.in_null_mode = FALSE;
245
246 for (;;) {
247 int ret;
248
249 /* If no outputs are connected, render some data and drop it immediately. */
250 if (u->sink->thread_info.state == PA_SINK_RUNNING && !u->thread_info.active_outputs) {
251 struct timeval now;
252
253 /* Just rewind if necessary, since we are in NULL mode, we
254 * don't have to pass this on */
255 pa_sink_process_rewind(u->sink);
256
257 pa_rtclock_get(&now);
258
259 if (!u->thread_info.in_null_mode || pa_timeval_cmp(&u->thread_info.timestamp, &now) <= 0) {
260 pa_sink_skip(u->sink, u->block_size);
261
262 if (!u->thread_info.in_null_mode)
263 u->thread_info.timestamp = now;
264
265 pa_timeval_add(&u->thread_info.timestamp, pa_bytes_to_usec(u->block_size, &u->sink->sample_spec));
266 }
267
268 pa_rtpoll_set_timer_absolute(u->rtpoll, &u->thread_info.timestamp);
269 u->thread_info.in_null_mode = TRUE;
270
271 } else {
272 pa_rtpoll_set_timer_disabled(u->rtpoll);
273 u->thread_info.in_null_mode = FALSE;
274 }
275
276 /* Hmm, nothing to do. Let's sleep */
277 if ((ret = pa_rtpoll_run(u->rtpoll, TRUE)) < 0) {
278 pa_log_info("pa_rtpoll_run() = %i", ret);
279 goto fail;
280 }
281
282 if (ret == 0)
283 goto finish;
284 }
285
286 fail:
287 /* If this was no regular exit from the loop we have to continue
288 * processing messages until we received PA_MESSAGE_SHUTDOWN */
289 pa_asyncmsgq_post(u->thread_mq.outq, PA_MSGOBJECT(u->core), PA_CORE_MESSAGE_UNLOAD_MODULE, u->module, 0, NULL, NULL);
290 pa_asyncmsgq_wait_for(u->thread_mq.inq, PA_MESSAGE_SHUTDOWN);
291
292 finish:
293 pa_log_debug("Thread shutting down");
294 }
295
296 /* Called from I/O thread context */
297 static void render_memblock(struct userdata *u, struct output *o, size_t length) {
298 pa_assert(u);
299 pa_assert(o);
300
301 /* We are run by the sink thread, on behalf of an output (o). The
302 * other output is waiting for us, hence it is safe to access its
303 * mainblockq and asyncmsgq directly. */
304
305 /* If we are not running, we cannot produce any data */
306 if (!pa_atomic_load(&u->thread_info.running))
307 return;
308
309 /* Maybe there's some data in the requesting output's queue
310 * now? */
311 while (pa_asyncmsgq_process_one(o->inq) > 0)
312 ;
313
314 /* Ok, now let's prepare some data if we really have to */
315 while (!pa_memblockq_is_readable(o->memblockq)) {
316 struct output *j;
317 pa_memchunk chunk;
318
319 /* Render data! */
320 pa_sink_render(u->sink, length, &chunk);
321
322 /* OK, let's send this data to the other threads */
323 for (j = u->thread_info.active_outputs; j; j = j->next)
324
325 /* Send to other outputs, which are not the requesting
326 * one */
327
328 if (j != o)
329 pa_asyncmsgq_post(j->inq, PA_MSGOBJECT(j->sink_input), SINK_INPUT_MESSAGE_POST, NULL, 0, &chunk, NULL);
330
331 /* And place it directly into the requesting output's queue */
332 if (o)
333 pa_memblockq_push_align(o->memblockq, &chunk);
334
335 pa_memblock_unref(chunk.memblock);
336 }
337 }
338
339 /* Called from I/O thread context */
340 static void request_memblock(struct output *o, size_t length) {
341 pa_assert(o);
342 pa_sink_input_assert_ref(o->sink_input);
343 pa_sink_assert_ref(o->userdata->sink);
344
345 /* If another thread already prepared some data we received
346 * the data over the asyncmsgq, hence let's first process
347 * it. */
348 while (pa_asyncmsgq_process_one(o->inq) > 0)
349 ;
350
351 /* Check whether we're now readable */
352 if (pa_memblockq_is_readable(o->memblockq))
353 return;
354
355 /* OK, we need to prepare new data, but only if the sink is actually running */
356 if (pa_atomic_load(&o->userdata->thread_info.running))
357 pa_asyncmsgq_send(o->outq, PA_MSGOBJECT(o->userdata->sink), SINK_MESSAGE_NEED, o, length, NULL);
358 }
359
360 /* Called from I/O thread context */
361 static int sink_input_pop_cb(pa_sink_input *i, size_t nbytes, pa_memchunk *chunk) {
362 struct output *o;
363
364 pa_sink_input_assert_ref(i);
365 pa_assert_se(o = i->userdata);
366
367 /* If necessary, get some new data */
368 request_memblock(o, nbytes);
369
370 if (pa_memblockq_peek(o->memblockq, chunk) < 0)
371 return -1;
372
373 pa_memblockq_drop(o->memblockq, chunk->length);
374 return 0;
375 }
376
377 /* Called from I/O thread context */
378 static void sink_input_attach_cb(pa_sink_input *i) {
379 struct output *o;
380
381 pa_sink_input_assert_ref(i);
382 pa_assert_se(o = i->userdata);
383
384 /* Set up the queue from the sink thread to us */
385 pa_assert(!o->inq_rtpoll_item);
386 o->inq_rtpoll_item = pa_rtpoll_item_new_asyncmsgq(
387 i->sink->rtpoll,
388 PA_RTPOLL_LATE, /* This one is not that important, since we check for data in _peek() anyway. */
389 o->inq);
390 }
391
392 /* Called from I/O thread context */
393 static void sink_input_detach_cb(pa_sink_input *i) {
394 struct output *o;
395
396 pa_sink_input_assert_ref(i);
397 pa_assert_se(o = i->userdata);
398
399 /* Shut down the queue from the sink thread to us */
400 pa_assert(o->inq_rtpoll_item);
401 pa_rtpoll_item_free(o->inq_rtpoll_item);
402 o->inq_rtpoll_item = NULL;
403 }
404
405 /* Called from main context */
406 static void sink_input_kill_cb(pa_sink_input *i) {
407 struct output *o;
408
409 pa_sink_input_assert_ref(i);
410 pa_assert(o = i->userdata);
411
412 pa_module_unload_request(o->userdata->module);
413 output_free(o);
414 }
415
416 /* Called from thread context */
417 static int sink_input_process_msg(pa_msgobject *obj, int code, void *data, int64_t offset, pa_memchunk *chunk) {
418 struct output *o = PA_SINK_INPUT(obj)->userdata;
419
420 switch (code) {
421
422 case PA_SINK_INPUT_MESSAGE_GET_LATENCY: {
423 pa_usec_t *r = data;
424
425 *r = pa_bytes_to_usec(pa_memblockq_get_length(o->memblockq), &o->sink_input->sample_spec);
426
427 /* Fall through, the default handler will add in the extra
428 * latency added by the resampler */
429 break;
430 }
431
432 case SINK_INPUT_MESSAGE_POST:
433
434 if (PA_SINK_OPENED(o->sink_input->sink->thread_info.state))
435 pa_memblockq_push_align(o->memblockq, chunk);
436 else
437 pa_memblockq_flush(o->memblockq);
438
439 break;
440
441 }
442
443 return pa_sink_input_process_msg(obj, code, data, offset, chunk);
444 }
445
446 /* Called from main context */
447 static void disable_output(struct output *o) {
448 pa_assert(o);
449
450 if (!o->sink_input)
451 return;
452
453 pa_asyncmsgq_send(o->userdata->sink->asyncmsgq, PA_MSGOBJECT(o->userdata->sink), SINK_MESSAGE_REMOVE_OUTPUT, o, 0, NULL);
454 pa_sink_input_unlink(o->sink_input);
455 pa_sink_input_unref(o->sink_input);
456 o->sink_input = NULL;
457
458 }
459
460 /* Called from main context */
461 static void enable_output(struct output *o) {
462 pa_assert(o);
463
464 if (o->sink_input)
465 return;
466
467 if (output_create_sink_input(o) >= 0) {
468
469 pa_memblockq_flush(o->memblockq);
470
471 pa_sink_input_put(o->sink_input);
472
473 if (o->userdata->sink && PA_SINK_LINKED(pa_sink_get_state(o->userdata->sink)))
474 pa_asyncmsgq_send(o->userdata->sink->asyncmsgq, PA_MSGOBJECT(o->userdata->sink), SINK_MESSAGE_ADD_OUTPUT, o, 0, NULL);
475 }
476 }
477
478 /* Called from main context */
479 static void suspend(struct userdata *u) {
480 struct output *o;
481 uint32_t idx;
482
483 pa_assert(u);
484
485 /* Let's suspend by unlinking all streams */
486 for (o = pa_idxset_first(u->outputs, &idx); o; o = pa_idxset_next(u->outputs, &idx))
487 disable_output(o);
488
489 pick_master(u, NULL);
490
491 pa_log_info("Device suspended...");
492 }
493
494 /* Called from main context */
495 static void unsuspend(struct userdata *u) {
496 struct output *o;
497 uint32_t idx;
498
499 pa_assert(u);
500
501 /* Let's resume */
502 for (o = pa_idxset_first(u->outputs, &idx); o; o = pa_idxset_next(u->outputs, &idx)) {
503
504 pa_sink_suspend(o->sink, FALSE);
505
506 if (PA_SINK_OPENED(pa_sink_get_state(o->sink)))
507 enable_output(o);
508 }
509
510 pick_master(u, NULL);
511
512 pa_log_info("Resumed successfully...");
513 }
514
515 /* Called from main context */
516 static int sink_set_state(pa_sink *sink, pa_sink_state_t state) {
517 struct userdata *u;
518
519 pa_sink_assert_ref(sink);
520 pa_assert_se(u = sink->userdata);
521
522 /* Please note that in contrast to the ALSA modules we call
523 * suspend/unsuspend from main context here! */
524
525 switch (state) {
526 case PA_SINK_SUSPENDED:
527 pa_assert(PA_SINK_OPENED(pa_sink_get_state(u->sink)));
528
529 suspend(u);
530 break;
531
532 case PA_SINK_IDLE:
533 case PA_SINK_RUNNING:
534
535 if (pa_sink_get_state(u->sink) == PA_SINK_SUSPENDED)
536 unsuspend(u);
537
538 break;
539
540 case PA_SINK_UNLINKED:
541 case PA_SINK_INIT:
542 ;
543 }
544
545 return 0;
546 }
547
548 /* Called from thread context of the master */
549 static int sink_process_msg(pa_msgobject *o, int code, void *data, int64_t offset, pa_memchunk *chunk) {
550 struct userdata *u = PA_SINK(o)->userdata;
551
552 switch (code) {
553
554 case PA_SINK_MESSAGE_SET_STATE:
555 pa_atomic_store(&u->thread_info.running, PA_PTR_TO_UINT(data) == PA_SINK_RUNNING);
556 break;
557
558 case PA_SINK_MESSAGE_GET_LATENCY:
559
560 /* This code will only be called when running in NULL
561 * mode, i.e. when no output is attached. See
562 * sink_get_latency_cb() below */
563
564 if (u->thread_info.in_null_mode) {
565 struct timeval now;
566
567 if (pa_timeval_cmp(&u->thread_info.timestamp, pa_rtclock_get(&now)) > 0) {
568 *((pa_usec_t*) data) = pa_timeval_diff(&u->thread_info.timestamp, &now);
569 break;
570 }
571 }
572
573 *((pa_usec_t*) data) = 0;
574
575 break;
576
577 case SINK_MESSAGE_ADD_OUTPUT: {
578 struct output *op = data;
579
580 PA_LLIST_PREPEND(struct output, u->thread_info.active_outputs, op);
581
582 pa_assert(!op->outq_rtpoll_item);
583
584 /* Create pa_asyncmsgq to the sink thread */
585
586 op->outq_rtpoll_item = pa_rtpoll_item_new_asyncmsgq(
587 u->rtpoll,
588 PA_RTPOLL_EARLY-1, /* This item is very important */
589 op->outq);
590
591 return 0;
592 }
593
594 case SINK_MESSAGE_REMOVE_OUTPUT: {
595 struct output *op = data;
596
597 PA_LLIST_REMOVE(struct output, u->thread_info.active_outputs, op);
598
599 /* Remove the q that leads from this output to the sink thread */
600
601 pa_assert(op->outq_rtpoll_item);
602 pa_rtpoll_item_free(op->outq_rtpoll_item);
603 op->outq_rtpoll_item = NULL;
604
605 return 0;
606 }
607
608 case SINK_MESSAGE_NEED:
609 render_memblock(u, data, (size_t) offset);
610 return 0;
611 }
612
613 return pa_sink_process_msg(o, code, data, offset, chunk);
614 }
615
616 /* Called from main context */
617 static pa_usec_t sink_get_latency_cb(pa_sink *s) {
618 struct userdata *u;
619
620 pa_sink_assert_ref(s);
621 pa_assert_se(u = s->userdata);
622
623 if (u->master) {
624 /* If we have a master sink, we just return the latency of it
625 * and add our own buffering on top */
626
627 if (!u->master->sink_input)
628 return 0;
629
630 return
631 pa_sink_input_get_latency(u->master->sink_input) +
632 pa_sink_get_latency(u->master->sink);
633
634 } else {
635 pa_usec_t usec = 0;
636
637 /* We have no master, hence let's ask our own thread which
638 * implements the NULL sink */
639
640 if (pa_asyncmsgq_send(s->asyncmsgq, PA_MSGOBJECT(s), PA_SINK_MESSAGE_GET_LATENCY, &usec, 0, NULL) < 0)
641 return 0;
642
643 return usec;
644 }
645 }
646
647 static void update_description(struct userdata *u) {
648 int first = 1;
649 char *t;
650 struct output *o;
651 uint32_t idx;
652
653 pa_assert(u);
654
655 if (pa_idxset_isempty(u->outputs)) {
656 pa_sink_set_description(u->sink, "Simultaneous output");
657 return;
658 }
659
660 t = pa_xstrdup("Simultaneous output to");
661
662 for (o = pa_idxset_first(u->outputs, &idx); o; o = pa_idxset_next(u->outputs, &idx)) {
663 char *e;
664
665 if (first) {
666 e = pa_sprintf_malloc("%s %s", t, pa_strnull(pa_proplist_gets(o->sink->proplist, PA_PROP_DEVICE_DESCRIPTION)));
667 first = 0;
668 } else
669 e = pa_sprintf_malloc("%s, %s", t, pa_strnull(pa_proplist_gets(o->sink->proplist, PA_PROP_DEVICE_DESCRIPTION)));
670
671 pa_xfree(t);
672 t = e;
673 }
674
675 pa_sink_set_description(u->sink, t);
676 pa_xfree(t);
677 }
678
679 static void update_master(struct userdata *u, struct output *o) {
680 pa_assert(u);
681
682 if (u->master == o)
683 return;
684
685 if ((u->master = o))
686 pa_log_info("Master sink is now '%s'", o->sink_input->sink->name);
687 else
688 pa_log_info("No master selected, lacking suitable outputs.");
689 }
690
691 static void pick_master(struct userdata *u, struct output *except) {
692 struct output *o;
693 uint32_t idx;
694 pa_assert(u);
695
696 if (u->master &&
697 u->master != except &&
698 u->master->sink_input &&
699 PA_SINK_OPENED(pa_sink_get_state(u->master->sink))) {
700 update_master(u, u->master);
701 return;
702 }
703
704 for (o = pa_idxset_first(u->outputs, &idx); o; o = pa_idxset_next(u->outputs, &idx))
705 if (o != except &&
706 o->sink_input &&
707 PA_SINK_OPENED(pa_sink_get_state(o->sink))) {
708 update_master(u, o);
709 return;
710 }
711
712 update_master(u, NULL);
713 }
714
715 static int output_create_sink_input(struct output *o) {
716 pa_sink_input_new_data data;
717 char *t;
718
719 pa_assert(o);
720
721 if (o->sink_input)
722 return 0;
723
724 t = pa_sprintf_malloc("Simultaneous output on %s", pa_strnull(pa_proplist_gets(o->sink->proplist, PA_PROP_DEVICE_DESCRIPTION)));
725
726 pa_sink_input_new_data_init(&data);
727 data.sink = o->sink;
728 data.driver = __FILE__;
729 pa_proplist_sets(data.proplist, PA_PROP_DEVICE_DESCRIPTION, t);
730 pa_sink_input_new_data_set_sample_spec(&data, &o->userdata->sink->sample_spec);
731 pa_sink_input_new_data_set_channel_map(&data, &o->userdata->sink->channel_map);
732 data.module = o->userdata->module;
733 data.resample_method = o->userdata->resample_method;
734
735 o->sink_input = pa_sink_input_new(o->userdata->core, &data, PA_SINK_INPUT_VARIABLE_RATE|PA_SINK_INPUT_DONT_MOVE);
736
737 pa_sink_input_new_data_done(&data);
738
739 pa_xfree(t);
740
741 if (!o->sink_input)
742 return -1;
743
744 o->sink_input->parent.process_msg = sink_input_process_msg;
745 o->sink_input->pop = sink_input_pop_cb;
746 o->sink_input->attach = sink_input_attach_cb;
747 o->sink_input->detach = sink_input_detach_cb;
748 o->sink_input->kill = sink_input_kill_cb;
749 o->sink_input->userdata = o;
750
751
752 return 0;
753 }
754
755 static struct output *output_new(struct userdata *u, pa_sink *sink) {
756 struct output *o;
757
758 pa_assert(u);
759 pa_assert(sink);
760 pa_assert(u->sink);
761
762 o = pa_xnew(struct output, 1);
763 o->userdata = u;
764 o->inq = pa_asyncmsgq_new(0);
765 o->outq = pa_asyncmsgq_new(0);
766 o->inq_rtpoll_item = NULL;
767 o->outq_rtpoll_item = NULL;
768 o->sink = sink;
769 o->sink_input = NULL;
770 o->memblockq = pa_memblockq_new(
771 0,
772 MEMBLOCKQ_MAXLENGTH,
773 MEMBLOCKQ_MAXLENGTH,
774 pa_frame_size(&u->sink->sample_spec),
775 1,
776 0,
777 0,
778 NULL);
779
780 pa_assert_se(pa_idxset_put(u->outputs, o, NULL) == 0);
781
782 if (u->sink && PA_SINK_LINKED(pa_sink_get_state(u->sink)))
783 pa_asyncmsgq_send(u->sink->asyncmsgq, PA_MSGOBJECT(u->sink), SINK_MESSAGE_ADD_OUTPUT, o, 0, NULL);
784 else {
785 /* If the sink is not yet started, we need to do the activation ourselves */
786 PA_LLIST_PREPEND(struct output, u->thread_info.active_outputs, o);
787
788 o->outq_rtpoll_item = pa_rtpoll_item_new_asyncmsgq(
789 u->rtpoll,
790 PA_RTPOLL_EARLY-1, /* This item is very important */
791 o->outq);
792 }
793
794 if (PA_SINK_OPENED(pa_sink_get_state(u->sink)) || pa_sink_get_state(u->sink) == PA_SINK_INIT) {
795 pa_sink_suspend(sink, FALSE);
796
797 if (PA_SINK_OPENED(pa_sink_get_state(sink)))
798 if (output_create_sink_input(o) < 0)
799 goto fail;
800 }
801
802
803 update_description(u);
804
805 return o;
806
807 fail:
808
809 if (o) {
810 pa_idxset_remove_by_data(u->outputs, o, NULL);
811
812 if (o->sink_input) {
813 pa_sink_input_unlink(o->sink_input);
814 pa_sink_input_unref(o->sink_input);
815 }
816
817 if (o->memblockq)
818 pa_memblockq_free(o->memblockq);
819
820 if (o->inq)
821 pa_asyncmsgq_unref(o->inq);
822
823 if (o->outq)
824 pa_asyncmsgq_unref(o->outq);
825
826 pa_xfree(o);
827 }
828
829 return NULL;
830 }
831
832 static pa_hook_result_t sink_new_hook_cb(pa_core *c, pa_sink *s, struct userdata* u) {
833 struct output *o;
834
835 pa_core_assert_ref(c);
836 pa_sink_assert_ref(s);
837 pa_assert(u);
838 pa_assert(u->automatic);
839
840 if (!(s->flags & PA_SINK_HARDWARE) || s == u->sink)
841 return PA_HOOK_OK;
842
843 pa_log_info("Configuring new sink: %s", s->name);
844
845 if (!(o = output_new(u, s))) {
846 pa_log("Failed to create sink input on sink '%s'.", s->name);
847 return PA_HOOK_OK;
848 }
849
850 if (o->sink_input)
851 pa_sink_input_put(o->sink_input);
852
853 pick_master(u, NULL);
854
855 return PA_HOOK_OK;
856 }
857
858 static pa_hook_result_t sink_unlink_hook_cb(pa_core *c, pa_sink *s, struct userdata* u) {
859 struct output *o;
860 uint32_t idx;
861
862 pa_assert(c);
863 pa_sink_assert_ref(s);
864 pa_assert(u);
865
866 if (s == u->sink)
867 return PA_HOOK_OK;
868
869 for (o = pa_idxset_first(u->outputs, &idx); o; o = pa_idxset_next(u->outputs, &idx))
870 if (o->sink == s)
871 break;
872
873 if (!o)
874 return PA_HOOK_OK;
875
876 pa_log_info("Unconfiguring sink: %s", s->name);
877
878 output_free(o);
879
880 return PA_HOOK_OK;
881 }
882
883 static pa_hook_result_t sink_state_changed_hook_cb(pa_core *c, pa_sink *s, struct userdata* u) {
884 struct output *o;
885 uint32_t idx;
886 pa_sink_state_t state;
887
888 if (s == u->sink)
889 return PA_HOOK_OK;
890
891 for (o = pa_idxset_first(u->outputs, &idx); o; o = pa_idxset_next(u->outputs, &idx))
892 if (o->sink == s)
893 break;
894
895 if (!o)
896 return PA_HOOK_OK;
897
898 state = pa_sink_get_state(s);
899
900 if (PA_SINK_OPENED(state) && PA_SINK_OPENED(pa_sink_get_state(u->sink)) && !o->sink_input) {
901 enable_output(o);
902 pick_master(u, NULL);
903 }
904
905 if (state == PA_SINK_SUSPENDED && o->sink_input) {
906 disable_output(o);
907 pick_master(u, o);
908 }
909
910 return PA_HOOK_OK;
911 }
912
913 int pa__init(pa_module*m) {
914 struct userdata *u;
915 pa_modargs *ma = NULL;
916 const char *master_name, *slaves, *rm;
917 pa_sink *master_sink = NULL;
918 int resample_method = PA_RESAMPLER_TRIVIAL;
919 pa_sample_spec ss;
920 pa_channel_map map;
921 struct output *o;
922 uint32_t idx;
923 pa_sink_new_data data;
924
925 pa_assert(m);
926
927 if (!(ma = pa_modargs_new(m->argument, valid_modargs))) {
928 pa_log("failed to parse module arguments");
929 goto fail;
930 }
931
932 if ((rm = pa_modargs_get_value(ma, "resample_method", NULL))) {
933 if ((resample_method = pa_parse_resample_method(rm)) < 0) {
934 pa_log("invalid resample method '%s'", rm);
935 goto fail;
936 }
937 }
938
939 u = pa_xnew(struct userdata, 1);
940 u->core = m->core;
941 u->module = m;
942 m->userdata = u;
943 u->sink = NULL;
944 u->master = NULL;
945 u->time_event = NULL;
946 u->adjust_time = DEFAULT_ADJUST_TIME;
947 pa_thread_mq_init(&u->thread_mq, m->core->mainloop);
948 u->rtpoll = pa_rtpoll_new();
949 u->thread = NULL;
950 u->resample_method = resample_method;
951 u->outputs = pa_idxset_new(NULL, NULL);
952 memset(&u->adjust_timestamp, 0, sizeof(u->adjust_timestamp));
953 u->sink_new_slot = u->sink_unlink_slot = u->sink_state_changed_slot = NULL;
954 PA_LLIST_HEAD_INIT(struct output, u->thread_info.active_outputs);
955 pa_atomic_store(&u->thread_info.running, FALSE);
956 u->thread_info.in_null_mode = FALSE;
957 pa_rtpoll_item_new_asyncmsgq(u->rtpoll, PA_RTPOLL_EARLY, u->thread_mq.inq);
958
959 if (pa_modargs_get_value_u32(ma, "adjust_time", &u->adjust_time) < 0) {
960 pa_log("Failed to parse adjust_time value");
961 goto fail;
962 }
963
964 master_name = pa_modargs_get_value(ma, "master", NULL);
965 slaves = pa_modargs_get_value(ma, "slaves", NULL);
966 if (!master_name != !slaves) {
967 pa_log("No master or slave sinks specified");
968 goto fail;
969 }
970
971 if (master_name) {
972 if (!(master_sink = pa_namereg_get(m->core, master_name, PA_NAMEREG_SINK, 1))) {
973 pa_log("Invalid master sink '%s'", master_name);
974 goto fail;
975 }
976
977 ss = master_sink->sample_spec;
978 u->automatic = FALSE;
979 } else {
980 master_sink = NULL;
981 ss = m->core->default_sample_spec;
982 u->automatic = TRUE;
983 }
984
985 if ((pa_modargs_get_sample_spec(ma, &ss) < 0)) {
986 pa_log("Invalid sample specification.");
987 goto fail;
988 }
989
990 if (master_sink && ss.channels == master_sink->sample_spec.channels)
991 map = master_sink->channel_map;
992 else {
993 pa_assert_se(pa_channel_map_init_auto(&map, ss.channels, PA_CHANNEL_MAP_AUX));
994 pa_channel_map_init_auto(&map, ss.channels, PA_CHANNEL_MAP_DEFAULT);
995 }
996
997 if ((pa_modargs_get_channel_map(ma, NULL, &map) < 0)) {
998 pa_log("Invalid channel map.");
999 goto fail;
1000 }
1001
1002 if (ss.channels != map.channels) {
1003 pa_log("Channel map and sample specification don't match.");
1004 goto fail;
1005 }
1006
1007 pa_sink_new_data_init(&data);
1008 data.name = pa_xstrdup(pa_modargs_get_value(ma, "sink_name", DEFAULT_SINK_NAME));
1009 data.namereg_fail = FALSE;
1010 data.driver = __FILE__;
1011 data.module = m;
1012 pa_sink_new_data_set_sample_spec(&data, &ss);
1013 pa_sink_new_data_set_channel_map(&data, &map);
1014 pa_proplist_sets(data.proplist, PA_PROP_DEVICE_DESCRIPTION, "Simultaneous Output");
1015
1016 u->sink = pa_sink_new(m->core, &data, PA_SINK_LATENCY);
1017 pa_sink_new_data_done(&data);
1018
1019 if (!u->sink) {
1020 pa_log("Failed to create sink");
1021 goto fail;
1022 }
1023
1024 u->sink->parent.process_msg = sink_process_msg;
1025 u->sink->get_latency = sink_get_latency_cb;
1026 u->sink->set_state = sink_set_state;
1027 u->sink->userdata = u;
1028
1029 pa_sink_set_rtpoll(u->sink, u->rtpoll);
1030 pa_sink_set_asyncmsgq(u->sink, u->thread_mq.inq);
1031
1032 u->block_size = pa_bytes_per_second(&ss) / 20; /* 50 ms */
1033 if (u->block_size <= 0)
1034 u->block_size = pa_frame_size(&ss);
1035
1036 if (!u->automatic) {
1037 const char*split_state;
1038 char *n = NULL;
1039 pa_assert(slaves);
1040
1041 /* The master and slaves have been specified manually */
1042
1043 if (!(u->master = output_new(u, master_sink))) {
1044 pa_log("Failed to create master sink input on sink '%s'.", master_sink->name);
1045 goto fail;
1046 }
1047
1048 split_state = NULL;
1049 while ((n = pa_split(slaves, ",", &split_state))) {
1050 pa_sink *slave_sink;
1051
1052 if (!(slave_sink = pa_namereg_get(m->core, n, PA_NAMEREG_SINK, 1)) || slave_sink == u->sink) {
1053 pa_log("Invalid slave sink '%s'", n);
1054 pa_xfree(n);
1055 goto fail;
1056 }
1057
1058 pa_xfree(n);
1059
1060 if (!output_new(u, slave_sink)) {
1061 pa_log("Failed to create slave sink input on sink '%s'.", slave_sink->name);
1062 goto fail;
1063 }
1064 }
1065
1066 if (pa_idxset_size(u->outputs) <= 1)
1067 pa_log_warn("No slave sinks specified.");
1068
1069 u->sink_new_slot = NULL;
1070
1071 } else {
1072 pa_sink *s;
1073
1074 /* We're in automatic mode, we elect one hw sink to the master
1075 * and attach all other hw sinks as slaves to it */
1076
1077 for (s = pa_idxset_first(m->core->sinks, &idx); s; s = pa_idxset_next(m->core->sinks, &idx)) {
1078
1079 if (!(s->flags & PA_SINK_HARDWARE) || s == u->sink)
1080 continue;
1081
1082 if (!output_new(u, s)) {
1083 pa_log("Failed to create sink input on sink '%s'.", s->name);
1084 goto fail;
1085 }
1086 }
1087
1088 u->sink_new_slot = pa_hook_connect(&m->core->hooks[PA_CORE_HOOK_SINK_PUT], (pa_hook_cb_t) sink_new_hook_cb, u);
1089 }
1090
1091 u->sink_unlink_slot = pa_hook_connect(&m->core->hooks[PA_CORE_HOOK_SINK_UNLINK], (pa_hook_cb_t) sink_unlink_hook_cb, u);
1092 u->sink_state_changed_slot = pa_hook_connect(&m->core->hooks[PA_CORE_HOOK_SINK_STATE_CHANGED], (pa_hook_cb_t) sink_state_changed_hook_cb, u);
1093
1094 pick_master(u, NULL);
1095
1096 if (!(u->thread = pa_thread_new(thread_func, u))) {
1097 pa_log("Failed to create thread.");
1098 goto fail;
1099 }
1100
1101 /* Activate the sink and the sink inputs */
1102 pa_sink_put(u->sink);
1103
1104 for (o = pa_idxset_first(u->outputs, &idx); o; o = pa_idxset_next(u->outputs, &idx))
1105 if (o->sink_input)
1106 pa_sink_input_put(o->sink_input);
1107
1108 if (u->adjust_time > 0) {
1109 struct timeval tv;
1110 pa_gettimeofday(&tv);
1111 tv.tv_sec += u->adjust_time;
1112 u->time_event = m->core->mainloop->time_new(m->core->mainloop, &tv, time_callback, u);
1113 }
1114
1115 pa_modargs_free(ma);
1116
1117 return 0;
1118
1119 fail:
1120
1121 if (ma)
1122 pa_modargs_free(ma);
1123
1124 pa__done(m);
1125
1126 return -1;
1127 }
1128
1129 static void output_free(struct output *o) {
1130 pa_assert(o);
1131
1132 pick_master(o->userdata, o);
1133
1134 disable_output(o);
1135
1136 pa_assert_se(pa_idxset_remove_by_data(o->userdata->outputs, o, NULL));
1137
1138 update_description(o->userdata);
1139
1140 if (o->inq_rtpoll_item)
1141 pa_rtpoll_item_free(o->inq_rtpoll_item);
1142
1143 if (o->outq_rtpoll_item)
1144 pa_rtpoll_item_free(o->outq_rtpoll_item);
1145
1146 if (o->inq)
1147 pa_asyncmsgq_unref(o->inq);
1148
1149 if (o->outq)
1150 pa_asyncmsgq_unref(o->outq);
1151
1152 if (o->memblockq)
1153 pa_memblockq_free(o->memblockq);
1154
1155 pa_xfree(o);
1156 }
1157
1158 void pa__done(pa_module*m) {
1159 struct userdata *u;
1160 struct output *o;
1161
1162 pa_assert(m);
1163
1164 if (!(u = m->userdata))
1165 return;
1166
1167 if (u->sink_new_slot)
1168 pa_hook_slot_free(u->sink_new_slot);
1169
1170 if (u->sink_unlink_slot)
1171 pa_hook_slot_free(u->sink_unlink_slot);
1172
1173 if (u->sink_state_changed_slot)
1174 pa_hook_slot_free(u->sink_state_changed_slot);
1175
1176 if (u->outputs) {
1177 while ((o = pa_idxset_first(u->outputs, NULL)))
1178 output_free(o);
1179
1180 pa_idxset_free(u->outputs, NULL, NULL);
1181 }
1182
1183 if (u->sink)
1184 pa_sink_unlink(u->sink);
1185
1186 if (u->thread) {
1187 pa_asyncmsgq_send(u->thread_mq.inq, NULL, PA_MESSAGE_SHUTDOWN, NULL, 0, NULL);
1188 pa_thread_free(u->thread);
1189 }
1190
1191 pa_thread_mq_done(&u->thread_mq);
1192
1193 if (u->sink)
1194 pa_sink_unref(u->sink);
1195
1196 if (u->rtpoll)
1197 pa_rtpoll_free(u->rtpoll);
1198
1199 if (u->time_event)
1200 u->core->mainloop->time_free(u->time_event);
1201
1202 pa_xfree(u);
1203 }