/* Spa * Copyright (C) 2016 Wim Taymans * * This library is free software; you can redistribute it and/or * modify it under the terms of the GNU Library General Public * License as published by the Free Software Foundation; either * version 2 of the License, or (at your option) any later version. * * This library is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * Library General Public License for more details. * * You should have received a copy of the GNU Library General Public * License along with this library; if not, write to the * Free Software Foundation, Inc., 51 Franklin St, Fifth Floor, * Boston, MA 02110-1301, USA. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include "mix-ops.h" #define NAME "audiomixer" #define MAX_BUFFERS 64 #define MAX_PORTS 128 #define PORT_DEFAULT_VOLUME 1.0 #define PORT_DEFAULT_MUTE false struct port_props { double volume; int32_t mute; }; static void port_props_reset(struct port_props *props) { props->volume = PORT_DEFAULT_VOLUME; props->mute = PORT_DEFAULT_MUTE; } struct buffer { struct spa_list link; bool outstanding; struct spa_buffer *outbuf; struct spa_meta_header *h; }; struct port { bool valid; uint32_t id; struct port_props props; struct spa_io_buffers *io; struct spa_io_control_range *io_range; double *io_volume; int32_t *io_mute; struct spa_port_info info; bool have_format; struct buffer buffers[MAX_BUFFERS]; uint32_t n_buffers; struct spa_list queue; size_t queued_bytes; }; struct type { uint32_t node; uint32_t format; uint32_t prop_volume; uint32_t prop_mute; uint32_t io_prop_volume; uint32_t io_prop_mute; struct spa_type_io io; struct spa_type_param param; struct spa_type_media_type media_type; struct spa_type_media_subtype media_subtype; struct spa_type_format_audio format_audio; struct spa_type_audio_format audio_format; struct spa_type_command_node command_node; struct spa_type_meta meta; struct spa_type_data data; struct spa_type_param_buffers param_buffers; struct spa_type_param_meta param_meta; struct spa_type_param_io param_io; }; static inline void init_type(struct type *type, struct spa_type_map *map) { type->node = spa_type_map_get_id(map, SPA_TYPE__Node); type->format = spa_type_map_get_id(map, SPA_TYPE__Format); type->prop_volume = spa_type_map_get_id(map, SPA_TYPE_PROPS__volume); type->prop_mute = spa_type_map_get_id(map, SPA_TYPE_PROPS__mute); type->io_prop_volume = spa_type_map_get_id(map, SPA_TYPE_IO_PROP_BASE "volume"); type->io_prop_mute = spa_type_map_get_id(map, SPA_TYPE_IO_PROP_BASE "mute"); spa_type_io_map(map, &type->io); spa_type_param_map(map, &type->param); spa_type_media_type_map(map, &type->media_type); spa_type_media_subtype_map(map, &type->media_subtype); spa_type_format_audio_map(map, &type->format_audio); spa_type_audio_format_map(map, &type->audio_format); spa_type_command_node_map(map, &type->command_node); spa_type_meta_map(map, &type->meta); spa_type_data_map(map, &type->data); spa_type_param_buffers_map(map, &type->param_buffers); spa_type_param_meta_map(map, &type->param_meta); spa_type_param_io_map(map, &type->param_io); } struct impl { struct spa_handle handle; struct spa_node node; struct type type; struct spa_type_map *map; struct spa_log *log; struct spa_audiomixer_ops ops; const struct spa_node_callbacks *callbacks; void *user_data; int port_count; int last_port; struct port in_ports[MAX_PORTS]; struct port out_ports[1]; bool have_format; int n_formats; struct spa_audio_info format; uint32_t bpf; mix_clear_func_t clear; mix_func_t copy; mix_func_t add; mix_scale_func_t copy_scale; mix_scale_func_t add_scale; bool started; }; #define CHECK_FREE_IN_PORT(this,d,p) ((d) == SPA_DIRECTION_INPUT && (p) < MAX_PORTS && !this->in_ports[(p)].valid) #define CHECK_IN_PORT(this,d,p) ((d) == SPA_DIRECTION_INPUT && (p) < MAX_PORTS && this->in_ports[(p)].valid) #define CHECK_OUT_PORT(this,d,p) ((d) == SPA_DIRECTION_OUTPUT && (p) == 0) #define CHECK_PORT(this,d,p) (CHECK_OUT_PORT(this,d,p) || CHECK_IN_PORT (this,d,p)) #define GET_IN_PORT(this,p) (&this->in_ports[p]) #define GET_OUT_PORT(this,p) (&this->out_ports[p]) #define GET_PORT(this,d,p) (d == SPA_DIRECTION_INPUT ? GET_IN_PORT(this,p) : GET_OUT_PORT(this,p)) static int impl_node_enum_params(struct spa_node *node, uint32_t id, uint32_t *index, const struct spa_pod *filter, struct spa_pod **param, struct spa_pod_builder *builder) { return -ENOTSUP; } static int impl_node_set_param(struct spa_node *node, uint32_t id, uint32_t flags, const struct spa_pod *param) { return -ENOTSUP; } static int impl_node_send_command(struct spa_node *node, const struct spa_command *command) { struct impl *this; spa_return_val_if_fail(node != NULL, -EINVAL); spa_return_val_if_fail(command != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); if (SPA_COMMAND_TYPE(command) == this->type.command_node.Start) { this->started = true; } else if (SPA_COMMAND_TYPE(command) == this->type.command_node.Pause) { this->started = false; } else return -ENOTSUP; return 0; } static int impl_node_set_callbacks(struct spa_node *node, const struct spa_node_callbacks *callbacks, void *user_data) { struct impl *this; spa_return_val_if_fail(node != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); this->callbacks = callbacks; this->user_data = user_data; return 0; } static int impl_node_get_n_ports(struct spa_node *node, uint32_t *n_input_ports, uint32_t *max_input_ports, uint32_t *n_output_ports, uint32_t *max_output_ports) { struct impl *this; spa_return_val_if_fail(node != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); if (n_input_ports) *n_input_ports = this->port_count; if (max_input_ports) *max_input_ports = MAX_PORTS; if (n_output_ports) *n_output_ports = 1; if (max_output_ports) *max_output_ports = 1; return 0; } static int impl_node_get_port_ids(struct spa_node *node, uint32_t *input_ids, uint32_t n_input_ids, uint32_t *output_ids, uint32_t n_output_ids) { struct impl *this; int i, idx; spa_return_val_if_fail(node != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); if (input_ids) { for (i = 0, idx = 0; i < this->last_port && idx < n_input_ids; i++) { if (this->in_ports[i].valid) input_ids[idx++] = i; } } if (n_output_ids > 0 && output_ids) output_ids[0] = 0; return 0; } static int impl_node_add_port(struct spa_node *node, enum spa_direction direction, uint32_t port_id) { struct impl *this; struct port *port; spa_return_val_if_fail(node != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); spa_return_val_if_fail(CHECK_FREE_IN_PORT(this, direction, port_id), -EINVAL); port = GET_IN_PORT (this, port_id); port->valid = true; port->id = port_id; port_props_reset(&port->props); port->io_volume = &port->props.volume; port->io_mute = &port->props.mute; spa_list_init(&port->queue); port->info.flags = SPA_PORT_INFO_FLAG_CAN_USE_BUFFERS | SPA_PORT_INFO_FLAG_REMOVABLE | SPA_PORT_INFO_FLAG_OPTIONAL | SPA_PORT_INFO_FLAG_IN_PLACE; this->port_count++; if (this->last_port <= port_id) this->last_port = port_id + 1; spa_log_info(this->log, NAME " %p: add port %d", this, port_id); return 0; } static int impl_node_remove_port(struct spa_node *node, enum spa_direction direction, uint32_t port_id) { struct impl *this; struct port *port; spa_return_val_if_fail(node != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); spa_return_val_if_fail(CHECK_IN_PORT(this, direction, port_id), -EINVAL); port = GET_IN_PORT (this, port_id); this->port_count--; if (port->have_format && this->have_format) { if (--this->n_formats == 0) this->have_format = false; } spa_memzero(port, sizeof(struct port)); if (port_id == this->last_port + 1) { int i; for (i = this->last_port; i >= 0; i--) if (GET_IN_PORT (this, i)->valid) break; this->last_port = i + 1; } spa_log_info(this->log, NAME " %p: remove port %d", this, port_id); return 0; } static int impl_node_port_get_info(struct spa_node *node, enum spa_direction direction, uint32_t port_id, const struct spa_port_info **info) { struct impl *this; struct port *port; spa_return_val_if_fail(node != NULL, -EINVAL); spa_return_val_if_fail(info != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), -EINVAL); port = GET_PORT(this, direction, port_id); *info = &port->info; return 0; } static int port_enum_formats(struct spa_node *node, enum spa_direction direction, uint32_t port_id, uint32_t *index, struct spa_pod **param, struct spa_pod_builder *builder) { struct impl *this = SPA_CONTAINER_OF(node, struct impl, node); struct type *t = &this->type; switch (*index) { case 0: if (this->have_format) { *param = spa_pod_builder_object(builder, t->param.idEnumFormat, t->format, "I", t->media_type.audio, "I", t->media_subtype.raw, ":", t->format_audio.format, "I", this->format.info.raw.format, ":", t->format_audio.rate, "i", this->format.info.raw.rate, ":", t->format_audio.channels, "i", this->format.info.raw.channels); } else { *param = spa_pod_builder_object(builder, t->param.idEnumFormat, t->format, "I", t->media_type.audio, "I", t->media_subtype.raw, ":", t->format_audio.format, "Ieu", t->audio_format.S16, SPA_POD_PROP_ENUM(2, t->audio_format.S16, t->audio_format.F32), ":", t->format_audio.rate, "iru", 44100, SPA_POD_PROP_MIN_MAX(1, INT32_MAX), ":", t->format_audio.channels, "iru", 2, SPA_POD_PROP_MIN_MAX(1, INT32_MAX)); } break; default: return 0; } return 1; } static int port_get_format(struct spa_node *node, enum spa_direction direction, uint32_t port_id, uint32_t *index, struct spa_pod **param, struct spa_pod_builder *builder) { struct impl *this = SPA_CONTAINER_OF(node, struct impl, node); struct type *t = &this->type; struct port *port = GET_PORT(this, direction, port_id); if (!port->have_format) return -EIO; if (*index > 0) return 0; *param = spa_pod_builder_object(builder, t->param.idFormat, t->format, "I", t->media_type.audio, "I", t->media_subtype.raw, ":", t->format_audio.format, "I", this->format.info.raw.format, ":", t->format_audio.rate, "i", this->format.info.raw.rate, ":", t->format_audio.channels, "i", this->format.info.raw.channels); return 1; } static int impl_node_port_enum_params(struct spa_node *node, enum spa_direction direction, uint32_t port_id, uint32_t id, uint32_t *index, const struct spa_pod *filter, struct spa_pod **result, struct spa_pod_builder *builder) { struct impl *this; struct type *t; struct port *port; struct spa_pod *param; struct spa_pod_builder b = { 0 }; uint8_t buffer[1024]; int res; spa_return_val_if_fail(node != NULL, -EINVAL); spa_return_val_if_fail(index != NULL, -EINVAL); spa_return_val_if_fail(builder != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); t = &this->type; spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), -EINVAL); port = GET_PORT(this, direction, port_id); next: spa_pod_builder_init(&b, buffer, sizeof(buffer)); if (id == t->param.idList) { uint32_t list[] = { t->param.idEnumFormat, t->param.idFormat, t->param.idBuffers, t->param.idMeta, t->param_io.idBuffers, t->param_io.idControl, t->param_io.idPropsIn }; if (*index < SPA_N_ELEMENTS(list)) param = spa_pod_builder_object(&b, id, t->param.List, ":", t->param.listId, "I", list[*index]); else return 0; } else if (id == t->param.idEnumFormat) { if ((res = port_enum_formats(node, direction, port_id, index, ¶m, &b)) <= 0) return res; } else if (id == t->param.idFormat) { if ((res = port_get_format(node, direction, port_id, index, ¶m, &b)) <= 0) return res; } else if (id == t->param.idBuffers) { if (!port->have_format) return -EIO; if (*index > 0) return 0; param = spa_pod_builder_object(&b, id, t->param_buffers.Buffers, ":", t->param_buffers.size, "iru", 1024 * this->bpf, SPA_POD_PROP_MIN_MAX(16 * this->bpf, INT32_MAX / this->bpf), ":", t->param_buffers.stride, "i", 0, ":", t->param_buffers.buffers, "iru", 1, SPA_POD_PROP_MIN_MAX(1, MAX_BUFFERS), ":", t->param_buffers.align, "i", 16); } else if (id == t->param.idMeta) { if (!port->have_format) return -EIO; switch (*index) { case 0: param = spa_pod_builder_object(&b, id, t->param_meta.Meta, ":", t->param_meta.type, "I", t->meta.Header, ":", t->param_meta.size, "i", sizeof(struct spa_meta_header)); break; default: return 0; } } else if (id == t->param_io.idBuffers) { switch (*index) { case 0: param = spa_pod_builder_object(&b, id, t->param_io.Buffers, ":", t->param_io.id, "I", t->io.Buffers, ":", t->param_io.size, "i", sizeof(struct spa_io_buffers)); break; default: return 0; } } else if (id == t->param_io.idControl) { switch (*index) { case 0: param = spa_pod_builder_object(&b, id, t->param_io.Control, ":", t->param_io.id, "I", t->io.ControlRange, ":", t->param_io.size, "i", sizeof(struct spa_io_control_range)); break; default: return 0; } } else if (id == t->param_io.idPropsIn) { struct port_props *p = &port->props; if (direction == SPA_DIRECTION_OUTPUT) return 0; switch (*index) { case 0: param = spa_pod_builder_object(&b, id, t->param_io.Prop, ":", t->param_io.id, "I", t->io_prop_volume, ":", t->param_io.size, "i", sizeof(struct spa_pod_double), ":", t->param.propId, "I", t->prop_volume, ":", t->param.propType, "dru", p->volume, SPA_POD_PROP_MIN_MAX(0.0, 10.0)); break; case 1: param = spa_pod_builder_object(&b, id, t->param_io.Prop, ":", t->param_io.id, "I", t->io_prop_mute, ":", t->param_io.size, "i", sizeof(struct spa_pod_bool), ":", t->param.propId, "I", t->prop_mute, ":", t->param.propType, "b", p->mute); break; default: return 0; } } else return -ENOENT; (*index)++; if (spa_pod_filter(builder, result, param, filter) < 0) goto next; return 1; } static int clear_buffers(struct impl *this, struct port *port) { if (port->n_buffers > 0) { spa_log_info(this->log, NAME " %p: clear buffers %p", this, port); port->n_buffers = 0; spa_list_init(&port->queue); } return 0; } static int port_set_format(struct spa_node *node, enum spa_direction direction, uint32_t port_id, uint32_t flags, const struct spa_pod *format) { struct impl *this = SPA_CONTAINER_OF(node, struct impl, node); struct port *port; struct type *t = &this->type; port = GET_PORT(this, direction, port_id); if (format == NULL) { if (port->have_format) { port->have_format = false; if (--this->n_formats == 0) this->have_format = false; clear_buffers(this, port); } } else { struct spa_audio_info info = { 0 }; spa_pod_object_parse(format, "I", &info.media_type, "I", &info.media_subtype); if (info.media_type != t->media_type.audio || info.media_subtype != t->media_subtype.raw) return -EINVAL; if (spa_format_audio_raw_parse(format, &info.info.raw, &t->format_audio) < 0) return -EINVAL; if (this->have_format) { if (memcmp(&info, &this->format, sizeof(struct spa_audio_info))) return -EINVAL; } else { if (info.info.raw.format == t->audio_format.S16) { this->clear = this->ops.clear[FMT_S16]; this->copy = this->ops.copy[FMT_S16]; this->add = this->ops.add[FMT_S16]; this->copy_scale = this->ops.copy_scale[FMT_S16]; this->add_scale = this->ops.add_scale[FMT_S16]; this->bpf = sizeof(int16_t) * info.info.raw.channels; } else if (info.info.raw.format == t->audio_format.F32) { this->clear = this->ops.clear[FMT_F32]; this->copy = this->ops.copy[FMT_F32]; this->add = this->ops.add[FMT_F32]; this->copy_scale = this->ops.copy_scale[FMT_F32]; this->add_scale = this->ops.add_scale[FMT_F32]; this->bpf = sizeof(float) * info.info.raw.channels; } else return -EINVAL; this->have_format = true; this->format = info; } if (!port->have_format) { this->n_formats++; port->have_format = true; spa_log_info(this->log, NAME " %p: set format on port %d", this, port_id); } } return 0; } static int impl_node_port_set_param(struct spa_node *node, enum spa_direction direction, uint32_t port_id, uint32_t id, uint32_t flags, const struct spa_pod *param) { struct impl *this; struct type *t; spa_return_val_if_fail(node != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); t = &this->type; spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), -EINVAL); if (id == t->param.idFormat) { return port_set_format(node, direction, port_id, flags, param); } else return -ENOENT; } static int impl_node_port_use_buffers(struct spa_node *node, enum spa_direction direction, uint32_t port_id, struct spa_buffer **buffers, uint32_t n_buffers) { struct impl *this; struct port *port; uint32_t i; struct type *t; spa_return_val_if_fail(node != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); t = &this->type; spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), -EINVAL); port = GET_PORT(this, direction, port_id); spa_return_val_if_fail(port->have_format, -EIO); spa_log_info(this->log, NAME " %p: use buffers %d on port %d", this, n_buffers, port_id); clear_buffers(this, port); for (i = 0; i < n_buffers; i++) { struct buffer *b; struct spa_data *d = buffers[i]->datas; b = &port->buffers[i]; b->outbuf = buffers[i]; b->outstanding = (direction == SPA_DIRECTION_INPUT); b->h = spa_buffer_find_meta_data(buffers[i], t->meta.Header, sizeof(*b->h)); if (!((d[0].type == t->data.MemPtr || d[0].type == t->data.MemFd || d[0].type == t->data.DmaBuf) && d[0].data != NULL)) { spa_log_error(this->log, NAME " %p: invalid memory on buffer %p", this, buffers[i]); return -EINVAL; } if (!b->outstanding) spa_list_append(&port->queue, &b->link); port->queued_bytes = 0; if (port->io) *port->io = SPA_IO_BUFFERS_INIT; } port->n_buffers = n_buffers; return 0; } static int impl_node_port_alloc_buffers(struct spa_node *node, enum spa_direction direction, uint32_t port_id, struct spa_pod **params, uint32_t n_params, struct spa_buffer **buffers, uint32_t *n_buffers) { return -ENOTSUP; } static int impl_node_port_set_io(struct spa_node *node, enum spa_direction direction, uint32_t port_id, uint32_t id, void *data, size_t size) { struct impl *this; struct port *port; struct type *t; spa_return_val_if_fail(node != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); t = &this->type; spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), -EINVAL); port = GET_PORT(this, direction, port_id); if (id == t->io.Buffers) port->io = data; else if (id == t->io.ControlRange) port->io_range = data; else if (id == t->io_prop_volume && direction == SPA_DIRECTION_INPUT) if (data && size >= sizeof(struct spa_pod_double)) port->io_volume = &SPA_POD_VALUE(struct spa_pod_double, data); else port->io_volume = &port->props.volume; else if (id == t->io_prop_mute && direction == SPA_DIRECTION_INPUT) if (data && size >= sizeof(struct spa_pod_bool)) port->io_mute = &SPA_POD_VALUE(struct spa_pod_bool, data); else port->io_mute = &port->props.mute; else return -ENOENT; return 0; } static void recycle_buffer(struct impl *this, uint32_t id) { struct port *port = GET_OUT_PORT(this, 0); struct buffer *b = &port->buffers[id]; if (!b->outstanding) return; spa_list_append(&port->queue, &b->link); b->outstanding = false; spa_log_trace(this->log, NAME " %p: recycle buffer %d", this, id); } static int impl_node_port_reuse_buffer(struct spa_node *node, uint32_t port_id, uint32_t buffer_id) { struct impl *this; spa_return_val_if_fail(node != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); spa_return_val_if_fail(CHECK_PORT(this, SPA_DIRECTION_OUTPUT, port_id), -EINVAL); recycle_buffer(this, buffer_id); return -ENOTSUP; } static int impl_node_port_send_command(struct spa_node *node, enum spa_direction direction, uint32_t port_id, const struct spa_command *command) { return -ENOTSUP; } static inline void add_port_data(struct impl *this, void *out, size_t outsize, struct port *port, int layer) { size_t insize; struct buffer *b; uint32_t index, offset, len1, len2, maxsize; struct spa_data *d; void *data; double volume = *port->io_volume; bool mute = *port->io_mute; b = spa_list_first(&port->queue, struct buffer, link); d = b->outbuf->datas; maxsize = d[0].maxsize; data = d[0].data; insize = SPA_MIN(d[0].chunk->size, maxsize); outsize = SPA_MIN(outsize, insize); index = d[0].chunk->offset + (insize - port->queued_bytes); offset = index % maxsize; len1 = SPA_MIN(outsize, maxsize - offset); len2 = outsize - len1; if (volume < 0.001 || mute) { /* silence, for the first layer clear, otherwise do nothing */ if (layer == 0) { this->clear(out, len1); if (len2 > 0) this->clear(out + len1, len2); } } else if (volume < 0.999 || volume > 1.001) { mix_scale_func_t mix = layer == 0 ? this->copy_scale : this->add_scale; mix(out, SPA_MEMBER(data, offset, void), volume, len1); if (len2 > 0) mix(out + len1, data, volume, len2); } else { mix_func_t mix = layer == 0 ? this->copy : this->add; mix(out, SPA_MEMBER(data, offset, void), len1); if (len2 > 0) mix(out + len1, data, len2); } port->queued_bytes -= outsize; if (port->queued_bytes == 0) { spa_log_trace(this->log, NAME " %p: return buffer %d on port %d %zd", this, b->outbuf->id, port->id, outsize); port->io->buffer_id = b->outbuf->id; spa_list_remove(&b->link); b->outstanding = true; } else { spa_log_trace(this->log, NAME " %p: keeping buffer %d on port %d %zd %zd", this, b->outbuf->id, port->id, port->queued_bytes, outsize); } } static int mix_output(struct impl *this, size_t n_bytes) { struct buffer *outbuf; int i, layer; struct port *outport; struct spa_io_buffers *outio; struct spa_data *od; uint32_t avail, index, maxsize, len1, len2, offset; outport = GET_OUT_PORT(this, 0); outio = outport->io; if (spa_list_is_empty(&outport->queue)) { spa_log_trace(this->log, NAME " %p: out of buffers", this); return -EPIPE; } outbuf = spa_list_first(&outport->queue, struct buffer, link); spa_list_remove(&outbuf->link); outbuf->outstanding = true; od = outbuf->outbuf->datas; maxsize = od[0].maxsize; avail = maxsize; index = 0; n_bytes = SPA_MIN(n_bytes, avail); offset = index % maxsize; len1 = SPA_MIN(n_bytes, maxsize - offset); len2 = n_bytes - len1; spa_log_trace(this->log, NAME " %p: dequeue output buffer %d %zd %d %d %d", this, outbuf->outbuf->id, n_bytes, offset, len1, len2); for (layer = 0, i = 0; i < this->last_port; i++) { struct port *in_port = GET_IN_PORT(this, i); if (in_port->io == NULL || in_port->n_buffers == 0) continue; if (in_port->queued_bytes == 0) { spa_log_warn(this->log, NAME " %p: underrun stream %d", this, i); continue; } add_port_data(this, SPA_MEMBER(od[0].data, offset, void), len1, in_port, layer); if (len2 > 0) add_port_data(this, od[0].data, len2, in_port, layer); layer++; } od[0].chunk->offset = index; od[0].chunk->size = n_bytes; od[0].chunk->stride = 0; outio->buffer_id = outbuf->outbuf->id; outio->status = SPA_STATUS_HAVE_BUFFER; return SPA_STATUS_HAVE_BUFFER; } #if 0 static int impl_node_process_input(struct spa_node *node) { struct impl *this; uint32_t i; struct port *outport; size_t min_queued = SIZE_MAX; struct spa_io_buffers *outio; spa_return_val_if_fail(node != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); outport = GET_OUT_PORT(this, 0); outio = outport->io; spa_return_val_if_fail(outio != NULL, -EIO); spa_log_trace(this->log, NAME " %p: status %d", this, outio->status); if (outio->status == SPA_STATUS_HAVE_BUFFER) return SPA_STATUS_HAVE_BUFFER; for (i = 0; i < this->last_port; i++) { struct port *inport = GET_IN_PORT(this, i); struct spa_io_buffers *inio; if ((inio = inport->io) == NULL) continue; if (inport->queued_bytes == 0 && inio->status == SPA_STATUS_HAVE_BUFFER && inio->buffer_id < inport->n_buffers) { struct buffer *b = &inport->buffers[inio->buffer_id]; struct spa_data *d = b->outbuf->datas; if (!b->outstanding) { spa_log_warn(this->log, NAME " %p: buffer %u in use", this, inio->buffer_id); inio->status = -EINVAL; continue; } b->outstanding = false; inio->buffer_id = SPA_ID_INVALID; inio->status = SPA_STATUS_OK; spa_list_append(&inport->queue, &b->link); inport->queued_bytes = SPA_MIN(d[0].chunk->size, d[0].maxsize); spa_log_trace(this->log, NAME " %p: queue buffer %d on port %d %zd %zd", this, b->outbuf->id, i, inport->queued_bytes, min_queued); } if (inport->queued_bytes > 0 && inport->queued_bytes < min_queued) min_queued = inport->queued_bytes; } if (min_queued != SIZE_MAX && min_queued > 0) { outio->status = mix_output(this, min_queued); } else { outio->status = SPA_STATUS_NEED_BUFFER; } return outio->status; } #endif static int impl_node_process(struct spa_node *node) { struct impl *this; struct port *outport; struct spa_io_buffers *outio; int i; size_t min_queued = SIZE_MAX; spa_return_val_if_fail(node != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); outport = GET_OUT_PORT(this, 0); outio = outport->io; spa_return_val_if_fail(outio != NULL, -EIO); spa_log_trace(this->log, NAME " %p: status %d", this, outio->status); if (outio->status == SPA_STATUS_HAVE_BUFFER) goto done; /* recycle */ if (outio->buffer_id < outport->n_buffers) { recycle_buffer(this, outio->buffer_id); outio->buffer_id = SPA_ID_INVALID; } /* produce more output if possible */ for (i = 0; i < this->last_port; i++) { struct port *inport = GET_IN_PORT(this, i); if (inport->io == NULL || inport->n_buffers == 0) continue; if (inport->queued_bytes < min_queued) min_queued = inport->queued_bytes; } if (min_queued != SIZE_MAX && min_queued > 0) { outio->status = mix_output(this, min_queued); } else { /* take requested output range and apply to input */ for (i = 0; i < this->last_port; i++) { struct port *inport = GET_IN_PORT(this, i); struct spa_io_buffers *inio; if ((inio = inport->io) == NULL || inport->n_buffers == 0) continue; spa_log_trace(this->log, NAME " %p: port %d queued %zd, res %d", this, i, inport->queued_bytes, inio->status); if (inport->queued_bytes == 0) { if (inport->io_range && outport->io_range) *inport->io_range = *outport->io_range; inio->status = SPA_STATUS_NEED_BUFFER; } } outio->status = SPA_STATUS_NEED_BUFFER; } done: return outio->status; } static const struct spa_node impl_node = { SPA_VERSION_NODE, NULL, impl_node_enum_params, impl_node_set_param, impl_node_send_command, impl_node_set_callbacks, impl_node_get_n_ports, impl_node_get_port_ids, impl_node_add_port, impl_node_remove_port, impl_node_port_get_info, impl_node_port_enum_params, impl_node_port_set_param, impl_node_port_use_buffers, impl_node_port_alloc_buffers, impl_node_port_set_io, impl_node_port_reuse_buffer, impl_node_port_send_command, impl_node_process, }; static int impl_get_interface(struct spa_handle *handle, uint32_t interface_id, 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 (interface_id == this->type.node) *interface = &this->node; else return -ENOENT; return 0; } static int impl_clear(struct spa_handle *handle) { return 0; } static size_t impl_get_size(const struct spa_handle_factory *factory, const struct spa_dict *params) { return sizeof(struct impl); } 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; struct port *port; uint32_t i; 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; for (i = 0; i < n_support; i++) { if (strcmp(support[i].type, SPA_TYPE__TypeMap) == 0) this->map = support[i].data; else if (strcmp(support[i].type, SPA_TYPE__Log) == 0) this->log = support[i].data; } if (this->map == NULL) { spa_log_error(this->log, "an id-map is needed"); return -EINVAL; } init_type(&this->type, this->map); this->node = impl_node; port = GET_OUT_PORT(this, 0); port->valid = true; port->id = 0; port->info.flags = SPA_PORT_INFO_FLAG_CAN_USE_BUFFERS | SPA_PORT_INFO_FLAG_NO_REF; spa_list_init(&port->queue); spa_audiomixer_get_ops(&this->ops); return 0; } static const struct spa_interface_info impl_interfaces[] = { {SPA_TYPE__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_audiomixer_factory = { SPA_VERSION_HANDLE_FACTORY, NAME, NULL, impl_get_size, impl_init, impl_enum_interface_info, };