commit glitch-free work
[platform/upstream/pulseaudio.git] / 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 }