mirror of
https://gitlab.freedesktop.org/pipewire/pipewire.git
synced 2025-10-29 05:40:27 -04:00
893 lines
24 KiB
C
893 lines
24 KiB
C
/* 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>
|
|
#include <spa/id-map.h>
|
|
#include <spa/node.h>
|
|
#include <spa/list.h>
|
|
#include <spa/audio/format-utils.h>
|
|
#include <spa/format-builder.h>
|
|
#include <lib/props.h>
|
|
|
|
#define MAX_BUFFERS 16
|
|
|
|
typedef struct _SpaVolume SpaVolume;
|
|
|
|
typedef struct {
|
|
double volume;
|
|
bool mute;
|
|
} SpaVolumeProps;
|
|
|
|
typedef struct {
|
|
SpaBuffer *outbuf;
|
|
bool outstanding;
|
|
SpaMetaHeader *h;
|
|
void *ptr;
|
|
size_t size;
|
|
SpaList link;
|
|
} SpaVolumeBuffer;
|
|
|
|
typedef struct {
|
|
bool have_format;
|
|
|
|
SpaPortInfo info;
|
|
SpaAllocParam *params[2];
|
|
uint8_t params_buffer[1024];
|
|
|
|
SpaVolumeBuffer buffers[MAX_BUFFERS];
|
|
uint32_t n_buffers;
|
|
|
|
void *io;
|
|
|
|
SpaList empty;
|
|
} SpaVolumePort;
|
|
|
|
typedef struct {
|
|
uint32_t node;
|
|
SpaMediaTypes media_types;
|
|
SpaMediaSubtypes media_subtypes;
|
|
SpaPropAudio prop_audio;
|
|
SpaAudioFormats audio_formats;
|
|
} URI;
|
|
|
|
struct _SpaVolume {
|
|
SpaHandle handle;
|
|
SpaNode node;
|
|
|
|
URI uri;
|
|
SpaIDMap *map;
|
|
SpaLog *log;
|
|
|
|
uint8_t props_buffer[512];
|
|
SpaVolumeProps props;
|
|
|
|
SpaNodeEventCallback event_cb;
|
|
void *user_data;
|
|
|
|
uint8_t format_buffer[1024];
|
|
SpaAudioInfo current_format;
|
|
|
|
SpaVolumePort in_ports[1];
|
|
SpaVolumePort out_ports[1];
|
|
};
|
|
|
|
#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)
|
|
|
|
static const double default_volume = 1.0;
|
|
static const bool default_mute = false;
|
|
|
|
enum {
|
|
PROP_ID_NONE,
|
|
PROP_ID_VOLUME,
|
|
PROP_ID_MUTE,
|
|
};
|
|
|
|
static void
|
|
reset_volume_props (SpaVolumeProps *props)
|
|
{
|
|
props->volume = default_volume;
|
|
props->mute = default_mute;
|
|
}
|
|
|
|
static void
|
|
update_state (SpaVolume *this, SpaNodeState state)
|
|
{
|
|
this->node.state = state;
|
|
}
|
|
|
|
#define PROP(f,key,type,...) \
|
|
SPA_POD_PROP (f,key,SPA_POD_PROP_FLAG_READWRITE,type,1,__VA_ARGS__)
|
|
#define PROP_MM(f,key,type,...) \
|
|
SPA_POD_PROP (f,key,SPA_POD_PROP_FLAG_READWRITE | \
|
|
SPA_POD_PROP_RANGE_MIN_MAX,type,3,__VA_ARGS__)
|
|
#define PROP_U_MM(f,key,type,...) \
|
|
SPA_POD_PROP (f,key,SPA_POD_PROP_FLAG_READWRITE | \
|
|
SPA_POD_PROP_FLAG_UNSET | \
|
|
SPA_POD_PROP_RANGE_MIN_MAX,type,3,__VA_ARGS__)
|
|
#define PROP_U_EN(f,key,type,n,...) \
|
|
SPA_POD_PROP (f,key,SPA_POD_PROP_FLAG_READWRITE | \
|
|
SPA_POD_PROP_FLAG_UNSET | \
|
|
SPA_POD_PROP_RANGE_ENUM,type,n,__VA_ARGS__)
|
|
|
|
|
|
static SpaResult
|
|
spa_volume_node_get_props (SpaNode *node,
|
|
SpaProps **props)
|
|
{
|
|
SpaVolume *this;
|
|
SpaPODBuilder b = { NULL, };
|
|
SpaPODFrame f[2];
|
|
|
|
if (node == NULL || props == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaVolume, node);
|
|
|
|
spa_pod_builder_init (&b, this->props_buffer, sizeof (this->props_buffer));
|
|
spa_pod_builder_props (&b, &f[0],
|
|
PROP_MM (&f[1], PROP_ID_VOLUME, SPA_POD_TYPE_DOUBLE, this->props.volume, 0.0, 10.0),
|
|
PROP (&f[1], PROP_ID_MUTE, SPA_POD_TYPE_BOOL, this->props.mute));
|
|
|
|
*props = SPA_POD_BUILDER_DEREF (&b, f[0].ref, SpaProps);
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_set_props (SpaNode *node,
|
|
const SpaProps *props)
|
|
{
|
|
SpaVolume *this;
|
|
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaVolume, node);
|
|
|
|
if (props == NULL) {
|
|
reset_volume_props (&this->props);
|
|
} else {
|
|
spa_props_query (props,
|
|
PROP_ID_VOLUME, SPA_POD_TYPE_DOUBLE, &this->props.volume,
|
|
PROP_ID_MUTE, SPA_POD_TYPE_BOOL, &this->props.mute,
|
|
0);
|
|
}
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_send_command (SpaNode *node,
|
|
SpaNodeCommand *command)
|
|
{
|
|
SpaVolume *this;
|
|
|
|
if (node == NULL || command == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaVolume, node);
|
|
|
|
switch (SPA_NODE_COMMAND_TYPE (command)) {
|
|
case SPA_NODE_COMMAND_INVALID:
|
|
return SPA_RESULT_INVALID_COMMAND;
|
|
|
|
case SPA_NODE_COMMAND_START:
|
|
update_state (this, SPA_NODE_STATE_STREAMING);
|
|
break;
|
|
|
|
case SPA_NODE_COMMAND_PAUSE:
|
|
update_state (this, SPA_NODE_STATE_PAUSED);
|
|
break;
|
|
|
|
case SPA_NODE_COMMAND_FLUSH:
|
|
case SPA_NODE_COMMAND_DRAIN:
|
|
case SPA_NODE_COMMAND_MARKER:
|
|
case SPA_NODE_COMMAND_CLOCK_UPDATE:
|
|
return SPA_RESULT_NOT_IMPLEMENTED;
|
|
}
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_set_event_callback (SpaNode *node,
|
|
SpaNodeEventCallback event,
|
|
void *user_data)
|
|
{
|
|
SpaVolume *this;
|
|
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaVolume, node);
|
|
|
|
this->event_cb = event;
|
|
this->user_data = user_data;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_get_n_ports (SpaNode *node,
|
|
uint32_t *n_input_ports,
|
|
uint32_t *max_input_ports,
|
|
uint32_t *n_output_ports,
|
|
uint32_t *max_output_ports)
|
|
{
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
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;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_get_port_ids (SpaNode *node,
|
|
uint32_t n_input_ports,
|
|
uint32_t *input_ids,
|
|
uint32_t n_output_ports,
|
|
uint32_t *output_ids)
|
|
{
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
if (n_input_ports > 0 && input_ids)
|
|
input_ids[0] = 0;
|
|
if (n_output_ports > 0 && output_ids)
|
|
output_ids[0] = 0;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
|
|
static SpaResult
|
|
spa_volume_node_add_port (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id)
|
|
{
|
|
return SPA_RESULT_NOT_IMPLEMENTED;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_remove_port (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id)
|
|
{
|
|
return SPA_RESULT_NOT_IMPLEMENTED;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_port_enum_formats (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
SpaFormat **format,
|
|
const SpaFormat *filter,
|
|
uint32_t index)
|
|
{
|
|
SpaVolume *this;
|
|
SpaResult res;
|
|
SpaFormat *fmt;
|
|
uint8_t buffer[1024];
|
|
SpaPODBuilder b = { NULL, };
|
|
SpaPODFrame f[2];
|
|
|
|
if (node == NULL || format == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaVolume, node);
|
|
|
|
if (!CHECK_PORT (this, direction, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
next:
|
|
spa_pod_builder_init (&b, buffer, sizeof (buffer));
|
|
|
|
switch (index++) {
|
|
case 0:
|
|
spa_pod_builder_format (&b, &f[0],
|
|
this->uri.media_types.audio, this->uri.media_subtypes.raw,
|
|
PROP_U_EN (&f[1], this->uri.prop_audio.format, SPA_POD_TYPE_URI, 3,
|
|
this->uri.audio_formats.S16,
|
|
this->uri.audio_formats.S16,
|
|
this->uri.audio_formats.S32),
|
|
PROP_U_MM (&f[1], this->uri.prop_audio.rate, SPA_POD_TYPE_INT, 44100, 1, INT32_MAX),
|
|
PROP_U_MM (&f[1], this->uri.prop_audio.channels, SPA_POD_TYPE_INT, 2, 1, INT32_MAX));
|
|
|
|
break;
|
|
default:
|
|
return SPA_RESULT_ENUM_END;
|
|
}
|
|
fmt = SPA_POD_BUILDER_DEREF (&b, f[0].ref, SpaFormat);
|
|
spa_pod_builder_init (&b, this->format_buffer, sizeof (this->format_buffer));
|
|
|
|
if ((res = spa_format_filter (fmt, filter, &b)) != SPA_RESULT_OK)
|
|
goto next;
|
|
|
|
*format = SPA_POD_BUILDER_DEREF (&b, 0, SpaFormat);
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
clear_buffers (SpaVolume *this, SpaVolumePort *port)
|
|
{
|
|
if (port->n_buffers > 0) {
|
|
spa_log_info (this->log, "volume %p: clear buffers", this);
|
|
port->n_buffers = 0;
|
|
spa_list_init (&port->empty);
|
|
}
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_port_set_format (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
SpaPortFormatFlags flags,
|
|
const SpaFormat *format)
|
|
{
|
|
SpaVolume *this;
|
|
SpaVolumePort *port;
|
|
SpaResult res;
|
|
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaVolume, node);
|
|
|
|
if (!CHECK_PORT (this, direction, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
port = direction == SPA_DIRECTION_INPUT ? &this->in_ports[port_id] : &this->out_ports[port_id];
|
|
|
|
if (format == NULL) {
|
|
port->have_format = false;
|
|
clear_buffers (this, port);
|
|
} else {
|
|
if ((res = spa_format_audio_parse (format, &this->current_format)) < 0)
|
|
return res;
|
|
|
|
port->have_format = true;
|
|
}
|
|
|
|
if (port->have_format) {
|
|
SpaPODBuilder b = { NULL };
|
|
SpaPODFrame f[2];
|
|
|
|
port->info.maxbuffering = -1;
|
|
port->info.latency = 0;
|
|
|
|
port->info.n_params = 2;
|
|
port->info.params = port->params;
|
|
|
|
spa_pod_builder_init (&b, port->params_buffer, sizeof (port->params_buffer));
|
|
spa_pod_builder_object (&b, &f[0], 0, SPA_ALLOC_PARAM_TYPE_BUFFERS,
|
|
PROP (&f[1], SPA_ALLOC_PARAM_BUFFERS_SIZE, SPA_POD_TYPE_INT, 16),
|
|
PROP (&f[1], SPA_ALLOC_PARAM_BUFFERS_STRIDE, SPA_POD_TYPE_INT, 16),
|
|
PROP_U_MM (&f[1], SPA_ALLOC_PARAM_BUFFERS_BUFFERS, SPA_POD_TYPE_INT, MAX_BUFFERS, 2, MAX_BUFFERS),
|
|
PROP (&f[1], SPA_ALLOC_PARAM_BUFFERS_ALIGN, SPA_POD_TYPE_INT, 16));
|
|
port->params[0] = SPA_POD_BUILDER_DEREF (&b, f[0].ref, SpaAllocParam);
|
|
|
|
spa_pod_builder_object (&b, &f[0], 0, SPA_ALLOC_PARAM_TYPE_META_ENABLE,
|
|
PROP (&f[1], SPA_ALLOC_PARAM_META_ENABLE_TYPE, SPA_POD_TYPE_INT, SPA_META_TYPE_HEADER));
|
|
port->params[1] = SPA_POD_BUILDER_DEREF (&b, f[0].ref, SpaAllocParam);
|
|
|
|
port->info.extra = NULL;
|
|
update_state (this, SPA_NODE_STATE_READY);
|
|
}
|
|
else
|
|
update_state (this, SPA_NODE_STATE_CONFIGURE);
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_port_get_format (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
const SpaFormat **format)
|
|
{
|
|
SpaVolume *this;
|
|
SpaVolumePort *port;
|
|
|
|
if (node == NULL || format == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaVolume, node);
|
|
|
|
if (!CHECK_PORT (this, direction, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
port = direction == SPA_DIRECTION_INPUT ? &this->in_ports[port_id] : &this->out_ports[port_id];
|
|
|
|
if (!port->have_format)
|
|
return SPA_RESULT_NO_FORMAT;
|
|
|
|
*format = NULL;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_port_get_info (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
const SpaPortInfo **info)
|
|
{
|
|
SpaVolume *this;
|
|
SpaVolumePort *port;
|
|
|
|
if (node == NULL || info == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaVolume, node);
|
|
|
|
if (!CHECK_PORT (this, direction, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
port = direction == SPA_DIRECTION_INPUT ? &this->in_ports[port_id] : &this->out_ports[port_id];
|
|
*info = &port->info;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_port_get_props (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
SpaProps **props)
|
|
{
|
|
return SPA_RESULT_NOT_IMPLEMENTED;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_port_set_props (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
const SpaProps *props)
|
|
{
|
|
return SPA_RESULT_NOT_IMPLEMENTED;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_port_use_buffers (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
SpaBuffer **buffers,
|
|
uint32_t n_buffers)
|
|
{
|
|
SpaVolume *this;
|
|
SpaVolumePort *port;
|
|
uint32_t i;
|
|
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaVolume, node);
|
|
|
|
if (!CHECK_PORT (this, direction, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
port = direction == SPA_DIRECTION_INPUT ? &this->in_ports[port_id] : &this->out_ports[port_id];
|
|
|
|
if (!port->have_format)
|
|
return SPA_RESULT_NO_FORMAT;
|
|
|
|
clear_buffers (this, port);
|
|
|
|
for (i = 0; i < n_buffers; i++) {
|
|
SpaVolumeBuffer *b;
|
|
SpaData *d = buffers[i]->datas;
|
|
|
|
b = &port->buffers[i];
|
|
b->outbuf = buffers[i];
|
|
b->outstanding = true;
|
|
b->h = spa_buffer_find_meta (buffers[i], SPA_META_TYPE_HEADER);
|
|
|
|
switch (d[0].type) {
|
|
case SPA_DATA_TYPE_MEMPTR:
|
|
case SPA_DATA_TYPE_MEMFD:
|
|
case SPA_DATA_TYPE_DMABUF:
|
|
if (d[0].data == NULL) {
|
|
spa_log_error (this->log, "volume %p: invalid memory on buffer %p", this, buffers[i]);
|
|
continue;
|
|
}
|
|
b->ptr = d[0].data;
|
|
b->size = d[0].maxsize;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
spa_list_insert (port->empty.prev, &b->link);
|
|
}
|
|
port->n_buffers = n_buffers;
|
|
|
|
if (port->n_buffers > 0) {
|
|
update_state (this, SPA_NODE_STATE_PAUSED);
|
|
} else {
|
|
update_state (this, SPA_NODE_STATE_READY);
|
|
}
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_port_alloc_buffers (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
SpaAllocParam **params,
|
|
uint32_t n_params,
|
|
SpaBuffer **buffers,
|
|
uint32_t *n_buffers)
|
|
{
|
|
return SPA_RESULT_NOT_IMPLEMENTED;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_port_set_input (SpaNode *node,
|
|
uint32_t port_id,
|
|
SpaPortInput *input)
|
|
{
|
|
SpaVolume *this;
|
|
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaVolume, node);
|
|
|
|
if (!CHECK_PORT (this, SPA_DIRECTION_INPUT, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
this->in_ports[port_id].io = input;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_port_set_output (SpaNode *node,
|
|
uint32_t port_id,
|
|
SpaPortOutput *output)
|
|
{
|
|
SpaVolume *this;
|
|
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaVolume, node);
|
|
|
|
if (!CHECK_PORT (this, SPA_DIRECTION_OUTPUT, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
this->in_ports[port_id].io = output;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_port_reuse_buffer (SpaNode *node,
|
|
uint32_t port_id,
|
|
uint32_t buffer_id)
|
|
{
|
|
SpaVolume *this;
|
|
SpaVolumeBuffer *b;
|
|
SpaVolumePort *port;
|
|
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaVolume, node);
|
|
|
|
if (!CHECK_PORT (this, SPA_DIRECTION_OUTPUT, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
port = &this->out_ports[port_id];
|
|
|
|
if (port->n_buffers == 0)
|
|
return SPA_RESULT_NO_BUFFERS;
|
|
|
|
if (buffer_id >= port->n_buffers)
|
|
return SPA_RESULT_INVALID_BUFFER_ID;
|
|
|
|
b = &port->buffers[buffer_id];
|
|
if (!b->outstanding)
|
|
return SPA_RESULT_OK;
|
|
|
|
b->outstanding = false;
|
|
spa_list_insert (port->empty.prev, &b->link);
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_port_send_command (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
SpaNodeCommand *command)
|
|
{
|
|
return SPA_RESULT_NOT_IMPLEMENTED;
|
|
}
|
|
|
|
static SpaBuffer *
|
|
find_free_buffer (SpaVolume *this, SpaVolumePort *port)
|
|
{
|
|
SpaVolumeBuffer *b;
|
|
|
|
if (spa_list_is_empty (&port->empty))
|
|
return NULL;
|
|
|
|
b = spa_list_first (&port->empty, SpaVolumeBuffer, link);
|
|
spa_list_remove (&b->link);
|
|
b->outstanding = true;
|
|
|
|
return b->outbuf;
|
|
}
|
|
|
|
static void
|
|
release_buffer (SpaVolume *this, SpaBuffer *buffer)
|
|
{
|
|
SpaNodeEventReuseBuffer rb = SPA_NODE_EVENT_REUSE_BUFFER_INIT (0, buffer->id);
|
|
this->event_cb (&this->node, (SpaNodeEvent *)&rb, this->user_data);
|
|
}
|
|
|
|
static void
|
|
do_volume (SpaVolume *this, SpaBuffer *dbuf, SpaBuffer *sbuf)
|
|
{
|
|
uint32_t si, di, i, n_samples, n_bytes, soff, doff ;
|
|
SpaData *sd, *dd;
|
|
uint16_t *src, *dst;
|
|
double volume;
|
|
|
|
volume = this->props.volume;
|
|
|
|
si = di = 0;
|
|
soff = doff = 0;
|
|
|
|
while (true) {
|
|
if (si == sbuf->n_datas || di == dbuf->n_datas)
|
|
break;
|
|
|
|
sd = &sbuf->datas[si];
|
|
dd = &dbuf->datas[di];
|
|
|
|
src = (uint16_t*) ((uint8_t*)sd->data + sd->chunk->offset + soff);
|
|
dst = (uint16_t*) ((uint8_t*)dd->data + dd->chunk->offset + doff);
|
|
|
|
n_bytes = SPA_MIN (sd->chunk->size - soff, dd->chunk->size - doff);
|
|
n_samples = n_bytes / sizeof (uint16_t);
|
|
|
|
for (i = 0; i < n_samples; i++)
|
|
*src++ = *dst++ * volume;
|
|
|
|
soff += n_bytes;
|
|
doff += n_bytes;
|
|
|
|
if (soff >= sd->chunk->size) {
|
|
si++;
|
|
soff = 0;
|
|
}
|
|
if (doff >= dd->chunk->size) {
|
|
di++;
|
|
doff = 0;
|
|
}
|
|
}
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_process_input (SpaNode *node)
|
|
{
|
|
SpaVolume *this;
|
|
SpaPortInput *input;
|
|
SpaPortOutput *output;
|
|
SpaVolumePort *in_port, *out_port;
|
|
SpaBuffer *dbuf, *sbuf;
|
|
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaVolume, node);
|
|
|
|
in_port = &this->in_ports[0];
|
|
out_port = &this->out_ports[0];
|
|
|
|
if ((input = in_port->io) == NULL)
|
|
return SPA_RESULT_ERROR;
|
|
if ((output = out_port->io) == NULL)
|
|
return SPA_RESULT_ERROR;
|
|
|
|
if (!in_port->have_format) {
|
|
input->status = SPA_RESULT_NO_FORMAT;
|
|
return SPA_RESULT_ERROR;
|
|
}
|
|
if (input->buffer_id >= in_port->n_buffers) {
|
|
input->status = SPA_RESULT_INVALID_BUFFER_ID;
|
|
return SPA_RESULT_ERROR;
|
|
}
|
|
|
|
if (output->buffer_id >= out_port->n_buffers) {
|
|
dbuf = find_free_buffer (this, out_port);
|
|
} else {
|
|
dbuf = out_port->buffers[output->buffer_id].outbuf;
|
|
}
|
|
if (dbuf == NULL)
|
|
return SPA_RESULT_OUT_OF_BUFFERS;
|
|
|
|
sbuf = in_port->buffers[input->buffer_id].outbuf;
|
|
|
|
input->buffer_id = SPA_ID_INVALID;
|
|
input->status = SPA_RESULT_OK;
|
|
|
|
do_volume (this, sbuf, dbuf);
|
|
|
|
output->buffer_id = dbuf->id;
|
|
output->status = SPA_RESULT_OK;
|
|
|
|
if (sbuf != dbuf)
|
|
release_buffer (this, sbuf);
|
|
|
|
return SPA_RESULT_HAVE_OUTPUT;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_volume_node_process_output (SpaNode *node)
|
|
{
|
|
return SPA_RESULT_NEED_INPUT;
|
|
}
|
|
|
|
static const SpaNode volume_node = {
|
|
sizeof (SpaNode),
|
|
NULL,
|
|
SPA_NODE_STATE_INIT,
|
|
spa_volume_node_get_props,
|
|
spa_volume_node_set_props,
|
|
spa_volume_node_send_command,
|
|
spa_volume_node_set_event_callback,
|
|
spa_volume_node_get_n_ports,
|
|
spa_volume_node_get_port_ids,
|
|
spa_volume_node_add_port,
|
|
spa_volume_node_remove_port,
|
|
spa_volume_node_port_enum_formats,
|
|
spa_volume_node_port_set_format,
|
|
spa_volume_node_port_get_format,
|
|
spa_volume_node_port_get_info,
|
|
spa_volume_node_port_get_props,
|
|
spa_volume_node_port_set_props,
|
|
spa_volume_node_port_use_buffers,
|
|
spa_volume_node_port_alloc_buffers,
|
|
spa_volume_node_port_set_input,
|
|
spa_volume_node_port_set_output,
|
|
spa_volume_node_port_reuse_buffer,
|
|
spa_volume_node_port_send_command,
|
|
spa_volume_node_process_input,
|
|
spa_volume_node_process_output,
|
|
};
|
|
|
|
static SpaResult
|
|
spa_volume_get_interface (SpaHandle *handle,
|
|
uint32_t interface_id,
|
|
void **interface)
|
|
{
|
|
SpaVolume *this;
|
|
|
|
if (handle == NULL || interface == 0)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = (SpaVolume *) handle;
|
|
|
|
if (interface_id == this->uri.node)
|
|
*interface = &this->node;
|
|
else
|
|
return SPA_RESULT_UNKNOWN_INTERFACE;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
volume_clear (SpaHandle *handle)
|
|
{
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
volume_init (const SpaHandleFactory *factory,
|
|
SpaHandle *handle,
|
|
const SpaDict *info,
|
|
const SpaSupport *support,
|
|
uint32_t n_support)
|
|
{
|
|
SpaVolume *this;
|
|
uint32_t i;
|
|
|
|
if (factory == NULL || handle == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
handle->get_interface = spa_volume_get_interface;
|
|
handle->clear = volume_clear;
|
|
|
|
this = (SpaVolume *) handle;
|
|
|
|
for (i = 0; i < n_support; i++) {
|
|
if (strcmp (support[i].uri, SPA_ID_MAP_URI) == 0)
|
|
this->map = support[i].data;
|
|
else if (strcmp (support[i].uri, SPA_LOG_URI) == 0)
|
|
this->log = support[i].data;
|
|
}
|
|
if (this->map == NULL) {
|
|
spa_log_error (this->log, "an id-map is needed");
|
|
return SPA_RESULT_ERROR;
|
|
}
|
|
this->uri.node = spa_id_map_get_id (this->map, SPA_NODE_URI);
|
|
spa_media_types_fill (&this->uri.media_types, this->map);
|
|
spa_media_subtypes_map (this->map, &this->uri.media_subtypes);
|
|
spa_prop_audio_map (this->map, &this->uri.prop_audio);
|
|
spa_audio_formats_map (this->map, &this->uri.audio_formats);
|
|
|
|
this->node = volume_node;
|
|
reset_volume_props (&this->props);
|
|
|
|
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);
|
|
|
|
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);
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static const SpaInterfaceInfo volume_interfaces[] =
|
|
{
|
|
{ SPA_NODE_URI, },
|
|
};
|
|
|
|
static SpaResult
|
|
volume_enum_interface_info (const SpaHandleFactory *factory,
|
|
const SpaInterfaceInfo **info,
|
|
uint32_t index)
|
|
{
|
|
if (factory == NULL || info == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
switch (index) {
|
|
case 0:
|
|
*info = &volume_interfaces[index];
|
|
break;
|
|
default:
|
|
return SPA_RESULT_ENUM_END;
|
|
}
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
const SpaHandleFactory spa_volume_factory =
|
|
{ "volume",
|
|
NULL,
|
|
sizeof (SpaVolume),
|
|
volume_init,
|
|
volume_enum_interface_info,
|
|
};
|