/* Spa * Copyright (C) 2017 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 #include #include #include #define NAME "fakesrc" struct type { uint32_t node; uint32_t format; uint32_t props; uint32_t prop_live; uint32_t prop_pattern; struct spa_type_io io; struct spa_type_param param; struct spa_type_meta meta; struct spa_type_data data; struct spa_type_event_node event_node; struct spa_type_command_node command_node; struct spa_type_param_buffers param_buffers; struct spa_type_param_meta param_meta; }; 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->props = spa_type_map_get_id(map, SPA_TYPE__Props); type->prop_live = spa_type_map_get_id(map, SPA_TYPE_PROPS__live); type->prop_pattern = spa_type_map_get_id(map, SPA_TYPE_PROPS__patternType); spa_type_io_map(map, &type->io); spa_type_param_map(map, &type->param); spa_type_meta_map(map, &type->meta); spa_type_data_map(map, &type->data); spa_type_event_node_map(map, &type->event_node); spa_type_command_node_map(map, &type->command_node); spa_type_param_buffers_map(map, &type->param_buffers); spa_type_param_meta_map(map, &type->param_meta); } struct props { bool live; uint32_t pattern; }; #define MAX_BUFFERS 16 #define MAX_PORTS 1 struct buffer { struct spa_buffer *outbuf; bool outstanding; struct spa_meta_header *h; struct spa_list link; }; struct impl { struct spa_handle handle; struct spa_node node; struct type type; struct spa_type_map *map; struct spa_log *log; struct spa_loop *data_loop; struct props props; const struct spa_node_callbacks *callbacks; void *callbacks_data; struct spa_source timer_source; struct itimerspec timerspec; struct spa_port_info info; struct spa_io_buffers *io; bool have_format; uint8_t format_buffer[1024]; struct buffer buffers[MAX_BUFFERS]; uint32_t n_buffers; bool started; uint64_t start_time; uint64_t elapsed_time; uint64_t buffer_count; struct spa_list empty; bool underrun; }; #define CHECK_PORT(this,d,p) ((d) == SPA_DIRECTION_OUTPUT && (p) < MAX_PORTS) #define DEFAULT_LIVE false #define DEFAULT_PATTERN 0 static void reset_props(struct impl *this, struct props *props) { props->live = DEFAULT_LIVE; props->pattern = DEFAULT_PATTERN; } static int impl_node_enum_params(struct spa_node *node, 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 spa_pod_builder b = { 0 }; uint8_t buffer[1024]; struct spa_pod *param; 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; next: spa_pod_builder_init(&b, buffer, sizeof(buffer)); if (id == t->param.idList) { if (*index > 0) return 0; param = spa_pod_builder_object(&b, id, t->param.List, ":", t->param.listId, "I", t->param.idProps); } else if (id == t->param.idProps) { struct props *p = &this->props; if (*index > 0) return 0; param = spa_pod_builder_object(&b, id, t->props, ":", t->prop_live, "b", p->live, ":", t->prop_pattern, "Ie", p->pattern, 1, p->pattern); } else return -ENOENT; (*index)++; if (spa_pod_filter(builder, result, param, filter) < 0) goto next; return 1; } static int impl_node_set_param(struct spa_node *node, 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; if (id == t->param.idProps) { struct props *p = &this->props; if (param == NULL) { reset_props(this, p); return 0; } spa_pod_object_parse(param, ":", t->prop_live, "?b", &p->live, ":", t->prop_pattern, "?I", &p->pattern, NULL); if (p->live) this->info.flags |= SPA_PORT_INFO_FLAG_LIVE; else this->info.flags &= ~SPA_PORT_INFO_FLAG_LIVE; } else return -ENOENT; return 0; } static int fill_buffer(struct impl *this, struct buffer *b) { return 0; } static void set_timer(struct impl *this, bool enabled) { if ((this->callbacks && this->callbacks->process) || this->props.live) { if (enabled) { if (this->props.live) { uint64_t next_time = this->start_time + this->elapsed_time; this->timerspec.it_value.tv_sec = next_time / SPA_NSEC_PER_SEC; this->timerspec.it_value.tv_nsec = next_time % SPA_NSEC_PER_SEC; } else { this->timerspec.it_value.tv_sec = 0; this->timerspec.it_value.tv_nsec = 1; } } else { this->timerspec.it_value.tv_sec = 0; this->timerspec.it_value.tv_nsec = 0; } timerfd_settime(this->timer_source.fd, TFD_TIMER_ABSTIME, &this->timerspec, NULL); } } static inline void read_timer(struct impl *this) { uint64_t expirations; if ((this->callbacks && this->callbacks->process) || this->props.live) { if (read(this->timer_source.fd, &expirations, sizeof(uint64_t)) != sizeof(uint64_t)) perror("read timerfd"); } } static int make_buffer(struct impl *this) { struct buffer *b; struct spa_io_buffers *io = this->io; int n_bytes; read_timer(this); if (spa_list_is_empty(&this->empty)) { set_timer(this, false); this->underrun = true; spa_log_error(this->log, NAME " %p: out of buffers", this); return -EPIPE; } b = spa_list_first(&this->empty, struct buffer, link); spa_list_remove(&b->link); b->outstanding = true; n_bytes = b->outbuf->datas[0].maxsize; spa_log_trace(this->log, NAME " %p: dequeue buffer %d", this, b->outbuf->id); fill_buffer(this, b); b->outbuf->datas[0].chunk->offset = 0; b->outbuf->datas[0].chunk->size = n_bytes; b->outbuf->datas[0].chunk->stride = n_bytes; if (b->h) { b->h->seq = this->buffer_count; b->h->pts = this->start_time + this->elapsed_time; b->h->dts_offset = 0; } this->buffer_count++; this->elapsed_time = this->buffer_count; set_timer(this, true); io->buffer_id = b->outbuf->id; io->status = SPA_STATUS_HAVE_BUFFER; return SPA_STATUS_HAVE_BUFFER; } static void on_output(struct spa_source *source) { struct impl *this = source->data; int res; res = make_buffer(this); if (res == SPA_STATUS_HAVE_BUFFER && this->callbacks && this->callbacks->process) this->callbacks->process(this->callbacks_data, res); } 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) { struct timespec now; if (!this->have_format) return -EIO; if (this->n_buffers == 0) return -EIO; if (this->started) return 0; clock_gettime(CLOCK_MONOTONIC, &now); if (this->props.live) this->start_time = SPA_TIMESPEC_TO_TIME(&now); else this->start_time = 0; this->buffer_count = 0; this->elapsed_time = 0; this->started = true; set_timer(this, true); } else if (SPA_COMMAND_TYPE(command) == this->type.command_node.Pause) { if (!this->have_format) return -EIO; if (this->n_buffers == 0) return -EIO; if (!this->started) return 0; this->started = false; set_timer(this, false); } else return -ENOTSUP; return 0; } static int impl_node_set_callbacks(struct spa_node *node, const struct spa_node_callbacks *callbacks, void *data) { struct impl *this; spa_return_val_if_fail(node != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); if (this->data_loop == NULL && (callbacks != NULL && callbacks->process != NULL)) { spa_log_error(this->log, "a data_loop is needed for async operation"); return -EINVAL; } this->callbacks = callbacks; this->callbacks_data = 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) { spa_return_val_if_fail(node != NULL, -EINVAL); if (n_input_ports) *n_input_ports = 0; if (n_output_ports) *n_output_ports = 1; if (max_input_ports) *max_input_ports = 0; 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) { spa_return_val_if_fail(node != NULL, -EINVAL); if (n_output_ids > 0 && output_ids != NULL) output_ids[0] = 0; return 0; } static int impl_node_add_port(struct spa_node *node, enum spa_direction direction, uint32_t port_id) { return -ENOTSUP; } static int impl_node_remove_port(struct spa_node *node, enum spa_direction direction, uint32_t port_id) { return -ENOTSUP; } 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; 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); *info = &this->info; return 0; } static int port_enum_formats(struct spa_node *node, enum spa_direction direction, uint32_t port_id, uint32_t *index, const struct spa_pod *filter, struct spa_pod **param, struct spa_pod_builder *builder) { return 0; } static int port_get_format(struct spa_node *node, enum spa_direction direction, uint32_t port_id, uint32_t *index, const struct spa_pod *filter, struct spa_pod **param, struct spa_pod_builder *builder) { struct impl *this = SPA_CONTAINER_OF(node, struct impl, node); if (!this->have_format) return -EIO; if (*index > 0) return 0; *param = SPA_MEMBER(this->format_buffer, 0, struct spa_pod); 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 spa_pod_builder b = { 0 }; uint8_t buffer[1024]; struct spa_pod *param; 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); 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 }; 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, filter, ¶m, &b)) <= 0) return res; } else if (id == t->param.idFormat) { if ((res = port_get_format(node, direction, port_id, index, filter, ¶m, &b)) <= 0) return res; } else if (id == t->param.idBuffers) { if (*index > 0) return 0; param = spa_pod_builder_object(&b, id, t->param_buffers.Buffers, ":", t->param_buffers.size, "i", 128, ":", t->param_buffers.stride, "i", 1, ":", t->param_buffers.buffers, "ir", 32, 2, 2, 32, ":", t->param_buffers.align, "i", 16); } else if (id == t->param.idMeta) { 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 return -ENOENT; (*index)++; if (spa_pod_filter(builder, result, param, filter) < 0) goto next; return 1; } static int clear_buffers(struct impl *this) { if (this->n_buffers > 0) { spa_log_info(this->log, NAME " %p: clear buffers", this); this->n_buffers = 0; spa_list_init(&this->empty); this->started = false; set_timer(this, false); } 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); if (format == NULL) { this->have_format = false; clear_buffers(this); } else { if (SPA_POD_SIZE(format) > sizeof(this->format_buffer)) return -ENOSPC; memcpy(this->format_buffer, format, SPA_POD_SIZE(format)); this->have_format = true; } 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; uint32_t i; spa_return_val_if_fail(node != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), -EINVAL); if (!this->have_format) return -EIO; clear_buffers(this); for (i = 0; i < n_buffers; i++) { struct buffer *b; struct spa_data *d = buffers[i]->datas; b = &this->buffers[i]; b->outbuf = buffers[i]; b->outstanding = false; b->h = spa_buffer_find_meta_data(buffers[i], this->type.meta.Header, sizeof(*b->h)); if ((d[0].type == this->type.data.MemPtr || d[0].type == this->type.data.MemFd || d[0].type == this->type.data.DmaBuf) && d[0].data == NULL) { spa_log_error(this->log, NAME " %p: invalid memory on buffer %p", this, buffers[i]); } spa_list_append(&this->empty, &b->link); } this->n_buffers = n_buffers; this->underrun = false; 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) { 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, direction, port_id), -EINVAL); if (!this->have_format) return -EIO; 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 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->io.Buffers) this->io = data; else return -ENOENT; return 0; } static inline void reuse_buffer(struct impl *this, uint32_t id) { struct buffer *b = &this->buffers[id]; spa_return_if_fail(b->outstanding); spa_log_trace(this->log, NAME " %p: reuse buffer %d", this, id); b->outstanding = false; spa_list_append(&this->empty, &b->link); if (this->underrun) { set_timer(this, true); this->underrun = false; } } 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(port_id == 0, -EINVAL); spa_return_val_if_fail(buffer_id < this->n_buffers, -EINVAL); reuse_buffer(this, buffer_id); return 0; } 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 int impl_node_process(struct spa_node *node) { struct impl *this; struct spa_io_buffers *io; spa_return_val_if_fail(node != NULL, -EINVAL); this = SPA_CONTAINER_OF(node, struct impl, node); io = this->io; spa_return_val_if_fail(io != NULL, -EIO); if (io->status == SPA_STATUS_HAVE_BUFFER) return SPA_STATUS_HAVE_BUFFER; if (io->buffer_id < this->n_buffers) { reuse_buffer(this, this->io->buffer_id); this->io->buffer_id = SPA_ID_INVALID; } if ((this->callbacks == NULL || this->callbacks->process == NULL) && (io->status == SPA_STATUS_NEED_BUFFER)) return make_buffer(this); else return SPA_STATUS_OK; } 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) { struct impl *this; spa_return_val_if_fail(handle != NULL, -EINVAL); this = (struct impl *) handle; if (this->data_loop) spa_loop_remove_source(this->data_loop, &this->timer_source); close(this->timer_source.fd); 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; 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; else if (strcmp(support[i].type, SPA_TYPE_LOOP__DataLoop) == 0) this->data_loop = support[i].data; } if (this->map == NULL) { spa_log_error(this->log, "a type-map is needed"); return -EINVAL; } init_type(&this->type, this->map); this->node = impl_node; reset_props(this, &this->props); spa_list_init(&this->empty); this->timer_source.func = on_output; this->timer_source.data = this; this->timer_source.fd = timerfd_create(CLOCK_MONOTONIC, TFD_CLOEXEC); this->timer_source.mask = SPA_IO_IN; this->timer_source.rmask = 0; this->timerspec.it_value.tv_sec = 0; this->timerspec.it_value.tv_nsec = 0; this->timerspec.it_interval.tv_sec = 0; this->timerspec.it_interval.tv_nsec = 0; if (this->data_loop) spa_loop_add_source(this->data_loop, &this->timer_source); this->info.flags = SPA_PORT_INFO_FLAG_CAN_USE_BUFFERS | SPA_PORT_INFO_FLAG_NO_REF; if (this->props.live) this->info.flags |= SPA_PORT_INFO_FLAG_LIVE; spa_log_info(this->log, NAME " %p: initialized", this); 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_fakesrc_factory = { SPA_VERSION_HANDLE_FACTORY, NAME, NULL, impl_get_size, impl_init, impl_enum_interface_info, };