/* SPA * * Copyright © 2019 Wim Taymans * * Permission is hereby granted, free of charge, to any person obtaining a * copy of this software and associated documentation files (the "Software"), * to deal in the Software without restriction, including without limitation * the rights to use, copy, modify, merge, publish, distribute, sublicense, * and/or sell copies of the Software, and to permit persons to whom the * Software is furnished to do so, subject to the following conditions: * * The above copyright notice and this permission notice (including the next * paragraph) shall be included in all copies or substantial portions of the * Software. * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER * DEALINGS IN THE SOFTWARE. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #undef SPA_LOG_TOPIC_DEFAULT #define SPA_LOG_TOPIC_DEFAULT log_topic static struct spa_log_topic *log_topic = &SPA_LOG_TOPIC(0, "spa.audioadapter"); #define DEFAULT_ALIGN 16 #define MAX_PORTS (SPA_AUDIO_MAX_CHANNELS+1) /** \cond */ struct impl { struct spa_handle handle; struct spa_node node; struct spa_log *log; struct spa_cpu *cpu; uint32_t max_align; enum spa_direction direction; struct spa_node *target; struct spa_node *follower; struct spa_hook follower_listener; uint32_t follower_flags; struct spa_audio_info follower_current_format; struct spa_audio_info default_format; struct spa_handle *hnd_convert; struct spa_node *convert; struct spa_hook convert_listener; uint32_t convert_flags; uint32_t n_buffers; struct spa_buffer **buffers; struct spa_io_buffers io_buffers; struct spa_io_rate_match io_rate_match; struct spa_io_position *io_position; uint64_t info_all; struct spa_node_info info; #define IDX_EnumFormat 0 #define IDX_PropInfo 1 #define IDX_Props 2 #define IDX_Format 3 #define IDX_EnumPortConfig 4 #define IDX_PortConfig 5 #define IDX_Latency 6 #define IDX_ProcessLatency 7 #define N_NODE_PARAMS 8 struct spa_param_info params[N_NODE_PARAMS]; uint32_t convert_params_flags[N_NODE_PARAMS]; uint32_t follower_params_flags[N_NODE_PARAMS]; struct spa_hook_list hooks; struct spa_callbacks callbacks; unsigned int add_listener:1; unsigned int have_format:1; unsigned int started:1; unsigned int driver:1; unsigned int async:1; unsigned int passthrough:1; unsigned int follower_removing:1; }; /** \endcond */ static int follower_enum_params(struct impl *this, uint32_t id, uint32_t idx, struct spa_result_node_params *result, const struct spa_pod *filter, struct spa_pod_builder *builder) { int res; if (result->next < 0x100000) { if ((res = spa_node_enum_params_sync(this->convert, id, &result->next, filter, &result->param, builder)) == 1) return res; result->next = 0x100000; } if (result->next < 0x200000 && this->follower_params_flags[idx] & SPA_PARAM_INFO_READ) { result->next &= 0xfffff; if ((res = spa_node_enum_params_sync(this->follower, id, &result->next, filter, &result->param, builder)) == 1) { result->next |= 0x100000; return res; } result->next = 0x200000; } return 0; } static int convert_enum_port_config(struct impl *this, int seq, uint32_t id, uint32_t start, uint32_t num, const struct spa_pod *filter, struct spa_pod_builder *builder) { struct spa_pod *f1, *f2 = NULL; int res; f1 = spa_pod_builder_add_object(builder, SPA_TYPE_OBJECT_ParamPortConfig, id, SPA_PARAM_PORT_CONFIG_direction, SPA_POD_Id(this->direction)); if (filter) { if ((res = spa_pod_filter(builder, &f2, f1, filter)) < 0) return res; } else { f2 = f1; } return spa_node_enum_params(this->convert, seq, id, start, num, f2); } static int impl_node_enum_params(void *object, int seq, uint32_t id, uint32_t start, uint32_t num, const struct spa_pod *filter) { struct impl *this = object; uint8_t buffer[4096]; struct spa_pod_dynamic_builder b; struct spa_result_node_params result; uint32_t count = 0; int res; spa_return_val_if_fail(this != NULL, -EINVAL); spa_return_val_if_fail(num != 0, -EINVAL); result.id = id; result.next = start; next: result.index = result.next; spa_log_debug(this->log, "%p: %d id:%u", this, seq, id); spa_pod_dynamic_builder_init(&b, buffer, sizeof(buffer), 4096); switch (id) { case SPA_PARAM_EnumPortConfig: return convert_enum_port_config(this, seq, id, start, num, filter, &b.b); case SPA_PARAM_PortConfig: if (this->passthrough) { switch (result.index) { case 0: result.param = spa_pod_builder_add_object(&b.b, SPA_TYPE_OBJECT_ParamPortConfig, id, SPA_PARAM_PORT_CONFIG_direction, SPA_POD_Id(this->direction), SPA_PARAM_PORT_CONFIG_mode, SPA_POD_Id( SPA_PARAM_PORT_CONFIG_MODE_passthrough)); result.next++; break; default: return 0; } } else { return convert_enum_port_config(this, seq, id, start, num, filter, &b.b); } break; case SPA_PARAM_PropInfo: res = follower_enum_params(this, id, IDX_PropInfo, &result, filter, &b.b); break; case SPA_PARAM_Props: res = follower_enum_params(this, id, IDX_Props, &result, filter, &b.b); break; case SPA_PARAM_ProcessLatency: res = follower_enum_params(this, id, IDX_ProcessLatency, &result, filter, &b.b); break; case SPA_PARAM_EnumFormat: case SPA_PARAM_Format: case SPA_PARAM_Latency: res = spa_node_port_enum_params_sync(this->follower, this->direction, 0, id, &result.next, filter, &result.param, &b.b); break; default: return -ENOENT; } if (res == 1) { spa_node_emit_result(&this->hooks, seq, 0, SPA_RESULT_TYPE_NODE_PARAMS, &result); count++; } spa_pod_dynamic_builder_clean(&b); if (res != 1) return res; if (count != num) goto next; return 0; } static int link_io(struct impl *this) { int res; if (this->convert == NULL) return 0; spa_log_debug(this->log, "%p: controls", this); spa_zero(this->io_rate_match); this->io_rate_match.rate = 1.0; if ((res = spa_node_port_set_io(this->follower, this->direction, 0, SPA_IO_RateMatch, &this->io_rate_match, sizeof(this->io_rate_match))) < 0) { spa_log_debug(this->log, "%p: set RateMatch on follower disabled %d %s", this, res, spa_strerror(res)); } else if ((res = spa_node_port_set_io(this->convert, SPA_DIRECTION_REVERSE(this->direction), 0, SPA_IO_RateMatch, &this->io_rate_match, sizeof(this->io_rate_match))) < 0) { spa_log_warn(this->log, "%p: set RateMatch on convert failed %d %s", this, res, spa_strerror(res)); } this->io_buffers = SPA_IO_BUFFERS_INIT; if ((res = spa_node_port_set_io(this->follower, this->direction, 0, SPA_IO_Buffers, &this->io_buffers, sizeof(this->io_buffers))) < 0) { spa_log_warn(this->log, "%p: set Buffers on follower failed %d %s", this, res, spa_strerror(res)); return res; } else if ((res = spa_node_port_set_io(this->convert, SPA_DIRECTION_REVERSE(this->direction), 0, SPA_IO_Buffers, &this->io_buffers, sizeof(this->io_buffers))) < 0) { spa_log_warn(this->log, "%p: set Buffers on convert failed %d %s", this, res, spa_strerror(res)); return res; } return 0; } static void emit_node_info(struct impl *this, bool full) { uint32_t i; uint64_t old = full ? this->info.change_mask : 0; spa_log_debug(this->log, "%p: info full:%d change:%08"PRIx64, this, full, this->info.change_mask); if (full) this->info.change_mask = this->info_all; if (this->info.change_mask) { if (this->info.change_mask & SPA_NODE_CHANGE_MASK_PARAMS) { for (i = 0; i < this->info.n_params; i++) { if (this->params[i].user > 0) { this->params[i].flags ^= SPA_PARAM_INFO_SERIAL; this->params[i].user = 0; spa_log_debug(this->log, "param %d flags:%08x", i, this->params[i].flags); } } } spa_node_emit_info(&this->hooks, &this->info); this->info.change_mask = old; } } static int debug_params(struct impl *this, struct spa_node *node, enum spa_direction direction, uint32_t port_id, uint32_t id, struct spa_pod *filter, const char *debug, int err) { struct spa_pod_builder b = { 0 }; uint8_t buffer[4096]; uint32_t state; struct spa_pod *param; int res, count = 0; spa_log_error(this->log, "params %s: %d:%d (%s) %s", spa_debug_type_find_name(spa_type_param, id), direction, port_id, debug, err ? spa_strerror(err) : "no matching params"); if (err == -EBUSY) return 0; if (filter) { spa_log_error(this->log, "with this filter:"); spa_debug_log_pod(this->log, SPA_LOG_LEVEL_DEBUG, 2, NULL, filter); } else { spa_log_error(this->log, "there was no filter"); } state = 0; while (true) { spa_pod_builder_init(&b, buffer, sizeof(buffer)); res = spa_node_port_enum_params_sync(node, direction, port_id, id, &state, NULL, ¶m, &b); if (res != 1) { if (res < 0) spa_log_error(this->log, " error: %s", spa_strerror(res)); break; } spa_log_error(this->log, "unmatched %s %d:", debug, count); spa_debug_log_pod(this->log, SPA_LOG_LEVEL_DEBUG, 2, NULL, param); count++; } if (count == 0) spa_log_error(this->log, "could not get any %s", debug); return 0; } static int negotiate_buffers(struct impl *this) { uint8_t buffer[4096]; struct spa_pod_builder b = SPA_POD_BUILDER_INIT(buffer, sizeof(buffer)); uint32_t state; struct spa_pod *param; int res; bool follower_alloc, conv_alloc; uint32_t i, size, buffers, blocks, align, flags, stride = 0; uint32_t *aligns; struct spa_data *datas; uint32_t follower_flags, conv_flags; spa_log_debug(this->log, "%p: n_buffers:%d", this, this->n_buffers); if (this->target == this->follower) return 0; if (this->n_buffers > 0) return 0; state = 0; param = NULL; if ((res = spa_node_port_enum_params_sync(this->follower, this->direction, 0, SPA_PARAM_Buffers, &state, param, ¶m, &b)) < 0) { if (res == -ENOENT) param = NULL; else { debug_params(this, this->follower, this->direction, 0, SPA_PARAM_Buffers, param, "follower buffers", res); return res; } } state = 0; if ((res = spa_node_port_enum_params_sync(this->convert, SPA_DIRECTION_REVERSE(this->direction), 0, SPA_PARAM_Buffers, &state, param, ¶m, &b)) != 1) { debug_params(this, this->convert, SPA_DIRECTION_REVERSE(this->direction), 0, SPA_PARAM_Buffers, param, "convert buffers", res); return -ENOTSUP; } if (param == NULL) return -ENOTSUP; spa_pod_fixate(param); follower_flags = this->follower_flags; conv_flags = this->convert_flags; follower_alloc = SPA_FLAG_IS_SET(follower_flags, SPA_PORT_FLAG_CAN_ALLOC_BUFFERS); conv_alloc = SPA_FLAG_IS_SET(conv_flags, SPA_PORT_FLAG_CAN_ALLOC_BUFFERS); flags = 0; if (conv_alloc || follower_alloc) { flags |= SPA_BUFFER_ALLOC_FLAG_NO_DATA; if (conv_alloc) follower_alloc = false; } align = DEFAULT_ALIGN; if ((res = spa_pod_parse_object(param, SPA_TYPE_OBJECT_ParamBuffers, NULL, SPA_PARAM_BUFFERS_buffers, SPA_POD_Int(&buffers), SPA_PARAM_BUFFERS_blocks, SPA_POD_Int(&blocks), SPA_PARAM_BUFFERS_size, SPA_POD_Int(&size), SPA_PARAM_BUFFERS_stride, SPA_POD_Int(&stride), SPA_PARAM_BUFFERS_align, SPA_POD_OPT_Int(&align))) < 0) return res; spa_log_debug(this->log, "%p: buffers:%d, blocks:%d, size:%d, stride:%d align:%d %d:%d", this, buffers, blocks, size, stride, align, follower_alloc, conv_alloc); align = SPA_MAX(align, this->max_align); datas = alloca(sizeof(struct spa_data) * blocks); memset(datas, 0, sizeof(struct spa_data) * blocks); aligns = alloca(sizeof(uint32_t) * blocks); for (i = 0; i < blocks; i++) { datas[i].type = SPA_DATA_MemPtr; datas[i].flags = SPA_DATA_FLAG_READWRITE | SPA_DATA_FLAG_DYNAMIC; datas[i].maxsize = size; aligns[i] = align; } free(this->buffers); this->buffers = spa_buffer_alloc_array(buffers, flags, 0, NULL, blocks, datas, aligns); if (this->buffers == NULL) return -errno; this->n_buffers = buffers; if ((res = spa_node_port_use_buffers(this->convert, SPA_DIRECTION_REVERSE(this->direction), 0, conv_alloc ? SPA_NODE_BUFFERS_FLAG_ALLOC : 0, this->buffers, this->n_buffers)) < 0) return res; if ((res = spa_node_port_use_buffers(this->follower, this->direction, 0, follower_alloc ? SPA_NODE_BUFFERS_FLAG_ALLOC : 0, this->buffers, this->n_buffers)) < 0) return res; return 0; } static int configure_format(struct impl *this, uint32_t flags, const struct spa_pod *format) { uint8_t buffer[4096]; int res; if (format == NULL && !this->have_format) return 0; spa_log_debug(this->log, "%p: configure format:", this); if (format) spa_debug_log_format(this->log, SPA_LOG_LEVEL_DEBUG, 0, NULL, format); if ((res = spa_node_port_set_param(this->follower, this->direction, 0, SPA_PARAM_Format, flags, format)) < 0) return res; if (res > 0) { struct spa_pod_builder b = SPA_POD_BUILDER_INIT(buffer, sizeof(buffer)); uint32_t state = 0; struct spa_pod *fmt; /* format was changed to nearest compatible format */ if ((res = spa_node_port_enum_params_sync(this->follower, this->direction, 0, SPA_PARAM_Format, &state, NULL, &fmt, &b)) != 1) return -EIO; format = fmt; } if (this->target != this->follower && this->convert) { if ((res = spa_node_port_set_param(this->convert, SPA_DIRECTION_REVERSE(this->direction), 0, SPA_PARAM_Format, flags, format)) < 0) return res; } this->have_format = format != NULL; if (format == NULL) { this->n_buffers = 0; } else { res = negotiate_buffers(this); } return res; } static int configure_convert(struct impl *this, uint32_t mode) { struct spa_pod_builder b = { 0 }; uint8_t buffer[1024]; struct spa_pod *param; spa_pod_builder_init(&b, buffer, sizeof(buffer)); spa_log_debug(this->log, "%p: configure convert %p", this, this->target); param = spa_pod_builder_add_object(&b, SPA_TYPE_OBJECT_ParamPortConfig, SPA_PARAM_PortConfig, SPA_PARAM_PORT_CONFIG_direction, SPA_POD_Id(this->direction), SPA_PARAM_PORT_CONFIG_mode, SPA_POD_Id(mode)); return spa_node_set_param(this->convert, SPA_PARAM_PortConfig, 0, param); } extern const struct spa_handle_factory spa_audioconvert_factory; static const struct spa_node_events follower_node_events; static int reconfigure_mode(struct impl *this, bool passthrough, enum spa_direction direction, struct spa_pod *format) { int res = 0; struct spa_hook l; spa_log_info(this->log, "%p: passthrough mode %d", this, passthrough); if (this->passthrough != passthrough) { if (passthrough) { /* remove converter split/merge ports */ configure_convert(this, SPA_PARAM_PORT_CONFIG_MODE_none); } else { /* remove follower ports */ this->follower_removing = true; spa_zero(l); spa_node_add_listener(this->follower, &l, &follower_node_events, this); spa_hook_remove(&l); this->follower_removing = false; } } /* set new target */ this->target = passthrough ? this->follower : this->convert; if ((res = configure_format(this, SPA_NODE_PARAM_FLAG_NEAREST, format)) < 0) return res; if (this->passthrough != passthrough) { this->passthrough = passthrough; if (passthrough) { /* add follower ports */ spa_zero(l); spa_node_add_listener(this->follower, &l, &follower_node_events, this); spa_hook_remove(&l); } else { /* add converter ports */ configure_convert(this, SPA_PARAM_PORT_CONFIG_MODE_dsp); link_io(this); } } this->info.change_mask |= SPA_NODE_CHANGE_MASK_FLAGS | SPA_NODE_CHANGE_MASK_PARAMS; this->info.flags &= ~SPA_NODE_FLAG_NEED_CONFIGURE; this->params[IDX_Props].user++; emit_node_info(this, false); return 0; } static int impl_node_set_param(void *object, uint32_t id, uint32_t flags, const struct spa_pod *param) { int res = 0, res2 = 0; struct impl *this = object; struct spa_audio_info info = { 0 }; spa_log_debug(this->log, "%p: set param %d", this, id); switch (id) { case SPA_PARAM_Format: if (this->started) return -EIO; if (param == NULL) return -EINVAL; if ((res = spa_format_parse(param, &info.media_type, &info.media_subtype)) < 0) return res; if (info.media_type != SPA_MEDIA_TYPE_audio || info.media_subtype != SPA_MEDIA_SUBTYPE_raw) return -EINVAL; if (spa_format_audio_raw_parse(param, &info.info.raw) < 0) return -EINVAL; this->follower_current_format = info; break; case SPA_PARAM_PortConfig: { enum spa_direction dir; enum spa_param_port_config_mode mode; struct spa_pod *format = NULL; if (this->started) { spa_log_error(this->log, "was started"); return -EIO; } if (spa_pod_parse_object(param, SPA_TYPE_OBJECT_ParamPortConfig, NULL, SPA_PARAM_PORT_CONFIG_direction, SPA_POD_Id(&dir), SPA_PARAM_PORT_CONFIG_mode, SPA_POD_Id(&mode), SPA_PARAM_PORT_CONFIG_format, SPA_POD_OPT_Pod(&format)) < 0) return -EINVAL; if (format) { struct spa_audio_info info; spa_zero(info); if ((res = spa_format_parse(format, &info.media_type, &info.media_subtype)) < 0) return res; if (info.media_type != SPA_MEDIA_TYPE_audio || info.media_subtype != SPA_MEDIA_SUBTYPE_raw) return -ENOTSUP; if (spa_format_audio_raw_parse(format, &info.info.raw) >= 0) { info.info.raw.rate = 0; this->default_format = info; } } switch (mode) { case SPA_PARAM_PORT_CONFIG_MODE_none: return -ENOTSUP; case SPA_PARAM_PORT_CONFIG_MODE_passthrough: if ((res = reconfigure_mode(this, true, dir, format)) < 0) return res; break; case SPA_PARAM_PORT_CONFIG_MODE_convert: case SPA_PARAM_PORT_CONFIG_MODE_dsp: if ((res = reconfigure_mode(this, false, dir, NULL)) < 0) return res; break; default: return -EINVAL; } if (this->target != this->follower) { if ((res = spa_node_set_param(this->target, id, flags, param)) < 0) return res; } break; } case SPA_PARAM_Props: if (this->target != this->follower) res = spa_node_set_param(this->target, id, flags, param); res2 = spa_node_set_param(this->follower, id, flags, param); if (res < 0 && res2 < 0) return res; res = 0; break; case SPA_PARAM_ProcessLatency: res = spa_node_set_param(this->follower, id, flags, param); break; default: res = -ENOTSUP; break; } return res; } static int impl_node_set_io(void *object, uint32_t id, void *data, size_t size) { struct impl *this = object; int res = 0; spa_return_val_if_fail(this != NULL, -EINVAL); switch (id) { case SPA_IO_Position: this->io_position = data; break; default: break; } if (this->target) res = spa_node_set_io(this->target, id, data, size); if (this->target != this->follower) res = spa_node_set_io(this->follower, id, data, size); return res; } static struct spa_pod *merge_objects(struct impl *this, struct spa_pod_builder *b, uint32_t id, struct spa_pod_object *o1, struct spa_pod_object *o2) { const struct spa_pod_prop *p1, *p2; struct spa_pod_frame f; struct spa_pod_builder_state state; int res = 0; if (o2 == NULL || SPA_POD_TYPE(o1) != SPA_POD_TYPE(o2)) return (struct spa_pod*)o1; spa_pod_builder_push_object(b, &f, o1->body.type, o1->body.id); p2 = NULL; SPA_POD_OBJECT_FOREACH(o1, p1) { p2 = spa_pod_object_find_prop(o2, p2, p1->key); if (p2 != NULL) { spa_pod_builder_get_state(b, &state); res = spa_pod_filter_prop(b, p1, p2); if (res < 0) spa_pod_builder_reset(b, &state); } if (p2 == NULL || res < 0) spa_pod_builder_raw_padded(b, p1, SPA_POD_PROP_SIZE(p1)); } p1 = NULL; SPA_POD_OBJECT_FOREACH(o2, p2) { p1 = spa_pod_object_find_prop(o1, p1, p2->key); if (p1 != NULL) continue; spa_pod_builder_raw_padded(b, p2, SPA_POD_PROP_SIZE(p2)); } return spa_pod_builder_pop(b, &f); } static int negotiate_format(struct impl *this) { uint32_t state; struct spa_pod *format, *def; uint8_t buffer[4096]; struct spa_pod_builder b = { 0 }; int res; spa_log_debug(this->log, "%p: have_format:%d", this, this->have_format); if (this->have_format) return 0; if (this->target == this->follower) return 0; spa_pod_builder_init(&b, buffer, sizeof(buffer)); spa_node_send_command(this->follower, &SPA_NODE_COMMAND_INIT(SPA_NODE_COMMAND_ParamBegin)); state = 0; format = NULL; if ((res = spa_node_port_enum_params_sync(this->follower, this->direction, 0, SPA_PARAM_EnumFormat, &state, format, &format, &b)) < 0) { if (res == -ENOENT) format = NULL; else { debug_params(this, this->follower, this->direction, 0, SPA_PARAM_EnumFormat, format, "follower format", res); goto done; } } if (this->convert) { state = 0; if ((res = spa_node_port_enum_params_sync(this->convert, SPA_DIRECTION_REVERSE(this->direction), 0, SPA_PARAM_EnumFormat, &state, format, &format, &b)) != 1) { debug_params(this, this->convert, SPA_DIRECTION_REVERSE(this->direction), 0, SPA_PARAM_EnumFormat, format, "convert format", res); res = -ENOTSUP; goto done; } } if (format == NULL) { res = -ENOTSUP; goto done; } def = spa_format_audio_raw_build(&b, SPA_PARAM_Format, &this->default_format.info.raw); format = merge_objects(this, &b, SPA_PARAM_Format, (struct spa_pod_object*)format, (struct spa_pod_object*)def); spa_pod_fixate(format); res = configure_format(this, SPA_NODE_PARAM_FLAG_NEAREST, format); done: spa_node_send_command(this->follower, &SPA_NODE_COMMAND_INIT(SPA_NODE_COMMAND_ParamEnd)); return res; } static int impl_node_send_command(void *object, const struct spa_command *command) { struct impl *this = object; int res; spa_return_val_if_fail(this != NULL, -EINVAL); spa_log_debug(this->log, "%p: command %d", this, SPA_NODE_COMMAND_ID(command)); switch (SPA_NODE_COMMAND_ID(command)) { case SPA_NODE_COMMAND_Start: spa_log_debug(this->log, "%p: starting %d", this, this->started); if (this->started) return 0; if ((res = negotiate_format(this)) < 0) return res; if ((res = negotiate_buffers(this)) < 0) return res; this->started = true; break; case SPA_NODE_COMMAND_Suspend: this->started = false; spa_log_debug(this->log, "%p: suspending", this); break; case SPA_NODE_COMMAND_Pause: this->started = false; spa_log_debug(this->log, "%p: pausing", this); break; case SPA_NODE_COMMAND_Flush: spa_log_debug(this->log, "%p: flushing", this); this->io_buffers.status = SPA_STATUS_OK; break; default: break; } if ((res = spa_node_send_command(this->target, command)) < 0) { spa_log_error(this->log, "%p: can't send command %d: %s", this, SPA_NODE_COMMAND_ID(command), spa_strerror(res)); return res; } if (this->target != this->follower) { if ((res = spa_node_send_command(this->follower, command)) < 0) { spa_log_error(this->log, "%p: can't send command %d: %s", this, SPA_NODE_COMMAND_ID(command), spa_strerror(res)); return res; } } switch (SPA_NODE_COMMAND_ID(command)) { case SPA_NODE_COMMAND_Start: spa_log_debug(this->log, "%p: started", this); break; case SPA_NODE_COMMAND_Suspend: configure_format(this, 0, NULL); spa_log_debug(this->log, "%p: suspended", this); break; case SPA_NODE_COMMAND_Pause: spa_log_debug(this->log, "%p: paused", this); break; case SPA_NODE_COMMAND_Flush: spa_log_debug(this->log, "%p: flushed", this); break; } return res; } static void convert_node_info(void *data, const struct spa_node_info *info) { struct impl *this = data; uint32_t i; spa_log_debug(this->log, "%p: info change:%08"PRIx64, this, info->change_mask); if (info->change_mask & SPA_NODE_CHANGE_MASK_PARAMS) { for (i = 0; i < info->n_params; i++) { uint32_t idx; switch (info->params[i].id) { case SPA_PARAM_EnumPortConfig: idx = IDX_EnumPortConfig; break; case SPA_PARAM_PortConfig: idx = IDX_PortConfig; break; case SPA_PARAM_PropInfo: idx = IDX_PropInfo; break; case SPA_PARAM_Props: idx = IDX_Props; break; default: continue; } if (!this->add_listener && this->convert_params_flags[idx] == info->params[i].flags) continue; this->info.change_mask |= SPA_NODE_CHANGE_MASK_PARAMS; this->convert_params_flags[idx] = info->params[i].flags; this->params[idx].flags = (this->params[idx].flags & SPA_PARAM_INFO_SERIAL) | (info->params[i].flags & SPA_PARAM_INFO_READWRITE); if (this->add_listener) continue; this->params[idx].user++; spa_log_debug(this->log, "param %d changed", info->params[i].id); } } emit_node_info(this, false); } static void convert_port_info(void *data, enum spa_direction direction, uint32_t port_id, const struct spa_port_info *info) { struct impl *this = data; if (direction != this->direction) { if (port_id == 0) return; else port_id--; } spa_log_debug(this->log, "%p: port info %d:%d", this, direction, port_id); if (this->target != this->follower) spa_node_emit_port_info(&this->hooks, direction, port_id, info); } static void convert_result(void *data, int seq, int res, uint32_t type, const void *result) { struct impl *this = data; if (this->target == this->follower) return; spa_log_trace(this->log, "%p: result %d %d", this, seq, res); spa_node_emit_result(&this->hooks, seq, res, type, result); } static const struct spa_node_events convert_node_events = { SPA_VERSION_NODE_EVENTS, .info = convert_node_info, .port_info = convert_port_info, .result = convert_result, }; static void follower_info(void *data, const struct spa_node_info *info) { struct impl *this = data; uint32_t i; spa_log_debug(this->log, "%p: info change:%08"PRIx64, this, info->change_mask); if (this->follower_removing) return; this->async = (info->flags & SPA_NODE_FLAG_ASYNC) != 0; if (info->max_input_ports > 0) this->direction = SPA_DIRECTION_INPUT; else this->direction = SPA_DIRECTION_OUTPUT; if (this->direction == SPA_DIRECTION_INPUT) { this->info.flags |= SPA_NODE_FLAG_IN_PORT_CONFIG; this->info.max_input_ports = MAX_PORTS; } else { this->info.flags |= SPA_NODE_FLAG_OUT_PORT_CONFIG; this->info.max_output_ports = MAX_PORTS; } spa_log_debug(this->log, "%p: follower info %s", this, this->direction == SPA_DIRECTION_INPUT ? "Input" : "Output"); if (info->change_mask & SPA_NODE_CHANGE_MASK_PROPS) { this->info.change_mask |= SPA_NODE_CHANGE_MASK_PROPS; this->info.props = info->props; } if (info->change_mask & SPA_NODE_CHANGE_MASK_PARAMS) { for (i = 0; i < info->n_params; i++) { uint32_t idx; switch (info->params[i].id) { case SPA_PARAM_PropInfo: idx = IDX_PropInfo; break; case SPA_PARAM_Props: idx = IDX_Props; break; case SPA_PARAM_ProcessLatency: idx = IDX_ProcessLatency; break; default: continue; } if (!this->add_listener && this->follower_params_flags[idx] == info->params[i].flags) continue; this->info.change_mask |= SPA_NODE_CHANGE_MASK_PARAMS; this->follower_params_flags[idx] = info->params[i].flags; this->params[idx].flags = (this->params[idx].flags & SPA_PARAM_INFO_SERIAL) | (info->params[i].flags & SPA_PARAM_INFO_READWRITE); if (this->add_listener) continue; this->params[idx].user++; spa_log_debug(this->log, "param %d changed", info->params[i].id); } } emit_node_info(this, false); spa_zero(this->info.props); this->info.change_mask &= ~SPA_NODE_CHANGE_MASK_PROPS; } static int recalc_latency(struct impl *this, enum spa_direction direction, uint32_t port_id) { struct spa_pod_builder b = { 0 }; uint8_t buffer[1024]; struct spa_pod *param; uint32_t index = 0; struct spa_latency_info latency; int res; spa_log_debug(this->log, "%p: ", this); if (this->target == this->follower) return 0; while (true) { spa_pod_builder_init(&b, buffer, sizeof(buffer)); if ((res = spa_node_port_enum_params_sync(this->follower, direction, port_id, SPA_PARAM_Latency, &index, NULL, ¶m, &b)) != 1) return res; if ((res = spa_latency_parse(param, &latency)) < 0) return res; if (latency.direction == direction) break; } if ((res = spa_node_port_set_param(this->target, SPA_DIRECTION_REVERSE(direction), 0, SPA_PARAM_Latency, 0, param)) < 0) return res; return 0; } static void follower_port_info(void *data, enum spa_direction direction, uint32_t port_id, const struct spa_port_info *info) { struct impl *this = data; uint32_t i; int res; if (this->follower_removing) { spa_node_emit_port_info(&this->hooks, direction, port_id, NULL); return; } spa_log_debug(this->log, "%p: follower port info %s %p %08"PRIx64, this, this->direction == SPA_DIRECTION_INPUT ? "Input" : "Output", info, info->change_mask); if (info->change_mask & SPA_PORT_CHANGE_MASK_PARAMS) { for (i = 0; i < info->n_params; i++) { uint32_t idx; switch (info->params[i].id) { case SPA_PARAM_EnumFormat: idx = IDX_EnumFormat; break; case SPA_PARAM_Format: idx = IDX_Format; break; case SPA_PARAM_Latency: idx = IDX_Latency; break; default: continue; } if (!this->add_listener && this->follower_params_flags[idx] == info->params[i].flags) continue; this->info.change_mask |= SPA_NODE_CHANGE_MASK_PARAMS; this->follower_params_flags[idx] = info->params[i].flags; this->params[idx].flags = (this->params[idx].flags & SPA_PARAM_INFO_SERIAL) | (info->params[i].flags & SPA_PARAM_INFO_READWRITE); if (this->add_listener) continue; if (idx == IDX_Latency) { res = recalc_latency(this, direction, port_id); spa_log_debug(this->log, "latency: %d (%s)", res, spa_strerror(res)); } if (idx == IDX_EnumFormat) { spa_log_debug(this->log, "new formats"); configure_format(this, 0, NULL); } this->params[idx].user++; spa_log_debug(this->log, "param %d changed", info->params[i].id); } } emit_node_info(this, false); if (this->target == this->follower) spa_node_emit_port_info(&this->hooks, direction, port_id, info); } static void follower_result(void *data, int seq, int res, uint32_t type, const void *result) { struct impl *this = data; if (this->target != this->follower) return; spa_log_trace(this->log, "%p: result %d %d", this, seq, res); spa_node_emit_result(&this->hooks, seq, res, type, result); } static void follower_event(void *data, const struct spa_event *event) { struct impl *this = data; spa_log_trace(this->log, "%p: event %d", this, SPA_EVENT_TYPE(event)); switch (SPA_NODE_EVENT_ID(event)) { case SPA_NODE_EVENT_Error: /* Forward errors */ spa_node_emit_event(&this->hooks, event); break; default: /* Ignore other events */ break; } } static const struct spa_node_events follower_node_events = { SPA_VERSION_NODE_EVENTS, .info = follower_info, .port_info = follower_port_info, .result = follower_result, .event = follower_event, }; static int follower_ready(void *data, int status) { struct impl *this = data; spa_log_trace_fp(this->log, "%p: ready %d", this, status); if (!this->started) { spa_log_info(this->log, "%p: ready stopped node", this); return -EIO; } if (this->target != this->follower) { this->driver = true; if (this->direction == SPA_DIRECTION_OUTPUT) { int retry = 8; while (retry--) { status = spa_node_process(this->convert); if (status & SPA_STATUS_HAVE_DATA) break; if (status & SPA_STATUS_NEED_DATA) { status = spa_node_process(this->follower); if (!(status & SPA_STATUS_HAVE_DATA)) break; } } } } return spa_node_call_ready(&this->callbacks, status); } static int follower_reuse_buffer(void *data, uint32_t port_id, uint32_t buffer_id) { int res; struct impl *this = data; if (this->target != this->follower && this->convert) res = spa_node_port_reuse_buffer(this->convert, port_id, buffer_id); else res = spa_node_call_reuse_buffer(&this->callbacks, port_id, buffer_id); return res; } static int follower_xrun(void *data, uint64_t trigger, uint64_t delay, struct spa_pod *info) { struct impl *this = data; return spa_node_call_xrun(&this->callbacks, trigger, delay, info); } static const struct spa_node_callbacks follower_node_callbacks = { SPA_VERSION_NODE_CALLBACKS, .ready = follower_ready, .reuse_buffer = follower_reuse_buffer, .xrun = follower_xrun, }; static int impl_node_add_listener(void *object, struct spa_hook *listener, const struct spa_node_events *events, void *data) { struct impl *this = object; struct spa_hook l; struct spa_hook_list save; spa_return_val_if_fail(this != NULL, -EINVAL); spa_log_trace(this->log, "%p: add listener %p", this, listener); spa_hook_list_isolate(&this->hooks, &save, listener, events, data); if (events->info || events->port_info) { this->add_listener = true; spa_zero(l); spa_node_add_listener(this->follower, &l, &follower_node_events, this); spa_hook_remove(&l); if (this->convert) { spa_zero(l); spa_node_add_listener(this->convert, &l, &convert_node_events, this); spa_hook_remove(&l); } this->add_listener = false; emit_node_info(this, true); } spa_hook_list_join(&this->hooks, &save); return 0; } static int impl_node_set_callbacks(void *object, const struct spa_node_callbacks *callbacks, void *data) { struct impl *this = object; spa_return_val_if_fail(this != NULL, -EINVAL); this->callbacks = SPA_CALLBACKS_INIT(callbacks, data); return 0; } static int impl_node_sync(void *object, int seq) { struct impl *this = object; spa_return_val_if_fail(this != NULL, -EINVAL); return spa_node_sync(this->follower, seq); } static int impl_node_add_port(void *object, enum spa_direction direction, uint32_t port_id, const struct spa_dict *props) { struct impl *this = object; spa_return_val_if_fail(this != NULL, -EINVAL); if (direction != this->direction) return -EINVAL; return spa_node_add_port(this->target, direction, port_id, props); } static int impl_node_remove_port(void *object, enum spa_direction direction, uint32_t port_id) { struct impl *this = object; spa_return_val_if_fail(this != NULL, -EINVAL); if (direction != this->direction) return -EINVAL; return spa_node_remove_port(this->target, direction, port_id); } static int impl_node_port_enum_params(void *object, int seq, enum spa_direction direction, uint32_t port_id, uint32_t id, uint32_t start, uint32_t num, const struct spa_pod *filter) { struct impl *this = object; spa_return_val_if_fail(this != NULL, -EINVAL); spa_return_val_if_fail(num != 0, -EINVAL); if (direction != this->direction) port_id++; spa_log_debug(this->log, "%p: %d %u", this, seq, id); return spa_node_port_enum_params(this->target, seq, direction, port_id, id, start, num, filter); } static int impl_node_port_set_param(void *object, enum spa_direction direction, uint32_t port_id, uint32_t id, uint32_t flags, const struct spa_pod *param) { struct impl *this = object; int res; spa_return_val_if_fail(this != NULL, -EINVAL); spa_log_debug(this->log, " %d %d %d %d", port_id, id, direction, this->direction); if (direction != this->direction) port_id++; if ((res = spa_node_port_set_param(this->target, direction, port_id, id, flags, param)) < 0) return res; if ((id == SPA_PARAM_Latency) && direction == this->direction) { if ((res = spa_node_port_set_param(this->follower, direction, 0, id, flags, param)) < 0) return res; } return res; } static int impl_node_port_set_io(void *object, enum spa_direction direction, uint32_t port_id, uint32_t id, void *data, size_t size) { struct impl *this = object; spa_return_val_if_fail(this != NULL, -EINVAL); spa_log_debug(this->log, "set io %d %d %d %d", port_id, id, direction, this->direction); if (direction != this->direction) port_id++; return spa_node_port_set_io(this->target, direction, port_id, id, data, size); } static int impl_node_port_use_buffers(void *object, enum spa_direction direction, uint32_t port_id, uint32_t flags, struct spa_buffer **buffers, uint32_t n_buffers) { struct impl *this = object; int res; spa_return_val_if_fail(this != NULL, -EINVAL); if (direction != this->direction) port_id++; spa_log_debug(this->log, "%p: %d %d:%d", this, n_buffers, direction, port_id); if ((res = spa_node_port_use_buffers(this->target, direction, port_id, flags, buffers, n_buffers)) < 0) return res; return res; } static int impl_node_port_reuse_buffer(void *object, uint32_t port_id, uint32_t buffer_id) { struct impl *this = object; spa_return_val_if_fail(this != NULL, -EINVAL); return spa_node_port_reuse_buffer(this->target, port_id, buffer_id); } static int impl_node_process(void *object) { struct impl *this = object; int status = 0, fstatus, retry = 8; if (!this->started) { spa_log_warn(this->log, "%p: scheduling stopped node", this); return -EIO; } spa_log_trace_fp(this->log, "%p: process convert:%p driver:%d", this, this->convert, this->driver); if (this->target == this->follower) { if (this->io_position) this->io_rate_match.size = this->io_position->clock.duration; return spa_node_process(this->follower); } if (this->direction == SPA_DIRECTION_INPUT) { /* an input node (sink). * First we run the converter to process the input for the follower * then if it produced data, we run the follower. */ while (retry--) { status = this->convert ? spa_node_process(this->convert) : 0; /* schedule the follower when the converter needed * a recycled buffer */ if (status == -EPIPE || status == 0) status = SPA_STATUS_HAVE_DATA; else if (status < 0) break; if (status & (SPA_STATUS_HAVE_DATA | SPA_STATUS_DRAINED)) { /* as long as the converter produced something or * is drained, process the follower. */ fstatus = spa_node_process(this->follower); if (fstatus < 0) { status = fstatus; break; } /* if the follower doesn't need more data or is * drained we can stop */ if ((fstatus & SPA_STATUS_NEED_DATA) == 0 || (fstatus & SPA_STATUS_DRAINED)) break; } /* the converter needs more data */ if ((status & SPA_STATUS_NEED_DATA)) break; } } else if (!this->driver) { bool done = false; while (retry--) { /* output node (source). First run the converter to make * sure we push out any queued data. Then when it needs * more data, schedule the follower. */ status = this->convert ? spa_node_process(this->convert) : 0; if (status == 0) status = SPA_STATUS_NEED_DATA; else if (status < 0) break; done = (status & (SPA_STATUS_HAVE_DATA | SPA_STATUS_DRAINED)); /* when not async, we can return the data when we are done. * In async mode we might first need to wake up the follower * to asynchronously provide more data for the next round. */ if (!this->async && done) break; if (status & SPA_STATUS_NEED_DATA) { /* the converter needs more data, schedule the * follower */ fstatus = spa_node_process(this->follower); if (fstatus < 0) { status = fstatus; break; } /* if the follower didn't produce more data or is * not drained we can stop now */ if ((fstatus & (SPA_STATUS_HAVE_DATA | SPA_STATUS_DRAINED)) == 0) break; } /* converter produced something or is drained and we * scheduled the follower above, we can stop now*/ if (done) break; } if (!done) spa_node_call_xrun(&this->callbacks, 0, 0, NULL); } else { status = spa_node_process(this->follower); } spa_log_trace_fp(this->log, "%p: process status:%d", this, status); this->driver = false; return status; } static const struct spa_node_methods impl_node = { SPA_VERSION_NODE_METHODS, .add_listener = impl_node_add_listener, .set_callbacks = impl_node_set_callbacks, .sync = impl_node_sync, .enum_params = impl_node_enum_params, .set_param = impl_node_set_param, .set_io = impl_node_set_io, .send_command = impl_node_send_command, .add_port = impl_node_add_port, .remove_port = impl_node_remove_port, .port_enum_params = impl_node_port_enum_params, .port_set_param = impl_node_port_set_param, .port_use_buffers = impl_node_port_use_buffers, .port_set_io = impl_node_port_set_io, .port_reuse_buffer = impl_node_port_reuse_buffer, .process = impl_node_process, }; static int impl_get_interface(struct spa_handle *handle, const char *type, void **interface) { struct impl *this; spa_return_val_if_fail(handle != NULL, -EINVAL); spa_return_val_if_fail(interface != NULL, -EINVAL); this = (struct impl *) handle; if (spa_streq(type, SPA_TYPE_INTERFACE_Node)) *interface = &this->node; else return -ENOENT; return 0; } static int impl_clear(struct spa_handle *handle) { struct impl *this; spa_return_val_if_fail(handle != NULL, -EINVAL); this = (struct impl *) handle; spa_hook_remove(&this->follower_listener); spa_node_set_callbacks(this->follower, NULL, NULL); spa_handle_clear(this->hnd_convert); if (this->buffers) free(this->buffers); this->buffers = NULL; return 0; } static size_t impl_get_size(const struct spa_handle_factory *factory, const struct spa_dict *params) { size_t size; size = spa_handle_factory_get_size(&spa_audioconvert_factory, params); size += sizeof(struct impl); return size; } static int impl_init(const struct spa_handle_factory *factory, struct spa_handle *handle, const struct spa_dict *info, const struct spa_support *support, uint32_t n_support) { struct impl *this; void *iface; const char *str; spa_return_val_if_fail(factory != NULL, -EINVAL); spa_return_val_if_fail(handle != NULL, -EINVAL); handle->get_interface = impl_get_interface; handle->clear = impl_clear; this = (struct impl *) handle; this->log = spa_support_find(support, n_support, SPA_TYPE_INTERFACE_Log); spa_log_topic_init(this->log, log_topic); this->cpu = spa_support_find(support, n_support, SPA_TYPE_INTERFACE_CPU); if (info == NULL || (str = spa_dict_lookup(info, "audio.adapt.follower")) == NULL) return -EINVAL; sscanf(str, "pointer:%p", &this->follower); if (this->follower == NULL) return -EINVAL; if (this->cpu) this->max_align = spa_cpu_get_max_align(this->cpu); spa_hook_list_init(&this->hooks); this->node.iface = SPA_INTERFACE_INIT( SPA_TYPE_INTERFACE_Node, SPA_VERSION_NODE, &impl_node, this); this->hnd_convert = SPA_PTROFF(this, sizeof(struct impl), struct spa_handle); spa_handle_factory_init(&spa_audioconvert_factory, this->hnd_convert, info, support, n_support); spa_handle_get_interface(this->hnd_convert, SPA_TYPE_INTERFACE_Node, &iface); this->convert = iface; this->target = this->convert; this->info_all = SPA_NODE_CHANGE_MASK_FLAGS | SPA_NODE_CHANGE_MASK_PARAMS; this->info = SPA_NODE_INFO_INIT(); this->info.flags = SPA_NODE_FLAG_RT | SPA_NODE_FLAG_NEED_CONFIGURE; this->params[IDX_EnumFormat] = SPA_PARAM_INFO(SPA_PARAM_EnumFormat, SPA_PARAM_INFO_READ); this->params[IDX_PropInfo] = SPA_PARAM_INFO(SPA_PARAM_PropInfo, SPA_PARAM_INFO_READ); this->params[IDX_Props] = SPA_PARAM_INFO(SPA_PARAM_Props, SPA_PARAM_INFO_READWRITE); this->params[IDX_Format] = SPA_PARAM_INFO(SPA_PARAM_Format, SPA_PARAM_INFO_WRITE); this->params[IDX_EnumPortConfig] = SPA_PARAM_INFO(SPA_PARAM_EnumPortConfig, SPA_PARAM_INFO_READ); this->params[IDX_PortConfig] = SPA_PARAM_INFO(SPA_PARAM_PortConfig, SPA_PARAM_INFO_READWRITE); this->params[IDX_Latency] = SPA_PARAM_INFO(SPA_PARAM_Latency, SPA_PARAM_INFO_READWRITE); this->params[IDX_ProcessLatency] = SPA_PARAM_INFO(SPA_PARAM_ProcessLatency, SPA_PARAM_INFO_READWRITE); this->info.params = this->params; this->info.n_params = N_NODE_PARAMS; spa_node_add_listener(this->follower, &this->follower_listener, &follower_node_events, this); spa_node_set_callbacks(this->follower, &follower_node_callbacks, this); spa_node_add_listener(this->convert, &this->convert_listener, &convert_node_events, this); configure_convert(this, SPA_PARAM_PORT_CONFIG_MODE_dsp); link_io(this); return 0; } static const struct spa_interface_info impl_interfaces[] = { { SPA_TYPE_INTERFACE_Node, }, }; static int impl_enum_interface_info(const struct spa_handle_factory *factory, const struct spa_interface_info **info, uint32_t *index) { spa_return_val_if_fail(factory != NULL, -EINVAL); spa_return_val_if_fail(info != NULL, -EINVAL); spa_return_val_if_fail(index != NULL, -EINVAL); switch (*index) { case 0: *info = &impl_interfaces[*index]; break; default: return 0; } (*index)++; return 1; } const struct spa_handle_factory spa_audioadapter_factory = { .version = SPA_VERSION_HANDLE_FACTORY, .name = SPA_NAME_AUDIO_ADAPT, .get_size = impl_get_size, .init = impl_init, .enum_interface_info = impl_enum_interface_info, };