/* Called from main context */
static void sink_input_moving_cb(pa_sink_input *i, pa_sink *dest) {
struct userdata *u;
pa_sink_input_assert_ref(i);
pa_assert_se(u = i->userdata);
if (dest) {
pa_sink_set_asyncmsgq(u->sink, dest->asyncmsgq);
pa_sink_update_flags(u->sink, PA_SINK_LATENCY|PA_SINK_DYNAMIC_LATENCY, dest->flags);
} else
pa_sink_set_asyncmsgq(u->sink, NULL);
if (u->auto_desc && dest) {
const char *z;
pa_proplist *pl;
pl = pa_proplist_new();
z = pa_proplist_gets(dest->proplist, PA_PROP_DEVICE_DESCRIPTION);
pa_proplist_setf(pl, PA_PROP_DEVICE_DESCRIPTION, "Virtual Sink %s on %s",
pa_proplist_gets(u->sink->proplist, "device.vsink.name"), z ? z : dest->name);
pa_sink_update_proplist(u->sink, PA_UPDATE_REPLACE, pl);
pa_proplist_free(pl);
}
}
static void switch_mode(struct userdata *u, const char *mode) {
pa_proplist *proplist = pa_proplist_new();
pa_log_debug("Switching to mode %s", mode);
pa_proplist_sets(proplist, PA_NOKIA_PROP_AUDIO_MODE, mode);
pa_proplist_sets(proplist, PA_NOKIA_PROP_AUDIO_ACCESSORY_HWID, "");
pa_sink_update_proplist(u->mode_sink, PA_UPDATE_REPLACE, proplist);
pa_proplist_free(proplist);
}
int pa__init(pa_module *m)
{
pa_modargs *ma;
const char *master_sink_name;
const char *master_source_name;
const char *max_hw_frag_size_str;
const char *aep_runtime;
pa_source *master_source;
struct userdata *u;
pa_proplist *p;
pa_sink *master_sink;
const char *raw_sink_name;
const char *raw_source_name;
const char *voice_sink_name;
const char *voice_source_name;
const char *dbus_type;
int max_hw_frag_size = 3840;
pa_assert(m);
if (!(ma = pa_modargs_new(m->argument, valid_modargs)))
{
pa_log_error("Failed to parse module arguments");
goto fail;
}
voice_turn_sidetone_down();
master_sink_name = pa_modargs_get_value(ma, "master_sink", NULL);
master_source_name = pa_modargs_get_value(ma, "master_source", NULL);
raw_sink_name = pa_modargs_get_value(ma, "raw_sink_name", "sink.voice.raw");
raw_source_name = pa_modargs_get_value(ma, "raw_source_name",
"source.voice.raw");
voice_sink_name = pa_modargs_get_value(ma, "voice_sink_name", "sink.voice");
voice_source_name = pa_modargs_get_value(ma, "voice_source_name",
"source.voice");
dbus_type = pa_modargs_get_value(ma, "dbus_type", "session");
max_hw_frag_size_str = pa_modargs_get_value(ma, "max_hw_frag_size", "3840");
aep_runtime = pa_modargs_get_value(ma, "aep_runtime",
"bbaid1n-wr0-h9a22b--dbxpb--");
voice_set_aep_runtime_switch(aep_runtime);
pa_log_debug("Got arguments: master_sink=\"%s\" master_source=\"%s\" raw_sink_name=\"%s\" raw_source_name=\"%s\" dbus_type=\"%s\" max_hw_frag_size=\"%s\". ",
master_sink_name, master_source_name, raw_sink_name,
raw_source_name, dbus_type, max_hw_frag_size_str);
if (!(master_sink = pa_namereg_get(m->core, master_sink_name, PA_NAMEREG_SINK)))
{
pa_log("Master sink \"%s\" not found", master_sink_name);
goto fail;
}
if (!(master_source = pa_namereg_get(m->core, master_source_name, PA_NAMEREG_SOURCE)))
{
pa_log( "Master source \"%s\" not found", master_source_name);
goto fail;
}
if (master_sink->sample_spec.format != master_source->sample_spec.format &&
master_sink->sample_spec.rate != master_source->sample_spec.rate &&
master_sink->sample_spec.channels != master_source->sample_spec.channels)
{
pa_log("Master source and sink must have same sample spec");
goto fail;
}
if (pa_atoi(max_hw_frag_size_str, &max_hw_frag_size) < 0 ||
max_hw_frag_size < 960 ||
max_hw_frag_size > 128*960)
{
pa_log("Bad value for max_hw_frag_size: %s", max_hw_frag_size_str);
goto fail;
}
m->userdata = u = pa_xnew0(struct userdata, 1);
u->core = m->core;
u->module = m;
u->modargs = ma;
u->master_sink = master_sink;
u->master_source = master_source;
u->mainloop_handler = voice_mainloop_handler_new(u);;
u->ul_timing_advance = 500; // = 500 micro seconds, seems to be a good default value
pa_channel_map_init_mono(&u->mono_map);
pa_channel_map_init_stereo(&u->stereo_map);
u->hw_sample_spec.format = PA_SAMPLE_S16NE;
u->hw_sample_spec.rate = SAMPLE_RATE_HW_HZ;
u->hw_sample_spec.channels = 2;
u->hw_mono_sample_spec.format = PA_SAMPLE_S16NE;
u->hw_mono_sample_spec.rate = SAMPLE_RATE_HW_HZ;
u->hw_mono_sample_spec.channels = 1;
u->aep_sample_spec.format = PA_SAMPLE_S16NE;
u->aep_sample_spec.rate = SAMPLE_RATE_AEP_HZ;
u->aep_sample_spec.channels = 1;
pa_channel_map_init_mono(&u->aep_channel_map);
// The result is rounded down incorrectly thus +1
u->aep_fragment_size = pa_usec_to_bytes(PERIOD_AEP_USECS+1, &u->aep_sample_spec);
u->aep_hw_fragment_size = pa_usec_to_bytes(PERIOD_AEP_USECS+1, &u->hw_sample_spec);
u->hw_fragment_size = pa_usec_to_bytes(PERIOD_MASTER_USECS+1, &u->hw_sample_spec);
u->hw_fragment_size_max = max_hw_frag_size;
if (0 != (u->hw_fragment_size_max % u->hw_fragment_size))
u->hw_fragment_size_max += u->hw_fragment_size - (u->hw_fragment_size_max % u->hw_fragment_size);
u->aep_hw_mono_fragment_size = pa_usec_to_bytes(PERIOD_AEP_USECS+1, &u->hw_mono_sample_spec);
u->hw_mono_fragment_size = pa_usec_to_bytes(PERIOD_MASTER_USECS+1, &u->hw_mono_sample_spec);
u->voice_ul_fragment_size = pa_usec_to_bytes(PERIOD_CMT_USECS+1, &u->aep_sample_spec);
pa_silence_memchunk_get(&u->core->silence_cache,
u->core->mempool,
&u->aep_silence_memchunk,
&u->aep_sample_spec,
u->aep_fragment_size);
voice_memchunk_pool_load(u);
if (voice_init_raw_sink(u, raw_sink_name))
goto fail;
pa_sink_put(u->raw_sink);
if (voice_init_voip_sink(u, voice_sink_name))
goto fail;
pa_sink_put(u->voip_sink);
if (voice_init_aep_sink_input(u))
goto fail;
pa_atomic_store(&u->mixer_state, PROP_MIXER_TUNING_PRI);
u->alt_mixer_compensation = PA_VOLUME_NORM;
if (voice_init_hw_sink_input(u))
goto fail;
u->sink_temp_buff = pa_xmalloc(2 * u->hw_fragment_size_max);
u->sink_temp_buff_len = 2 * u->hw_fragment_size_max;
u->dl_memblockq =
pa_memblockq_new(0, 2 * u->voice_ul_fragment_size, 0,
pa_frame_size(&u->aep_sample_spec), 0, 0, 0, NULL);
if (voice_init_raw_source(u, raw_source_name))
goto fail;
pa_source_put(u->raw_source);
if (voice_init_voip_source(u, voice_source_name))
goto fail;
pa_source_put(u->voip_source);
if (voice_init_hw_source_output(u))
goto fail;
u->hw_source_memblockq =
pa_memblockq_new(0, 2 * u->hw_fragment_size_max, 0,
pa_frame_size(&u->hw_sample_spec), 0, 0, 0, NULL);
u->ul_memblockq =
pa_memblockq_new(0, 2 * u->voice_ul_fragment_size, 0,
pa_frame_size(&u->aep_sample_spec), 0, 0, 0, NULL);
u->cs_call_sink_input = 0;
u->dl_sideinfo_queue = pa_queue_new();
u->linear_q15_master_volume_L = INT16_MAX;
u->linear_q15_master_volume_R = INT16_MAX;
u->field_2CC = 0;
voice_aep_ear_ref_init(u);
if (voice_convert_init(u))
goto fail;
if (voice_init_event_forwarder(u, dbus_type) || voice_init_cmtspeech(u))
goto fail;
if (!(u->wb_mic_iir_eq = iir_eq_new(u->hw_fragment_size / 2,
master_source->sample_spec.channels)))
goto fail;
if (!(u->nb_mic_iir_eq = iir_eq_new( u->aep_fragment_size / 2, 1)))
goto fail;
if (!(u->wb_ear_iir_eq = fir_eq_new(master_sink->sample_spec.rate,
master_sink->sample_spec.channels)))
goto fail;
if (!(u->nb_ear_iir_eq = iir_eq_new(u->aep_fragment_size / 2, 1)))
goto fail;
u->input_task_active = FALSE;
u->xprot_watchdog = TRUE;
u->ambient_temp = 30;
if (!(u->xprot = xprot_new()))
goto fail;
u->aep_enable = FALSE;
u->wb_meq_enable = FALSE;
u->wb_eeq_enable = FALSE;
u->nb_meq_enable = FALSE;
u->nb_eeq_enable = FALSE;
u->xprot_enable = FALSE;
u->updating_parameters = FALSE;
u->sink_proplist_changed_slot =
pa_hook_connect(&m->core->hooks[PA_CORE_HOOK_SINK_PROPLIST_CHANGED],
0, (pa_hook_cb_t)sink_proplist_changed_cb, u);;
u->source_proplist_changed_slot =
pa_hook_connect( &m->core->hooks[PA_CORE_HOOK_SOURCE_PROPLIST_CHANGED], 0,
(pa_hook_cb_t)source_proplist_changed_cb, u);
u->mode_accessory_hwid_hash = 0;
p = pa_proplist_new();
pa_proplist_sets(p, PA_NOKIA_PROP_AUDIO_MODE, "ihf");
pa_proplist_sets(p, PA_NOKIA_PROP_AUDIO_ACCESSORY_HWID, "");
pa_sink_update_proplist( master_sink, PA_UPDATE_REPLACE, p);
pa_proplist_free(p);
pa_source_output_put(u->hw_source_output);
pa_sink_input_put(u->hw_sink_input);
pa_sink_input_put(u->aep_sink_input);
u->sink_subscription = pa_subscription_new(m->core, PA_SUBSCRIPTION_MASK_SINK,
sink_subscribe_cb, u);
return 0;
fail:
if (ma)
pa_modargs_free(ma);
pa__done(m);
return -1;
}
/* Generic sink state change logic. Used by raw_sink and voip_sink */
int voice_sink_set_state(pa_sink *s, pa_sink *other, pa_sink_state_t state) {
struct userdata *u;
pa_sink *om_sink;
pa_sink_assert_ref(s);
pa_assert_se(u = s->userdata);
if (!other) {
pa_log_debug("other sink not initialized or freed");
return 0;
}
pa_sink_assert_ref(other);
om_sink = u->master_sink;
if (u->hw_sink_input && PA_SINK_INPUT_IS_LINKED(pa_sink_input_get_state(u->hw_sink_input))) {
if (pa_sink_input_get_state(u->hw_sink_input) == PA_SINK_INPUT_CORKED) {
if (PA_SINK_IS_OPENED(state) ||
PA_SINK_IS_OPENED(pa_sink_get_state(other)) ||
pa_atomic_load(&u->cmt_connection.dl_state) == CMT_DL_ACTIVE) {
pa_sink_input_cork(u->hw_sink_input, FALSE);
pa_log_debug("hw_sink_input uncorked");
}
}
else {
if (state == PA_SINK_SUSPENDED &&
pa_sink_get_state(other) == PA_SINK_SUSPENDED &&
pa_atomic_load(&u->cmt_connection.dl_state) != CMT_DL_ACTIVE) {
pa_sink_input_cork(u->hw_sink_input, TRUE);
pa_log_debug("hw_sink_input corked");
}
}
}
if (om_sink == NULL) {
pa_log_info("No master sink, assuming primary mixer tuning.\n");
pa_atomic_store(&u->mixer_state, PROP_MIXER_TUNING_PRI);
}
else if (pa_atomic_load(&u->cmt_connection.dl_state) == CMT_DL_ACTIVE ||
(pa_sink_get_state(u->voip_sink) <= PA_SINK_SUSPENDED &&
voice_voip_sink_used_by(u))) {
if (pa_atomic_load(&u->mixer_state) == PROP_MIXER_TUNING_PRI) {
pa_proplist *p = pa_proplist_new();
pa_assert(p);
pa_proplist_sets(p, PROP_MIXER_TUNING_MODE, PROP_MIXER_TUNING_ALT_S);
pa_sink_update_proplist(om_sink, PA_UPDATE_REPLACE, p);
pa_atomic_store(&u->mixer_state, PROP_MIXER_TUNING_ALT);
pa_proplist_free(p);
if (u->sidetone_enable)
voice_enable_sidetone(u,1);
}
}
else {
if (pa_atomic_load(&u->mixer_state) == PROP_MIXER_TUNING_ALT) {
pa_proplist *p = pa_proplist_new();
pa_assert(p);
pa_proplist_sets(p, PROP_MIXER_TUNING_MODE, PROP_MIXER_TUNING_PRI_S);
pa_sink_update_proplist(om_sink, PA_UPDATE_REPLACE, p);
pa_atomic_store(&u->mixer_state, PROP_MIXER_TUNING_PRI);
pa_proplist_free(p);
voice_enable_sidetone(u,0);
}
}
return 0;
}
void
voice_sink_proplist_update(struct userdata *u, pa_sink *s)
{
pa_sink *master_sink;
const char *mode;
const char *accessory_hwid;
pa_proplist *p;
char *hash_str;
unsigned int hash;
const char *file;
char fname[256];
size_t nbytes;
const void *data;
master_sink = voice_get_original_master_sink(u);
ENTER();
if (!master_sink)
{
pa_log_warn("Original master sink not found, parameters not loaded.");
return;
}
if (!pa_proplist_get(s->proplist, "x-maemo.aep.trace-func", &data, &nbytes))
memcpy(&u->trace_func, data, sizeof(u->trace_func));
mode = pa_proplist_gets(s->proplist, PA_NOKIA_PROP_AUDIO_MODE);
accessory_hwid = pa_proplist_gets(s->proplist,
PA_NOKIA_PROP_AUDIO_ACCESSORY_HWID);
if (!accessory_hwid || !mode)
return;
if (master_sink != s)
{
p = pa_proplist_new();
pa_proplist_sets(p, PA_NOKIA_PROP_AUDIO_MODE, mode);
pa_proplist_sets(p, PA_NOKIA_PROP_AUDIO_ACCESSORY_HWID, accessory_hwid);
pa_proplist_update(master_sink->proplist, PA_UPDATE_REPLACE, p);
pa_proplist_free(p);
}
hash_str = pa_sprintf_malloc("%s%s", mode, accessory_hwid);
hash = pa_idxset_string_hash_func(hash_str);
pa_xfree(hash_str);
if (hash == u->mode_accessory_hwid_hash &&
!voice_pa_proplist_get_bool(master_sink->proplist, "x-maemo.tuning"))
return;
u->mode_accessory_hwid_hash = hash;
file = pa_proplist_gets(master_sink->proplist, "x-maemo.file");
if (!file)
file = "/var/lib/pulse-nokia/%s%s.parameters";
pa_snprintf(fname, sizeof(fname), file, mode);
pa_log_debug("Loading tuning parameters from file: %s",fname);
p = pa_nokia_proplist_from_file(fname);
if (!pa_proplist_contains(p, "x-maemo.aep") )
{
pa_log_warn("Parameter file not valid: %s", fname);
pa_proplist_free(p);
return;
}
u->btmono = FALSE;
if (!strcmp(mode, "ihf"))
aep_runtime_switch[3] = 'i';
else if (!strcmp(mode, "hs"))
aep_runtime_switch[3] = 't';
else if (!strcmp(mode, "btmono"))
{
aep_runtime_switch[3] = 't';
u->btmono = TRUE;
}
else if (!strcmp(mode, "hp"))
aep_runtime_switch[3] = 'p';
else if (!strcmp(mode, "lineout"))
aep_runtime_switch[3] = 'f';
else
aep_runtime_switch[3] = 't';
if (master_sink == s)
pa_proplist_update(master_sink->proplist, PA_UPDATE_REPLACE, p);
else
pa_sink_update_proplist(master_sink, PA_UPDATE_REPLACE, p);
pa_proplist_free(p);
voice_update_parameters(u);
return;
}