pipewire/spa/plugins/volume/volume.c

884 lines
22 KiB
C
Raw Normal View History

/* Spa
* Copyright (C) 2016 Wim Taymans <wim.taymans@gmail.com>
*
* 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 <string.h>
#include <stddef.h>
#include <spa/log.h>
2017-03-24 11:40:58 +01:00
#include <spa/type-map.h>
#include <spa/node.h>
#include <spa/list.h>
2017-03-21 16:50:44 +01:00
#include <spa/audio/format-utils.h>
#include <spa/format-builder.h>
#include <spa/param-alloc.h>
#include <lib/props.h>
#include <lib/format.h>
#define NAME "volume"
#define MAX_BUFFERS 16
struct props {
2017-05-25 16:23:13 +02:00
double volume;
bool mute;
};
struct buffer {
2017-05-25 16:23:13 +02:00
struct spa_buffer *outbuf;
bool outstanding;
struct spa_meta_header *h;
void *ptr;
size_t size;
struct spa_list link;
};
struct port {
2017-05-25 16:23:13 +02:00
bool have_format;
2017-05-25 16:23:13 +02:00
struct spa_port_info info;
uint8_t params_buffer[1024];
2017-05-25 16:23:13 +02:00
struct buffer buffers[MAX_BUFFERS];
uint32_t n_buffers;
struct spa_port_io *io;
2017-05-25 16:23:13 +02:00
struct spa_list empty;
};
struct type {
2017-05-25 16:23:13 +02:00
uint32_t node;
uint32_t format;
uint32_t props;
uint32_t prop_volume;
uint32_t prop_mute;
struct spa_type_meta meta;
struct spa_type_data data;
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_event_node event_node;
struct spa_type_command_node command_node;
struct spa_type_param_alloc_buffers param_alloc_buffers;
struct spa_type_param_alloc_meta_enable param_alloc_meta_enable;
};
2017-05-25 16:23:13 +02:00
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_volume = spa_type_map_get_id(map, SPA_TYPE_PROPS__volume);
type->prop_mute = spa_type_map_get_id(map, SPA_TYPE_PROPS__mute);
spa_type_meta_map(map, &type->meta);
spa_type_data_map(map, &type->data);
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_event_node_map(map, &type->event_node);
spa_type_command_node_map(map, &type->command_node);
spa_type_param_alloc_buffers_map(map, &type->param_alloc_buffers);
spa_type_param_alloc_meta_enable_map(map, &type->param_alloc_meta_enable);
}
struct impl {
2017-05-25 16:23:13 +02:00
struct spa_handle handle;
struct spa_node node;
2017-05-25 16:23:13 +02:00
struct type type;
struct spa_type_map *map;
struct spa_log *log;
2017-05-25 16:23:13 +02:00
uint8_t props_buffer[512];
struct props props;
const struct spa_node_callbacks *callbacks;
void *callbacks_data;
2017-05-25 16:23:13 +02:00
uint8_t format_buffer[1024];
struct spa_audio_info current_format;
2017-09-15 13:29:53 +02:00
int bpf;
2017-05-25 16:23:13 +02:00
struct port in_ports[1];
struct port out_ports[1];
2017-05-25 16:23:13 +02:00
bool started;
};
#define CHECK_IN_PORT(this,d,p) ((d) == SPA_DIRECTION_INPUT && (p) == 0)
#define CHECK_OUT_PORT(this,d,p) ((d) == SPA_DIRECTION_OUTPUT && (p) == 0)
#define CHECK_PORT(this,d,p) ((p) == 0)
#define DEFAULT_VOLUME 1.0
#define DEFAULT_MUTE false
2017-05-25 16:23:13 +02:00
static void reset_props(struct props *props)
{
2017-05-25 16:23:13 +02:00
props->volume = DEFAULT_VOLUME;
props->mute = DEFAULT_MUTE;
}
2017-05-25 16:23:13 +02:00
static int impl_node_get_props(struct spa_node *node, struct spa_props **props)
{
2017-05-25 16:23:13 +02:00
struct impl *this;
struct spa_pod_builder b = { NULL, };
struct type *t;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
spa_return_val_if_fail(props != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
this = SPA_CONTAINER_OF(node, struct impl, node);
t = &this->type;
2017-05-25 16:23:13 +02:00
spa_pod_builder_init(&b, this->props_buffer, sizeof(this->props_buffer));
*props = spa_pod_builder_props(&b,
t->props,
":", t->prop_volume, "dr", this->props.volume, 2, 0.0, 10.0,
":", t->prop_mute, "b", this->props.mute);
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OK;
}
2017-05-25 16:23:13 +02:00
static int impl_node_set_props(struct spa_node *node, const struct spa_props *props)
{
2017-05-25 16:23:13 +02:00
struct impl *this;
struct type *t;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
this = SPA_CONTAINER_OF(node, struct impl, node);
t = &this->type;
2017-05-25 16:23:13 +02:00
if (props == NULL) {
reset_props(&this->props);
} else {
spa_props_parse(props,
":", t->prop_volume, "?d", &this->props.volume,
":", t->prop_mute, "?b", &this->props.mute, NULL);
2017-05-25 16:23:13 +02:00
}
return SPA_RESULT_OK;
}
static int impl_node_send_command(struct spa_node *node, const struct spa_command *command)
{
2017-05-25 16:23:13 +02:00
struct impl *this;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
spa_return_val_if_fail(command != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
this = SPA_CONTAINER_OF(node, struct impl, node);
2017-05-25 16:23:13 +02:00
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 SPA_RESULT_NOT_IMPLEMENTED;
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OK;
}
static int
2017-05-25 16:23:13 +02:00
impl_node_set_callbacks(struct spa_node *node,
const struct spa_node_callbacks *callbacks,
void *data)
{
2017-05-25 16:23:13 +02:00
struct impl *this;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
this = SPA_CONTAINER_OF(node, struct impl, node);
this->callbacks = callbacks;
this->callbacks_data = data;
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OK;
}
static int
2017-05-25 16:23:13 +02:00
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)
{
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
if (n_input_ports)
*n_input_ports = 1;
if (max_input_ports)
*max_input_ports = 1;
if (n_output_ports)
*n_output_ports = 1;
if (max_output_ports)
*max_output_ports = 1;
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OK;
}
static int
2017-05-25 16:23:13 +02:00
impl_node_get_port_ids(struct spa_node *node,
uint32_t n_input_ports,
uint32_t *input_ids,
uint32_t n_output_ports,
uint32_t *output_ids)
{
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
if (n_input_ports > 0 && input_ids)
input_ids[0] = 0;
if (n_output_ports > 0 && output_ids)
output_ids[0] = 0;
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OK;
}
2017-05-25 16:23:13 +02:00
static int impl_node_add_port(struct spa_node *node, enum spa_direction direction, uint32_t port_id)
{
2017-05-25 16:23:13 +02:00
return SPA_RESULT_NOT_IMPLEMENTED;
}
static int
2017-05-25 16:23:13 +02:00
impl_node_remove_port(struct spa_node *node, enum spa_direction direction, uint32_t port_id)
{
2017-05-25 16:23:13 +02:00
return SPA_RESULT_NOT_IMPLEMENTED;
}
static int
2017-05-25 16:23:13 +02:00
impl_node_port_enum_formats(struct spa_node *node,
enum spa_direction direction,
uint32_t port_id,
struct spa_format **format,
const struct spa_format *filter,
uint32_t index)
{
struct impl *this;
int res;
struct spa_format *fmt;
uint8_t buffer[1024];
struct spa_pod_builder b = { NULL, };
uint32_t count, match;
struct type *t;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
spa_return_val_if_fail(format != NULL, SPA_RESULT_INVALID_ARGUMENTS);
this = SPA_CONTAINER_OF(node, struct impl, node);
t = &this->type;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), SPA_RESULT_INVALID_PORT);
count = match = filter ? 0 : index;
next:
spa_pod_builder_init(&b, buffer, sizeof(buffer));
switch (count++) {
case 0:
fmt = spa_pod_builder_format(&b,
t->format,
t->media_type.audio, t->media_subtype.raw,
":", t->format_audio.format, "Ieu", t->audio_format.S16,
2, t->audio_format.S16,
t->audio_format.S32,
":", t->format_audio.rate, "iru", 44100, 2, 1, INT32_MAX,
":", t->format_audio.channels,"iru", 2, 2, 1, INT32_MAX);
2017-05-25 16:23:13 +02:00
break;
default:
return SPA_RESULT_ENUM_END;
}
2017-05-25 16:23:13 +02:00
spa_pod_builder_init(&b, this->format_buffer, sizeof(this->format_buffer));
if ((res = spa_format_filter(fmt, filter, &b)) != SPA_RESULT_OK || match++ != index)
goto next;
*format = SPA_POD_BUILDER_DEREF(&b, 0, struct spa_format);
return SPA_RESULT_OK;
}
static int clear_buffers(struct impl *this, struct port *port)
{
if (port->n_buffers > 0) {
spa_log_info(this->log, NAME " %p: clear buffers", this);
port->n_buffers = 0;
spa_list_init(&port->empty);
}
return SPA_RESULT_OK;
}
static int
2017-05-25 16:23:13 +02:00
impl_node_port_set_format(struct spa_node *node,
enum spa_direction direction,
uint32_t port_id,
uint32_t flags,
const struct spa_format *format)
{
2017-05-25 16:23:13 +02:00
struct impl *this;
struct port *port;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
this = SPA_CONTAINER_OF(node, struct impl, node);
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), SPA_RESULT_INVALID_PORT);
2017-05-25 16:23:13 +02:00
port =
direction == SPA_DIRECTION_INPUT ? &this->in_ports[port_id] : &this->out_ports[port_id];
2017-05-25 16:23:13 +02:00
if (format == NULL) {
port->have_format = false;
clear_buffers(this, port);
} else {
struct spa_audio_info info = { SPA_FORMAT_MEDIA_TYPE(format),
SPA_FORMAT_MEDIA_SUBTYPE(format),
};
2017-03-24 18:11:11 +01:00
2017-05-25 16:23:13 +02:00
if (info.media_type != this->type.media_type.audio ||
info.media_subtype != this->type.media_subtype.raw)
return SPA_RESULT_INVALID_MEDIA_TYPE;
2017-03-24 18:11:11 +01:00
if (spa_format_audio_raw_parse(format, &info.info.raw, &this->type.format_audio) < 0)
2017-05-25 16:23:13 +02:00
return SPA_RESULT_INVALID_MEDIA_TYPE;
2017-09-15 13:29:53 +02:00
this->bpf = 2 * info.info.raw.channels;
2017-05-25 16:23:13 +02:00
this->current_format = info;
port->have_format = true;
}
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OK;
}
static int
2017-05-25 16:23:13 +02:00
impl_node_port_get_format(struct spa_node *node,
enum spa_direction direction,
uint32_t port_id,
const struct spa_format **format)
{
2017-05-25 16:23:13 +02:00
struct impl *this;
struct port *port;
2017-09-15 13:29:53 +02:00
struct spa_pod_builder b = { NULL, };
struct type *t;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
spa_return_val_if_fail(format != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
this = SPA_CONTAINER_OF(node, struct impl, node);
t = &this->type;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), SPA_RESULT_INVALID_PORT);
2017-05-25 16:23:13 +02:00
port =
direction == SPA_DIRECTION_INPUT ? &this->in_ports[port_id] : &this->out_ports[port_id];
2017-05-25 16:23:13 +02:00
if (!port->have_format)
return SPA_RESULT_NO_FORMAT;
2017-09-15 13:29:53 +02:00
spa_pod_builder_init(&b, this->format_buffer, sizeof(this->format_buffer));
*format = spa_pod_builder_format(&b,
t->format,
t->media_type.audio, t->media_subtype.raw,
":", t->format_audio.format, "I", this->current_format.info.raw.format,
":", t->format_audio.rate, "i", this->current_format.info.raw.rate,
":", t->format_audio.channels, "i", this->current_format.info.raw.channels);
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OK;
}
static int
2017-05-25 16:23:13 +02:00
impl_node_port_get_info(struct spa_node *node,
enum spa_direction direction,
uint32_t port_id,
const struct spa_port_info **info)
{
2017-05-25 16:23:13 +02:00
struct impl *this;
struct port *port;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
spa_return_val_if_fail(info != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
this = SPA_CONTAINER_OF(node, struct impl, node);
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), SPA_RESULT_INVALID_PORT);
2017-05-25 16:23:13 +02:00
port =
direction == SPA_DIRECTION_INPUT ? &this->in_ports[port_id] : &this->out_ports[port_id];
*info = &port->info;
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OK;
}
static int
2017-05-25 16:23:13 +02:00
impl_node_port_enum_params(struct spa_node *node,
enum spa_direction direction,
uint32_t port_id,
uint32_t index,
struct spa_param **param)
{
2017-05-25 16:23:13 +02:00
struct spa_pod_builder b = { NULL };
struct impl *this;
struct port *port;
struct type *t;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
spa_return_val_if_fail(param != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
this = SPA_CONTAINER_OF(node, struct impl, node);
t = &this->type;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), SPA_RESULT_INVALID_PORT);
2017-05-25 16:23:13 +02:00
port =
direction == SPA_DIRECTION_INPUT ? &this->in_ports[port_id] : &this->out_ports[port_id];
2017-05-25 16:23:13 +02:00
spa_pod_builder_init(&b, port->params_buffer, sizeof(port->params_buffer));
2017-05-25 16:23:13 +02:00
switch (index) {
case 0:
*param = spa_pod_builder_param(&b,
t->param_alloc_buffers.Buffers,
":", t->param_alloc_buffers.size, "iru", 1024 * this->bpf,
2, 16 * this->bpf,
INT32_MAX / this->bpf,
":", t->param_alloc_buffers.stride, "i", 0,
":", t->param_alloc_buffers.buffers, "iru", 2,
2, 1, MAX_BUFFERS,
":", t->param_alloc_buffers.align, "i", 16);
2017-05-25 16:23:13 +02:00
break;
2017-05-25 16:23:13 +02:00
case 1:
*param = spa_pod_builder_param(&b,
t->param_alloc_meta_enable.MetaEnable,
":", t->param_alloc_meta_enable.type, "I", t->meta.Header,
":", t->param_alloc_meta_enable.size, "i", sizeof(struct spa_meta_header));
2017-05-25 16:23:13 +02:00
break;
2017-05-25 16:23:13 +02:00
default:
return SPA_RESULT_NOT_IMPLEMENTED;
}
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OK;
}
static int
2017-05-25 16:23:13 +02:00
impl_node_port_set_param(struct spa_node *node,
enum spa_direction direction,
uint32_t port_id,
const struct spa_param *param)
{
2017-05-25 16:23:13 +02:00
return SPA_RESULT_NOT_IMPLEMENTED;
}
static int
2017-05-25 16:23:13 +02:00
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)
{
2017-05-25 16:23:13 +02:00
struct impl *this;
struct port *port;
uint32_t i;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
this = SPA_CONTAINER_OF(node, struct impl, node);
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), SPA_RESULT_INVALID_PORT);
2017-05-25 16:23:13 +02:00
port =
direction == SPA_DIRECTION_INPUT ? &this->in_ports[port_id] : &this->out_ports[port_id];
2017-05-25 16:23:13 +02:00
if (!port->have_format)
return SPA_RESULT_NO_FORMAT;
2017-05-25 16:23:13 +02:00
clear_buffers(this, port);
2017-05-25 16:23:13 +02:00
for (i = 0; i < n_buffers; i++) {
struct buffer *b;
struct spa_data *d = buffers[i]->datas;
2017-05-25 16:23:13 +02:00
b = &port->buffers[i];
b->outbuf = buffers[i];
b->outstanding = direction == SPA_DIRECTION_INPUT;
2017-05-25 16:23:13 +02:00
b->h = spa_buffer_find_meta(buffers[i], this->type.meta.Header);
2017-05-25 16:23:13 +02:00
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) {
b->ptr = d[0].data;
b->size = d[0].maxsize;
} else {
spa_log_error(this->log, NAME " %p: invalid memory on buffer %p", this,
buffers[i]);
return SPA_RESULT_ERROR;
}
if (!b->outstanding)
spa_list_append(&port->empty, &b->link);
2017-05-25 16:23:13 +02:00
}
port->n_buffers = n_buffers;
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OK;
}
static int
2017-05-25 16:23:13 +02:00
impl_node_port_alloc_buffers(struct spa_node *node,
enum spa_direction direction,
uint32_t port_id,
struct spa_param **params,
uint32_t n_params,
struct spa_buffer **buffers,
uint32_t *n_buffers)
{
2017-05-25 16:23:13 +02:00
return SPA_RESULT_NOT_IMPLEMENTED;
}
static int
2017-05-25 16:23:13 +02:00
impl_node_port_set_io(struct spa_node *node,
enum spa_direction direction,
uint32_t port_id,
struct spa_port_io *io)
{
2017-05-25 16:23:13 +02:00
struct impl *this;
struct port *port;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
this = SPA_CONTAINER_OF(node, struct impl, node);
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), SPA_RESULT_INVALID_PORT);
2017-05-25 16:23:13 +02:00
port =
direction == SPA_DIRECTION_INPUT ? &this->in_ports[port_id] : &this->out_ports[port_id];
port->io = io;
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OK;
}
2017-05-25 16:23:13 +02:00
static void recycle_buffer(struct impl *this, uint32_t id)
{
2017-05-25 16:23:13 +02:00
struct port *port = &this->out_ports[0];
struct buffer *b = &port->buffers[id];
2017-05-25 16:23:13 +02:00
if (!b->outstanding) {
spa_log_warn(this->log, NAME " %p: buffer %d not outstanding", this, id);
return;
}
2017-10-24 12:58:10 +02:00
spa_list_append(&port->empty, &b->link);
2017-05-25 16:23:13 +02:00
b->outstanding = false;
spa_log_trace(this->log, NAME " %p: recycle buffer %d", this, id);
}
2017-05-25 16:23:13 +02:00
static int impl_node_port_reuse_buffer(struct spa_node *node, uint32_t port_id, uint32_t buffer_id)
{
2017-05-25 16:23:13 +02:00
struct impl *this;
struct port *port;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
this = SPA_CONTAINER_OF(node, struct impl, node);
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(CHECK_PORT(this, SPA_DIRECTION_OUTPUT, port_id),
SPA_RESULT_INVALID_PORT);
2017-05-25 16:23:13 +02:00
port = &this->out_ports[port_id];
2017-05-25 16:23:13 +02:00
if (port->n_buffers == 0)
return SPA_RESULT_NO_BUFFERS;
2017-05-25 16:23:13 +02:00
if (buffer_id >= port->n_buffers)
return SPA_RESULT_INVALID_BUFFER_ID;
2017-05-25 16:23:13 +02:00
recycle_buffer(this, buffer_id);
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OK;
}
static int
2017-05-25 16:23:13 +02:00
impl_node_port_send_command(struct spa_node *node,
enum spa_direction direction,
uint32_t port_id,
const struct spa_command *command)
{
2017-05-25 16:23:13 +02:00
return SPA_RESULT_NOT_IMPLEMENTED;
}
2017-05-25 16:23:13 +02:00
static struct spa_buffer *find_free_buffer(struct impl *this, struct port *port)
{
2017-05-25 16:23:13 +02:00
struct buffer *b;
2017-05-25 16:23:13 +02:00
if (spa_list_is_empty(&port->empty))
return NULL;
2017-05-25 16:23:13 +02:00
b = spa_list_first(&port->empty, struct buffer, link);
spa_list_remove(&b->link);
b->outstanding = true;
2017-05-25 16:23:13 +02:00
return b->outbuf;
}
2017-05-25 16:23:13 +02:00
static void do_volume(struct impl *this, struct spa_buffer *dbuf, struct spa_buffer *sbuf)
{
2017-05-25 16:23:13 +02:00
uint32_t si, di, i, n_samples, n_bytes, soff, doff;
struct spa_data *sd, *dd;
int16_t *src, *dst;
2017-05-25 16:23:13 +02:00
double volume;
2017-05-25 16:23:13 +02:00
volume = this->props.volume;
2017-05-25 16:23:13 +02:00
si = di = 0;
soff = doff = 0;
2017-05-25 16:23:13 +02:00
while (true) {
if (si == sbuf->n_datas || di == dbuf->n_datas)
break;
2017-05-25 16:23:13 +02:00
sd = &sbuf->datas[si];
dd = &dbuf->datas[di];
src = (int16_t *) ((uint8_t *) sd->data + sd->chunk->offset + soff);
dst = (int16_t *) ((uint8_t *) dd->data + doff);
n_bytes = SPA_MIN(sd->chunk->size - soff, dd->maxsize - doff);
2017-05-25 16:23:13 +02:00
n_samples = n_bytes / sizeof(uint16_t);
2017-05-25 16:23:13 +02:00
for (i = 0; i < n_samples; i++)
dst[i] = src[i] * volume;
2017-05-25 16:23:13 +02:00
soff += n_bytes;
doff += n_bytes;
dd->chunk->offset = 0;
dd->chunk->size = doff;
2017-05-25 16:23:13 +02:00
if (soff >= sd->chunk->size) {
si++;
soff = 0;
}
if (doff >= dd->maxsize) {
2017-05-25 16:23:13 +02:00
di++;
doff = 0;
}
}
}
2017-05-25 16:23:13 +02:00
static int impl_node_process_input(struct spa_node *node)
{
2017-05-25 16:23:13 +02:00
struct impl *this;
struct spa_port_io *input;
struct spa_port_io *output;
struct port *in_port, *out_port;
struct spa_buffer *dbuf, *sbuf;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
this = SPA_CONTAINER_OF(node, struct impl, node);
2017-05-25 16:23:13 +02:00
out_port = &this->out_ports[0];
output = out_port->io;
spa_return_val_if_fail(output != NULL, SPA_RESULT_ERROR);
2017-05-25 16:23:13 +02:00
if (output->status == SPA_RESULT_HAVE_BUFFER)
return SPA_RESULT_HAVE_BUFFER;
2017-05-25 16:23:13 +02:00
in_port = &this->in_ports[0];
input = in_port->io;
spa_return_val_if_fail(input != NULL, SPA_RESULT_ERROR);
2017-09-15 13:29:53 +02:00
if (input->buffer_id >= in_port->n_buffers)
return SPA_RESULT_NEED_BUFFER;
if ((dbuf = find_free_buffer(this, out_port)) == NULL) {
spa_log_error(this->log, NAME " %p: out of buffers", this);
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OUT_OF_BUFFERS;
}
2017-05-25 16:23:13 +02:00
sbuf = in_port->buffers[input->buffer_id].outbuf;
input->status = SPA_RESULT_OK;
spa_log_trace(this->log, NAME " %p: do volume %d -> %d", this, sbuf->id, dbuf->id);
do_volume(this, dbuf, sbuf);
2017-05-25 16:23:13 +02:00
output->buffer_id = dbuf->id;
output->status = SPA_RESULT_HAVE_BUFFER;
2017-05-25 16:23:13 +02:00
return SPA_RESULT_HAVE_BUFFER;
}
2017-05-25 16:23:13 +02:00
static int impl_node_process_output(struct spa_node *node)
{
2017-05-25 16:23:13 +02:00
struct impl *this;
struct port *in_port, *out_port;
struct spa_port_io *input, *output;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
this = SPA_CONTAINER_OF(node, struct impl, node);
2017-05-25 16:23:13 +02:00
out_port = &this->out_ports[0];
output = out_port->io;
spa_return_val_if_fail(output != NULL, SPA_RESULT_ERROR);
2017-05-25 16:23:13 +02:00
if (output->status == SPA_RESULT_HAVE_BUFFER)
return SPA_RESULT_HAVE_BUFFER;
2017-05-25 16:23:13 +02:00
/* recycle */
2017-08-27 09:16:03 +02:00
if (output->buffer_id < out_port->n_buffers) {
2017-05-25 16:23:13 +02:00
recycle_buffer(this, output->buffer_id);
output->buffer_id = SPA_ID_INVALID;
}
2017-05-25 16:23:13 +02:00
in_port = &this->in_ports[0];
input = in_port->io;
spa_return_val_if_fail(input != NULL, SPA_RESULT_ERROR);
2017-05-25 16:23:13 +02:00
input->range = output->range;
input->status = SPA_RESULT_NEED_BUFFER;
2017-05-25 16:23:13 +02:00
return SPA_RESULT_NEED_BUFFER;
}
static const struct spa_node impl_node = {
SPA_VERSION_NODE,
2017-05-25 16:23:13 +02:00
NULL,
impl_node_get_props,
impl_node_set_props,
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_enum_formats,
impl_node_port_set_format,
impl_node_port_get_format,
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_input,
impl_node_process_output,
};
2017-05-25 16:23:13 +02:00
static int impl_get_interface(struct spa_handle *handle, uint32_t interface_id, void **interface)
{
2017-05-25 16:23:13 +02:00
struct impl *this;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(handle != NULL, SPA_RESULT_INVALID_ARGUMENTS);
spa_return_val_if_fail(interface != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
this = (struct impl *) handle;
2017-05-25 16:23:13 +02:00
if (interface_id == this->type.node)
*interface = &this->node;
else
return SPA_RESULT_UNKNOWN_INTERFACE;
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OK;
}
2017-05-25 16:23:13 +02:00
static int impl_clear(struct spa_handle *handle)
{
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OK;
}
static int
2017-05-25 16:23:13 +02:00
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)
{
2017-05-25 16:23:13 +02:00
struct impl *this;
uint32_t i;
2017-05-25 16:23:13 +02:00
spa_return_val_if_fail(factory != NULL, SPA_RESULT_INVALID_ARGUMENTS);
spa_return_val_if_fail(handle != NULL, SPA_RESULT_INVALID_ARGUMENTS);
2017-05-25 16:23:13 +02:00
handle->get_interface = impl_get_interface;
handle->clear = impl_clear;
2017-05-25 16:23:13 +02:00
this = (struct impl *) handle;
2017-05-25 16:23:13 +02:00
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, "a type-map is needed");
return SPA_RESULT_ERROR;
}
init_type(&this->type, this->map);
2017-05-25 16:23:13 +02:00
this->node = impl_node;
reset_props(&this->props);
2017-05-25 16:23:13 +02:00
this->in_ports[0].info.flags = SPA_PORT_INFO_FLAG_CAN_USE_BUFFERS |
SPA_PORT_INFO_FLAG_IN_PLACE;
spa_list_init(&this->in_ports[0].empty);
2017-05-25 16:23:13 +02:00
this->out_ports[0].info.flags = SPA_PORT_INFO_FLAG_CAN_USE_BUFFERS |
SPA_PORT_INFO_FLAG_NO_REF;
spa_list_init(&this->out_ports[0].empty);
2017-05-25 16:23:13 +02:00
return SPA_RESULT_OK;
}
2017-05-25 16:23:13 +02:00
static const struct spa_interface_info impl_interfaces[] = {
{SPA_TYPE__Node,},
};
static int
2017-05-25 16:23:13 +02:00
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, SPA_RESULT_INVALID_ARGUMENTS);
spa_return_val_if_fail(info != NULL, SPA_RESULT_INVALID_ARGUMENTS);
switch (index) {
case 0:
*info = &impl_interfaces[index];
break;
default:
return SPA_RESULT_ENUM_END;
}
return SPA_RESULT_OK;
}
const struct spa_handle_factory spa_volume_factory = {
SPA_VERSION_HANDLE_FACTORY,
2017-05-25 16:23:13 +02:00
NAME,
NULL,
sizeof(struct impl),
impl_init,
impl_enum_interface_info,
};