diff --git a/meson.build b/meson.build index 412f57c8b..4be67c13b 100644 --- a/meson.build +++ b/meson.build @@ -405,6 +405,9 @@ lilv_lib = dependency('lilv-0', required: get_option('lv2')) summary({'lilv (for lv2 plugins)': lilv_lib.found()}, bool_yn: true) cdata.set('HAVE_LILV', lilv_lib.found()) +libffado_dep = dependency('libffado', required: get_option('libffado')) +summary({'ffado': libffado_dep.found()}, bool_yn: true) + check_functions = [ ['gettid', '#include ', ['-D_GNU_SOURCE'], []], ['memfd_create', '#include ', ['-D_GNU_SOURCE'], []], diff --git a/meson_options.txt b/meson_options.txt index 9ca5cf821..85fe9dfb7 100644 --- a/meson_options.txt +++ b/meson_options.txt @@ -322,3 +322,7 @@ option('opus', description: 'Enable code that depends on opus', type: 'feature', value: 'auto') +option('libffado', + description: 'Enable code that depends on libffado', + type: 'feature', + value: 'auto') diff --git a/src/modules/meson.build b/src/modules/meson.build index 5d2dc9984..ed243ace0 100644 --- a/src/modules/meson.build +++ b/src/modules/meson.build @@ -14,6 +14,7 @@ module_sources = [ 'module-example-sink.c', 'module-example-source.c', 'module-fallback-sink.c', + 'module-ffado-driver.c', 'module-filter-chain.c', 'module-jack-tunnel.c', 'module-jackdbus-detect.c', @@ -185,6 +186,19 @@ endif summary({'jack-tunnel': build_module_jack_tunnel}, bool_yn: true, section: 'Optional Modules') +build_module_ffado_driver = libffado_dep.found() +if build_module_ffado_driver + pipewire_module_jack_tunnel = shared_library('pipewire-module-ffado-driver', + [ 'module-ffado-driver.c' ], + include_directories : [configinc], + install : true, + install_dir : modules_install_dir, + install_rpath: modules_install_dir, + dependencies : [mathlib, dl_lib, pipewire_dep, libffado_dep], + ) +endif + +summary({'ffado-driver': build_module_ffado_driver}, bool_yn: true, section: 'Optional Modules') pipewire_module_profiler = shared_library('pipewire-module-profiler', diff --git a/src/modules/module-ffado-driver.c b/src/modules/module-ffado-driver.c new file mode 100644 index 000000000..a58fa5306 --- /dev/null +++ b/src/modules/module-ffado-driver.c @@ -0,0 +1,1048 @@ +/* PipeWire */ +/* SPDX-FileCopyrightText: Copyright © 2021 Wim Taymans */ +/* SPDX-License-Identifier: MIT */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "config.h" + +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include +#include + +#include + +/** \page page_module_ffado_driver PipeWire Module: FFADO firewire audio driver + * + * The ffado-driver module provides a source or sink using the libffado library for + * reading and writing to firewire audio devices. + * + * ## Module Options + * + * - `driver.mode`: the driver mode, sink|source|duplex, default duplex + * - `midi.ports`: the number of midi ports. Can also be added to the stream props. + * - `source.props`: Extra properties for the source filter. + * - `sink.props`: Extra properties for the sink filter. + * + * ## General options + * + * Options with well-known behavior. + * + * - \ref PW_KEY_REMOTE_NAME + * - \ref SPA_KEY_AUDIO_POSITION + * - \ref PW_KEY_NODE_NAME + * - \ref PW_KEY_NODE_DESCRIPTION + * - \ref PW_KEY_NODE_GROUP + * - \ref PW_KEY_NODE_VIRTUAL + * - \ref PW_KEY_MEDIA_CLASS + * - \ref PW_KEY_TARGET_OBJECT to specify the remote node.name or serial.id to link to + * + * ## Example configuration of a duplex sink/source + * + *\code{.unparsed} + * context.modules = [ + * { name = libpipewire-module-ffado-driver + * args = { + * #driver.mode = duplex + * #midi.ports = 0 + * #audio.channels = 2 + * #audio.position = [ FL FR ] + * source.props = { + * # extra sink properties + * } + * sink.props = { + * # extra sink properties + * } + * } + * } + * ] + *\endcode + */ + +#define NAME "ffado-driver" + +PW_LOG_TOPIC_STATIC(mod_topic, "mod." NAME); +#define PW_LOG_TOPIC_DEFAULT mod_topic + +#define MAX_PORTS 128 + +#define DEFAULT_CHANNELS 2 +#define DEFAULT_POSITION "[ FL FR ]" +#define DEFAULT_MIDI_PORTS 1 + +#define MODULE_USAGE "( remote.name= ] " \ + "( driver.mode= ] " \ + "( midi.ports= ] " \ + "( audio.channels= ] " \ + "( audio.position= ] " \ + "( source.props= ) " \ + "( sink.props= ) " + + +static const struct spa_dict_item module_props[] = { + { PW_KEY_MODULE_AUTHOR, "Wim Taymans " }, + { PW_KEY_MODULE_DESCRIPTION, "Create an FFADO based driver" }, + { PW_KEY_MODULE_USAGE, MODULE_USAGE }, + { PW_KEY_MODULE_VERSION, PACKAGE_VERSION }, +}; + +struct port { + enum spa_direction direction; + struct spa_latency_info latency[2]; + bool latency_changed[2]; + unsigned int is_midi:1; + void *buffer; +}; + +struct volume { + bool mute; + uint32_t n_volumes; + float volumes[SPA_AUDIO_MAX_CHANNELS]; +}; + +struct stream { + struct impl *impl; + + enum spa_direction direction; + struct pw_properties *props; + struct pw_filter *filter; + struct spa_hook listener; + struct spa_audio_info_raw info; + uint32_t n_ports; + struct port *ports[MAX_PORTS]; + struct volume volume; + + unsigned int running:1; + unsigned int connect:1; +}; + +struct impl { + struct pw_context *context; + struct pw_loop *main_loop; + struct spa_system *system; + struct spa_thread_utils *utils; + + ffado_device_info_t device_info; + ffado_options_t device_options; + ffado_device_t *dev; + +#define MODE_SINK (1<<0) +#define MODE_SOURCE (1<<1) +#define MODE_DUPLEX (MODE_SINK|MODE_SOURCE) + uint32_t mode; + struct pw_properties *props; + + struct pw_impl_module *module; + + struct spa_hook module_listener; + + struct pw_core *core; + struct spa_hook core_proxy_listener; + struct spa_hook core_listener; + + struct spa_io_position *position; + + uint32_t latency[2]; + + struct stream source; + struct stream sink; + + int32_t sample_rate; + int32_t period_size; + int32_t n_periods; + uint32_t quantum_limit; + + uint32_t pw_xrun; + uint32_t ffado_xrun; + + pthread_t thread; + + unsigned int do_disconnect:1; + unsigned int done:1; + unsigned int new_xrun:1; + unsigned int fix_midi:1; +}; + +static void reset_volume(struct volume *vol, uint32_t n_volumes) +{ + uint32_t i; + vol->mute = false; + vol->n_volumes = n_volumes; + for (i = 0; i < n_volumes; i++) + vol->volumes[i] = 1.0f; +} + +static inline void do_volume(float *dst, const float *src, struct volume *vol, uint32_t ch, uint32_t n_samples) +{ + float v = vol->mute ? 0.0f : vol->volumes[ch]; + + if (v == 0.0f || src == NULL) + memset(dst, 0, n_samples * sizeof(float)); + else if (v == 1.0f) + memcpy(dst, src, n_samples * sizeof(float)); + else { + uint32_t i; + for (i = 0; i < n_samples; i++) + dst[i] = src[i] * v; + } +} + +static inline void fix_midi_event(uint8_t *data, size_t size) +{ + /* fixup NoteOn with vel 0 */ + if (size > 2 && (data[0] & 0xF0) == 0x90 && data[2] == 0x00) { + data[0] = 0x80 + (data[0] & 0x0F); + data[2] = 0x40; + } +} + +static void midi_to_ffado(struct impl *impl, float *dst, float *src, uint32_t n_samples) +{ + struct spa_pod *pod; + struct spa_pod_sequence *seq; + struct spa_pod_control *c; + + if (src == NULL) + return; + + if ((pod = spa_pod_from_data(src, n_samples * sizeof(float), 0, n_samples * sizeof(float))) == NULL) + return; + if (!spa_pod_is_sequence(pod)) + return; + + seq = (struct spa_pod_sequence*)pod; + + SPA_POD_SEQUENCE_FOREACH(seq, c) { + switch(c->type) { + case SPA_CONTROL_Midi: + { + uint8_t *data = SPA_POD_BODY(&c->value); + size_t size = SPA_POD_BODY_SIZE(&c->value); + + if (impl->fix_midi) + fix_midi_event(data, size); + + break; + } + default: + break; + } + } +} + +static void ffado_to_midi(float *dst, float *src, uint32_t size) +{ + struct spa_pod_builder b = { 0, }; + uint32_t i, count; + struct spa_pod_frame f; + + count = src ? 0 : 0; + + spa_pod_builder_init(&b, dst, size); + spa_pod_builder_push_sequence(&b, &f, 0); + for (i = 0; i < count; i++) { + } + spa_pod_builder_pop(&b, &f); +} + +static void stream_destroy(void *d) +{ + struct stream *s = d; + spa_hook_remove(&s->listener); + s->filter = NULL; +} + +static void stream_state_changed(void *d, enum pw_filter_state old, + enum pw_filter_state state, const char *error) +{ + struct stream *s = d; + struct impl *impl = s->impl; + switch (state) { + case PW_FILTER_STATE_ERROR: + case PW_FILTER_STATE_UNCONNECTED: + pw_impl_module_schedule_destroy(impl->module); + break; + case PW_FILTER_STATE_PAUSED: + s->running = false; + break; + case PW_FILTER_STATE_STREAMING: + s->running = true; + break; + default: + break; + } +} + +static void sink_process(void *d, struct spa_io_position *position) +{ + struct stream *s = d; + struct impl *impl = s->impl; + uint32_t i, n_samples = position->clock.duration; + + for (i = 0; i < s->n_ports; i++) { + struct port *p = s->ports[i]; + float *src; + if (p == NULL) + continue; + + src = pw_filter_get_dsp_buffer(p, n_samples); + if (src == NULL) + continue; + + if (SPA_UNLIKELY(p->is_midi)) + midi_to_ffado(impl, p->buffer, src, n_samples); + else + do_volume(p->buffer, src, &s->volume, i, n_samples); + } + ffado_streaming_transfer_playback_buffers(impl->dev); + + pw_log_trace_fp("done %u", impl->frame_time); + if (impl->mode & MODE_SINK) { + impl->done = true; + } +} + +static void source_process(void *d, struct spa_io_position *position) +{ + struct stream *s = d; + struct impl *impl = s->impl; + uint32_t i, n_samples = position->clock.duration; + + ffado_streaming_transfer_capture_buffers(impl->dev); + + for (i = 0; i < s->n_ports; i++) { + struct port *p = s->ports[i]; + float *dst; + + if (p == NULL || p->buffer == NULL) + continue; + + dst = pw_filter_get_dsp_buffer(p, n_samples); + if (dst == NULL) + continue; + + if (SPA_UNLIKELY(p->is_midi)) + ffado_to_midi(dst, p->buffer, n_samples); + else + do_volume(dst, p->buffer, &s->volume, i, n_samples); + } + pw_log_trace_fp("done %u", impl->frame_time); + if (impl->mode == MODE_SOURCE) { + impl->done = true; + } +} + +static void stream_io_changed(void *data, void *port_data, uint32_t id, void *area, uint32_t size) +{ + struct stream *s = data; + struct impl *impl = s->impl; + if (port_data == NULL) { + switch (id) { + case SPA_IO_Position: + impl->position = area; + break; + default: + break; + } + } +} + +static void param_latency_changed(struct stream *s, const struct spa_pod *param, + struct port *port) +{ + struct spa_latency_info latency; + bool update = false; + enum spa_direction direction = port->direction; + + if (spa_latency_parse(param, &latency) < 0) + return; + + if (spa_latency_info_compare(&port->latency[direction], &latency)) { + port->latency[direction] = latency; + port->latency_changed[direction] = update = true; + } +} + +static void make_stream_ports(struct stream *s) +{ + struct impl *impl = s->impl; + struct pw_properties *props; + char name[512]; + uint8_t buffer[1024]; + struct spa_pod_builder b; + const struct spa_pod *params[2]; + uint32_t i, n_params = 0; + bool is_midi; + + for (i = 0; i < s->n_ports; i++) { + struct port *port = s->ports[i]; + ffado_streaming_stream_type stream_type; + char portname[256]; + + if (port != NULL) { + s->ports[i] = NULL; + free(port->buffer); + pw_filter_remove_port(port); + } + + if (s->direction == PW_DIRECTION_INPUT) { + ffado_streaming_get_playback_stream_name(impl->dev, i, portname, sizeof(portname)); + stream_type = ffado_streaming_get_playback_stream_type(impl->dev, i); + snprintf(name, sizeof(name), "%s_out", portname); + } else { + ffado_streaming_get_capture_stream_name(impl->dev, i, portname, sizeof(portname)); + stream_type = ffado_streaming_get_capture_stream_type(impl->dev, i); + snprintf(name, sizeof(name), "%s_in", portname); + } + + switch (stream_type) { + case ffado_stream_type_audio: + props = pw_properties_new( + PW_KEY_FORMAT_DSP, "32 bit float mono audio", + PW_KEY_PORT_PHYSICAL, "true", + PW_KEY_PORT_NAME, name, + NULL); + is_midi = false; + break; + case ffado_stream_type_midi: + props = pw_properties_new( + PW_KEY_FORMAT_DSP, "8 bit raw midi", + PW_KEY_PORT_NAME, name, + PW_KEY_PORT_PHYSICAL, "true", + NULL); + + is_midi = true; + break; + default: + pw_log_info("not registering unknown stream %d %s (type %d)", i, + name, stream_type); + continue; + + } + spa_zero(port->latency[s->direction]); + port->latency[s->direction].min_quantum = + port->latency[s->direction].max_quantum = 1; + port->latency[s->direction].min_rate = + port->latency[s->direction].max_rate = impl->latency[s->direction]; + + spa_pod_builder_init(&b, buffer, sizeof(buffer)); + n_params = 0; + params[n_params++] = spa_latency_build(&b, + SPA_PARAM_Latency, &port->latency[s->direction]); + + port = pw_filter_add_port(s->filter, + s->direction, + PW_FILTER_PORT_FLAG_MAP_BUFFERS, + sizeof(struct port), + props, params, n_params); + if (port == NULL) { + pw_log_error("Can't create port: %m"); + return; + } + + port->is_midi = is_midi; + port->buffer = calloc(sizeof(float), impl->quantum_limit); + if (port->buffer == NULL) { + pw_log_error("Can't create port buffer: %m"); + return; + } + + if (ffado_streaming_set_capture_stream_buffer(impl->dev, i, port->buffer)) + pw_log_error("cannot configure port buffer for %s", name); + + if (ffado_streaming_capture_stream_onoff(impl->dev, i, 1)) + pw_log_error("cannot enable port %s", name); + + s->ports[i] = port; + } +} + +static struct spa_pod *make_props_param(struct spa_pod_builder *b, + struct volume *vol) +{ + return spa_pod_builder_add_object(b, SPA_TYPE_OBJECT_Props, SPA_PARAM_Props, + SPA_PROP_mute, SPA_POD_Bool(vol->mute), + SPA_PROP_channelVolumes, SPA_POD_Array(sizeof(float), + SPA_TYPE_Float, vol->n_volumes, vol->volumes)); +} + +static void parse_props(struct stream *s, const struct spa_pod *param) +{ + struct spa_pod_object *obj = (struct spa_pod_object *) param; + struct spa_pod_prop *prop; + uint8_t buffer[1024]; + struct spa_pod_builder b; + const struct spa_pod *params[1]; + + SPA_POD_OBJECT_FOREACH(obj, prop) { + switch (prop->key) { + case SPA_PROP_mute: + { + bool mute; + if (spa_pod_get_bool(&prop->value, &mute) == 0) + s->volume.mute = mute; + break; + } + case SPA_PROP_channelVolumes: + { + uint32_t n; + float vols[SPA_AUDIO_MAX_CHANNELS]; + if ((n = spa_pod_copy_array(&prop->value, SPA_TYPE_Float, + vols, SPA_AUDIO_MAX_CHANNELS)) > 0) { + s->volume.n_volumes = n; + for (n = 0; n < s->volume.n_volumes; n++) + s->volume.volumes[n] = vols[n]; + } + break; + } + default: + break; + } + } + spa_pod_builder_init(&b, buffer, sizeof(buffer)); + params[0] = make_props_param(&b, &s->volume); + + pw_filter_update_params(s->filter, NULL, params, 1); +} + +static void stream_param_changed(void *data, void *port_data, uint32_t id, + const struct spa_pod *param) +{ + struct stream *s = data; + if (port_data != NULL) { + switch (id) { + case SPA_PARAM_Latency: + param_latency_changed(s, param, port_data); + break; + } + } else { + switch (id) { + case SPA_PARAM_PortConfig: + pw_log_debug("PortConfig"); + make_stream_ports(s); + break; + case SPA_PARAM_Props: + pw_log_debug("Props"); + parse_props(s, param); + break; + } + } +} + +static const struct pw_filter_events sink_events = { + PW_VERSION_FILTER_EVENTS, + .destroy = stream_destroy, + .state_changed = stream_state_changed, + .param_changed = stream_param_changed, + .io_changed = stream_io_changed, + .process = sink_process +}; + +static const struct pw_filter_events source_events = { + PW_VERSION_FILTER_EVENTS, + .destroy = stream_destroy, + .state_changed = stream_state_changed, + .param_changed = stream_param_changed, + .io_changed = stream_io_changed, + .process = source_process, +}; + +static int make_stream(struct stream *s, const char *name) +{ + struct impl *impl = s->impl; + uint32_t n_params; + const struct spa_pod *params[4]; + uint8_t buffer[1024]; + struct spa_pod_builder b; + struct spa_latency_info latency; + + spa_zero(latency); + n_params = 0; + spa_pod_builder_init(&b, buffer, sizeof(buffer)); + + s->filter = pw_filter_new(impl->core, name, s->props); + s->props = NULL; + if (s->filter == NULL) + return -errno; + + if (s->direction == PW_DIRECTION_INPUT) { + pw_filter_add_listener(s->filter, &s->listener, + &sink_events, s); + } else { + pw_filter_add_listener(s->filter, &s->listener, + &source_events, s); + } + + reset_volume(&s->volume, s->info.channels); + + n_params = 0; + params[n_params++] = spa_format_audio_raw_build(&b, + SPA_PARAM_EnumFormat, &s->info); + params[n_params++] = spa_format_audio_raw_build(&b, + SPA_PARAM_Format, &s->info); + params[n_params++] = make_props_param(&b, &s->volume); + + return pw_filter_connect(s->filter, + PW_FILTER_FLAG_DRIVER | + PW_FILTER_FLAG_RT_PROCESS | + PW_FILTER_FLAG_CUSTOM_LATENCY, + params, n_params); +} + +static int create_filters(struct impl *impl) +{ + int res = 0; + + if (impl->mode & MODE_SINK) + res = make_stream(&impl->sink, "FFADO Sink"); + + if (impl->mode & MODE_SOURCE) + res = make_stream(&impl->source, "FFADO Source"); + + return res; +} + +static inline uint64_t get_time_ns(void) +{ + struct timespec ts; + clock_gettime(CLOCK_MONOTONIC, &ts); + return SPA_TIMESPEC_TO_NSEC(&ts); +} + +static void *ffado_process_thread(void *arg) +{ + struct impl *impl = arg; + bool source_running, sink_running; + uint32_t nsec; + + while (true) { + ffado_wait_response response; + + response = ffado_streaming_wait(impl->dev); + nsec = get_time_ns(); + + switch (response) { + case ffado_wait_ok: + break; + case ffado_wait_xrun: + pw_log_warn("FFADO xrun"); + break; + case ffado_wait_shutdown: + pw_log_info("FFADO shutdown"); + return NULL; + case ffado_wait_error: + default: + pw_log_error("FFADO error"); + return NULL; + } + source_running = impl->source.running; + sink_running = impl->sink.running; + + pw_log_trace_fp("process %d %u %u %p %d", impl->period_size, source_running, + sink_running, impl->position, impl->frame_time); + + if (impl->new_xrun) { + pw_log_warn("Xrun FFADO:%u PipeWire:%u", impl->ffado_xrun, impl->pw_xrun); + impl->new_xrun = false; + } + + if (impl->position) { + struct spa_io_clock *c = &impl->position->clock; + + c->nsec = nsec; + c->rate = SPA_FRACTION(1, impl->sample_rate); + c->position += impl->period_size; + c->duration = impl->period_size; + c->delay = 0; + c->rate_diff = 1.0; + c->next_nsec = nsec; + + c->target_rate = c->rate; + c->target_duration = c->duration; + } + if (impl->mode & MODE_SINK && sink_running) { + impl->done = false; + pw_filter_trigger_process(impl->sink.filter); + } else if (impl->mode == MODE_SOURCE && source_running) { + impl->done = false; + pw_filter_trigger_process(impl->source.filter); + } + } + return NULL; +} + +static int +do_schedule_destroy(struct spa_loop *loop, + bool async, uint32_t seq, const void *data, size_t size, void *user_data) +{ + struct impl *impl = user_data; + pw_impl_module_schedule_destroy(impl->module); + return 0; +} + +void module_schedule_destroy(struct impl *impl) +{ + pw_loop_invoke(impl->main_loop, do_schedule_destroy, 1, NULL, 0, false, impl); +} + +static int open_ffado_device(struct impl *impl) +{ + ffado_streaming_stream_type stream_type; + uint32_t i; + + spa_zero(impl->device_info); + spa_zero(impl->device_options); + + impl->device_options.sample_rate = impl->sample_rate; + impl->device_options.period_size = impl->period_size; + impl->device_options.nb_buffers = impl->n_periods; + impl->device_options.realtime = 1; + impl->device_options.packetizer_priority = 88; + + impl->dev = ffado_streaming_init(impl->device_info, impl->device_options); + if (impl->dev == NULL) { + pw_log_error("can't open FFADO device"); + return -EIO; + } + + if (impl->device_options.realtime) { + pw_log_info("Streaming thread running with Realtime scheduling, priority %d", + impl->device_options.packetizer_priority); + } else { + pw_log_info("Streaming thread running without Realtime scheduling"); + } + + ffado_streaming_set_audio_datatype(impl->dev, ffado_audio_datatype_float); + + impl->sample_rate = impl->device_options.sample_rate; + impl->source.info.rate = impl->sample_rate; + impl->sink.info.rate = impl->sample_rate; + + impl->source.info.channels = 0; + impl->source.n_ports = ffado_streaming_get_nb_capture_streams(impl->dev); + for (i = 0; i < impl->source.n_ports; i++) { + stream_type = ffado_streaming_get_capture_stream_type(impl->dev, i); + switch (stream_type) { + case ffado_stream_type_audio: + impl->source.info.channels++; + break; + default: + } + } + impl->sink.info.channels = 0; + impl->sink.n_ports = ffado_streaming_get_nb_playback_streams(impl->dev); + for (i = 0; i < impl->sink.n_ports; i++) { + stream_type = ffado_streaming_get_playback_stream_type(impl->dev, i); + switch (stream_type) { + case ffado_stream_type_audio: + impl->sink.info.channels++; + break; + default: + } + } + if (ffado_streaming_prepare(impl->dev)) { + pw_log_error("Could not prepare streaming"); + return -EIO; + } + return 0; +} + +static int start_ffado_device(struct impl *impl) +{ + struct spa_thread *thr; + + if (ffado_streaming_start(impl->dev)) { + pw_log_error("Could not start streaming"); + return -EIO; + } + + thr = spa_thread_utils_create(impl->utils, NULL, ffado_process_thread, impl); + impl->thread = (pthread_t)thr; + if (thr == NULL) { + pw_log_error("%p: can't create thread: %m", impl); + return -errno; + } + spa_thread_utils_acquire_rt(impl->utils, thr, -1); + + return 0; +} + +static int stop_ffado_device(struct impl *impl) +{ + if (ffado_streaming_stop(impl->dev)) { + pw_log_error("Could not stop streaming"); + } + spa_thread_utils_join(impl->utils, (struct spa_thread*)impl->thread, NULL); + + return 0; +} + +static void core_error(void *data, uint32_t id, int seq, int res, const char *message) +{ + struct impl *impl = data; + + pw_log_error("error id:%u seq:%d res:%d (%s): %s", + id, seq, res, spa_strerror(res), message); + + if (id == PW_ID_CORE && res == -EPIPE) + pw_impl_module_schedule_destroy(impl->module); +} + +static const struct pw_core_events core_events = { + PW_VERSION_CORE_EVENTS, + .error = core_error, +}; + +static void core_destroy(void *d) +{ + struct impl *impl = d; + spa_hook_remove(&impl->core_listener); + impl->core = NULL; + pw_impl_module_schedule_destroy(impl->module); +} + +static const struct pw_proxy_events core_proxy_events = { + .destroy = core_destroy, +}; + +static void impl_destroy(struct impl *impl) +{ + if (impl->dev) { + stop_ffado_device(impl); + ffado_streaming_finish(impl->dev); + impl->dev = NULL; + } + if (impl->source.filter) + pw_filter_destroy(impl->source.filter); + if (impl->sink.filter) + pw_filter_destroy(impl->sink.filter); + if (impl->core && impl->do_disconnect) + pw_core_disconnect(impl->core); + + pw_properties_free(impl->sink.props); + pw_properties_free(impl->source.props); + pw_properties_free(impl->props); + + free(impl); +} + +static void module_destroy(void *data) +{ + struct impl *impl = data; + spa_hook_remove(&impl->module_listener); + impl_destroy(impl); +} + +static const struct pw_impl_module_events module_events = { + PW_VERSION_IMPL_MODULE_EVENTS, + .destroy = module_destroy, +}; + +static uint32_t channel_from_name(const char *name) +{ + int i; + for (i = 0; spa_type_audio_channel[i].name; i++) { + if (spa_streq(name, spa_debug_type_short_name(spa_type_audio_channel[i].name))) + return spa_type_audio_channel[i].type; + } + return SPA_AUDIO_CHANNEL_UNKNOWN; +} + +static void parse_position(struct spa_audio_info_raw *info, const char *val, size_t len) +{ + struct spa_json it[2]; + char v[256]; + + spa_json_init(&it[0], val, len); + if (spa_json_enter_array(&it[0], &it[1]) <= 0) + spa_json_init(&it[1], val, len); + + info->channels = 0; + while (spa_json_get_string(&it[1], v, sizeof(v)) > 0 && + info->channels < SPA_AUDIO_MAX_CHANNELS) { + info->position[info->channels++] = channel_from_name(v); + } +} + +static void parse_audio_info(const struct pw_properties *props, struct spa_audio_info_raw *info) +{ + const char *str; + + spa_zero(*info); + info->format = SPA_AUDIO_FORMAT_F32P; + info->rate = 0; + info->channels = pw_properties_get_uint32(props, PW_KEY_AUDIO_CHANNELS, info->channels); + info->channels = SPA_MIN(info->channels, SPA_AUDIO_MAX_CHANNELS); + if ((str = pw_properties_get(props, SPA_KEY_AUDIO_POSITION)) != NULL) + parse_position(info, str, strlen(str)); + if (info->channels == 0) + parse_position(info, DEFAULT_POSITION, strlen(DEFAULT_POSITION)); +} + +static void copy_props(struct impl *impl, struct pw_properties *props, const char *key) +{ + const char *str; + if ((str = pw_properties_get(props, key)) != NULL) { + if (pw_properties_get(impl->sink.props, key) == NULL) + pw_properties_set(impl->sink.props, key, str); + if (pw_properties_get(impl->source.props, key) == NULL) + pw_properties_set(impl->source.props, key, str); + } +} + +SPA_EXPORT +int pipewire__module_init(struct pw_impl_module *module, const char *args) +{ + struct pw_context *context = pw_impl_module_get_context(module); + struct pw_properties *props = NULL; + struct impl *impl; + const char *str; + int res; + + PW_LOG_TOPIC_INIT(mod_topic); + + impl = calloc(1, sizeof(struct impl)); + if (impl == NULL) + return -errno; + + pw_log_debug("module %p: new %s", impl, args); + + if (args == NULL) + args = ""; + + props = pw_properties_new_string(args); + if (props == NULL) { + res = -errno; + pw_log_error( "can't create properties: %m"); + goto error; + } + impl->props = props; + impl->period_size = 1024; + impl->sample_rate = 48000; + impl->quantum_limit = 8192; + impl->utils = pw_thread_utils_get(); + + impl->sink.props = pw_properties_new(NULL, NULL); + impl->source.props = pw_properties_new(NULL, NULL); + if (impl->source.props == NULL || impl->sink.props == NULL) { + res = -errno; + pw_log_error( "can't create properties: %m"); + goto error; + } + + impl->module = module; + impl->context = context; + impl->main_loop = pw_context_get_main_loop(context); + impl->system = impl->main_loop->system; + + impl->source.impl = impl; + impl->source.direction = PW_DIRECTION_OUTPUT; + impl->sink.impl = impl; + impl->sink.direction = PW_DIRECTION_INPUT; + + impl->mode = MODE_DUPLEX; + if ((str = pw_properties_get(props, "driver.mode")) != NULL) { + if (spa_streq(str, "source")) { + impl->mode = MODE_SOURCE; + } else if (spa_streq(str, "sink")) { + impl->mode = MODE_SINK; + } else if (spa_streq(str, "duplex")) { + impl->mode = MODE_DUPLEX; + } else { + pw_log_error("invalid driver.mode '%s'", str); + res = -EINVAL; + goto error; + } + } + + if (pw_properties_get(props, PW_KEY_NODE_VIRTUAL) == NULL) + pw_properties_set(props, PW_KEY_NODE_VIRTUAL, "true"); + if (pw_properties_get(props, PW_KEY_NODE_GROUP) == NULL) + pw_properties_set(props, PW_KEY_NODE_GROUP, "ffado-group"); + if (pw_properties_get(props, PW_KEY_NODE_ALWAYS_PROCESS) == NULL) + pw_properties_set(props, PW_KEY_NODE_ALWAYS_PROCESS, "true"); + + pw_properties_set(impl->sink.props, PW_KEY_MEDIA_CLASS, "Audio/Sink"); + pw_properties_set(impl->sink.props, PW_KEY_PRIORITY_DRIVER, "35001"); + pw_properties_set(impl->sink.props, PW_KEY_NODE_NAME, "ffado_sink"); + pw_properties_set(impl->sink.props, PW_KEY_NODE_DESCRIPTION, "FFADO Sink"); + + pw_properties_set(impl->source.props, PW_KEY_MEDIA_CLASS, "Audio/Source"); + pw_properties_set(impl->source.props, PW_KEY_PRIORITY_DRIVER, "35000"); + pw_properties_set(impl->source.props, PW_KEY_NODE_NAME, "ffado_source"); + pw_properties_set(impl->source.props, PW_KEY_NODE_DESCRIPTION, "FFADO Source"); + + if ((str = pw_properties_get(props, "sink.props")) != NULL) + pw_properties_update_string(impl->sink.props, str, strlen(str)); + if ((str = pw_properties_get(props, "source.props")) != NULL) + pw_properties_update_string(impl->source.props, str, strlen(str)); + + copy_props(impl, props, PW_KEY_NODE_ALWAYS_PROCESS); + copy_props(impl, props, PW_KEY_NODE_GROUP); + copy_props(impl, props, PW_KEY_NODE_VIRTUAL); + + parse_audio_info(impl->source.props, &impl->source.info); + parse_audio_info(impl->sink.props, &impl->sink.info); + + impl->core = pw_context_get_object(impl->context, PW_TYPE_INTERFACE_Core); + if (impl->core == NULL) { + str = pw_properties_get(props, PW_KEY_REMOTE_NAME); + impl->core = pw_context_connect(impl->context, + pw_properties_new( + PW_KEY_REMOTE_NAME, str, + NULL), + 0); + impl->do_disconnect = true; + } + if (impl->core == NULL) { + res = -errno; + pw_log_error("can't connect: %m"); + goto error; + } + + pw_proxy_add_listener((struct pw_proxy*)impl->core, + &impl->core_proxy_listener, + &core_proxy_events, impl); + pw_core_add_listener(impl->core, + &impl->core_listener, + &core_events, impl); + + if ((res = open_ffado_device(impl)) < 0) + goto error; + + if ((res = create_filters(impl)) < 0) + goto error; + + if ((res = start_ffado_device(impl)) < 0) + goto error; + + pw_impl_module_add_listener(module, &impl->module_listener, &module_events, impl); + + pw_impl_module_update_properties(module, &SPA_DICT_INIT_ARRAY(module_props)); + + return 0; + +error: + impl_destroy(impl); + return res; +}