mirror of
https://gitlab.freedesktop.org/pipewire/pipewire.git
synced 2025-10-29 05:40:27 -04:00
Add connection message for PORT_COMMAND Add rtkit support to ask for realtime priority work on stream states and improve negotiation Rework of port linking works, keep separate state for realtime threads and use message passing to update the state. Don't try to link nodes that are removed. Open the device in the ALSA monitor to detect source or sink Implement send_command as async methods on the plugins, use async replies to sync start and stop. Work on alsa sink. Implement async PAUSE/START on v4l2 src. move the STREAMON/OFF calls to the mainloop because they have high latency, add the poll descriptors from the data loop.
1078 lines
29 KiB
C
1078 lines
29 KiB
C
/* Spa V4l2 Source
|
|
* 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 <stddef.h>
|
|
#include <sys/types.h>
|
|
#include <sys/stat.h>
|
|
#include <fcntl.h>
|
|
|
|
#include <linux/videodev2.h>
|
|
|
|
#include <spa/node.h>
|
|
#include <spa/video/format.h>
|
|
#include <spa/debug.h>
|
|
#include <spa/queue.h>
|
|
#include <spa/log.h>
|
|
#include <spa/id-map.h>
|
|
|
|
typedef struct _SpaV4l2Source SpaV4l2Source;
|
|
|
|
static const char default_device[] = "/dev/video0";
|
|
|
|
typedef struct {
|
|
SpaProps props;
|
|
char device[64];
|
|
char device_name[128];
|
|
int device_fd;
|
|
} SpaV4l2SourceProps;
|
|
|
|
static void
|
|
reset_v4l2_source_props (SpaV4l2SourceProps *props)
|
|
{
|
|
strncpy (props->device, default_device, 64);
|
|
props->props.unset_mask = 7;
|
|
}
|
|
|
|
#define MAX_BUFFERS 64
|
|
|
|
typedef struct _V4l2Buffer V4l2Buffer;
|
|
|
|
struct _V4l2Buffer {
|
|
SpaBuffer *outbuf;
|
|
SpaMetaHeader *h;
|
|
bool outstanding;
|
|
bool allocated;
|
|
struct v4l2_buffer v4l2_buffer;
|
|
V4l2Buffer *next;
|
|
};
|
|
|
|
typedef struct _V4l2Format V4l2Format;
|
|
|
|
struct _V4l2Format {
|
|
SpaFormat fmt;
|
|
SpaVideoFormat format;
|
|
SpaRectangle size;
|
|
SpaFraction framerate;
|
|
SpaVideoInterlaceMode interlace_mode;
|
|
SpaVideoColorRange color_range;
|
|
SpaVideoColorMatrix color_matrix;
|
|
SpaVideoTransferFunction transfer_function;
|
|
SpaVideoColorPrimaries color_primaries;
|
|
SpaPropInfo infos[16];
|
|
SpaPropRangeInfo ranges[16];
|
|
SpaFraction framerates[16];
|
|
};
|
|
|
|
typedef struct {
|
|
uint32_t node;
|
|
uint32_t clock;
|
|
} URI;
|
|
|
|
typedef struct {
|
|
SpaLog *log;
|
|
SpaPoll *main_loop;
|
|
SpaPoll *data_loop;
|
|
|
|
bool export_buf;
|
|
bool started;
|
|
|
|
bool next_fmtdesc;
|
|
struct v4l2_fmtdesc fmtdesc;
|
|
bool next_frmsize;
|
|
struct v4l2_frmsizeenum frmsize;
|
|
struct v4l2_frmivalenum frmival;
|
|
void *cookie;
|
|
|
|
V4l2Format format[2];
|
|
V4l2Format *current_format;
|
|
|
|
int fd;
|
|
bool opened;
|
|
struct v4l2_capability cap;
|
|
struct v4l2_format fmt;
|
|
enum v4l2_buf_type type;
|
|
enum v4l2_memory memtype;
|
|
|
|
V4l2Buffer buffers[MAX_BUFFERS];
|
|
unsigned int n_buffers;
|
|
SpaQueue ready;
|
|
|
|
SpaPollFd fds[1];
|
|
SpaPollItem poll;
|
|
|
|
SpaPortInfo info;
|
|
SpaAllocParam *params[2];
|
|
SpaAllocParamBuffers param_buffers;
|
|
SpaAllocParamMetaEnable param_meta;
|
|
SpaPortStatus status;
|
|
|
|
int64_t last_ticks;
|
|
int64_t last_monotonic;
|
|
} SpaV4l2State;
|
|
|
|
struct _SpaV4l2Source {
|
|
SpaHandle handle;
|
|
SpaNode node;
|
|
SpaClock clock;
|
|
|
|
URI uri;
|
|
SpaIDMap *map;
|
|
SpaLog *log;
|
|
|
|
uint32_t seq;
|
|
|
|
SpaV4l2SourceProps props[2];
|
|
|
|
SpaNodeEventCallback event_cb;
|
|
void *user_data;
|
|
|
|
SpaV4l2State state[1];
|
|
};
|
|
|
|
#define CHECK_PORT(this, direction, port_id) ((direction) == SPA_DIRECTION_OUTPUT && (port_id) == 0)
|
|
|
|
static void
|
|
update_state (SpaV4l2Source *this, SpaNodeState state)
|
|
{
|
|
spa_log_info (this->log, "state: %d\n", state);
|
|
this->node.state = state;
|
|
}
|
|
#include "v4l2-utils.c"
|
|
|
|
enum {
|
|
PROP_ID_DEVICE,
|
|
PROP_ID_DEVICE_NAME,
|
|
PROP_ID_DEVICE_FD,
|
|
PROP_ID_LAST,
|
|
};
|
|
|
|
static const SpaPropInfo prop_info[] =
|
|
{
|
|
{ PROP_ID_DEVICE, offsetof (SpaV4l2SourceProps, device),
|
|
"device",
|
|
SPA_PROP_FLAG_READWRITE,
|
|
SPA_PROP_TYPE_STRING, 63,
|
|
SPA_PROP_RANGE_TYPE_NONE, 0, NULL,
|
|
NULL },
|
|
{ PROP_ID_DEVICE_NAME, offsetof (SpaV4l2SourceProps, device_name),
|
|
"device-name",
|
|
SPA_PROP_FLAG_READABLE,
|
|
SPA_PROP_TYPE_STRING, 127,
|
|
SPA_PROP_RANGE_TYPE_NONE, 0, NULL,
|
|
NULL },
|
|
{ PROP_ID_DEVICE_FD, offsetof (SpaV4l2SourceProps, device_fd),
|
|
"device-fd",
|
|
SPA_PROP_FLAG_READABLE,
|
|
SPA_PROP_TYPE_UINT32, sizeof (uint32_t),
|
|
SPA_PROP_RANGE_TYPE_NONE, 0, NULL,
|
|
NULL },
|
|
};
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_get_props (SpaNode *node,
|
|
SpaProps **props)
|
|
{
|
|
SpaV4l2Source *this;
|
|
|
|
if (node == NULL || props == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
|
|
memcpy (&this->props[0], &this->props[1], sizeof (this->props[1]));
|
|
*props = &this->props[0].props;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_set_props (SpaNode *node,
|
|
const SpaProps *props)
|
|
{
|
|
SpaV4l2Source *this;
|
|
SpaV4l2SourceProps *p;
|
|
SpaResult res;
|
|
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
p = &this->props[1];
|
|
|
|
if (props == NULL) {
|
|
reset_v4l2_source_props (p);
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
res = spa_props_copy_values (props, &p->props);
|
|
|
|
return res;
|
|
}
|
|
|
|
static SpaResult
|
|
do_pause_done (SpaPoll *poll,
|
|
bool async,
|
|
uint32_t seq,
|
|
size_t size,
|
|
void *data,
|
|
void *user_data)
|
|
{
|
|
SpaV4l2Source *this = user_data;
|
|
SpaV4l2State *state = &this->state[0];
|
|
SpaNodeEventAsyncComplete *ac = data;
|
|
|
|
|
|
if (SPA_RESULT_IS_OK (ac->res))
|
|
ac->res = spa_v4l2_stream_off (this);
|
|
|
|
if (SPA_RESULT_IS_OK (ac->res)) {
|
|
state->started = false;
|
|
update_state (this, SPA_NODE_STATE_PAUSED);
|
|
}
|
|
this->event_cb (&this->node, &ac->event, this->user_data);
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
do_pause (SpaPoll *poll,
|
|
bool async,
|
|
uint32_t seq,
|
|
size_t size,
|
|
void *data,
|
|
void *user_data)
|
|
{
|
|
SpaV4l2Source *this = user_data;
|
|
SpaResult res;
|
|
SpaNodeEventAsyncComplete ac;
|
|
SpaNodeCommand *cmd = data;
|
|
|
|
res = spa_node_port_send_command (&this->node,
|
|
SPA_DIRECTION_OUTPUT,
|
|
0,
|
|
cmd);
|
|
|
|
ac.event.type = SPA_NODE_EVENT_TYPE_ASYNC_COMPLETE;
|
|
ac.event.size = sizeof (SpaNodeEventAsyncComplete);
|
|
ac.seq = seq;
|
|
ac.res = res;
|
|
spa_poll_invoke (this->state[0].main_loop,
|
|
do_pause_done,
|
|
seq,
|
|
sizeof (ac),
|
|
&ac,
|
|
this);
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
do_start_done (SpaPoll *poll,
|
|
bool async,
|
|
uint32_t seq,
|
|
size_t size,
|
|
void *data,
|
|
void *user_data)
|
|
{
|
|
SpaV4l2Source *this = user_data;
|
|
SpaV4l2State *state = &this->state[0];
|
|
SpaNodeEventAsyncComplete *ac = data;
|
|
|
|
if (SPA_RESULT_IS_OK (ac->res)) {
|
|
state->started = true;
|
|
update_state (this, SPA_NODE_STATE_STREAMING);
|
|
}
|
|
this->event_cb (&this->node, &ac->event, this->user_data);
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
do_start (SpaPoll *poll,
|
|
bool async,
|
|
uint32_t seq,
|
|
size_t size,
|
|
void *data,
|
|
void *user_data)
|
|
{
|
|
SpaV4l2Source *this = user_data;
|
|
SpaResult res;
|
|
SpaNodeEventAsyncComplete ac;
|
|
SpaNodeCommand *cmd = data;
|
|
|
|
res = spa_node_port_send_command (&this->node,
|
|
SPA_DIRECTION_OUTPUT,
|
|
0,
|
|
cmd);
|
|
|
|
ac.event.type = SPA_NODE_EVENT_TYPE_ASYNC_COMPLETE;
|
|
ac.event.size = sizeof (SpaNodeEventAsyncComplete);
|
|
ac.seq = seq;
|
|
ac.res = res;
|
|
spa_poll_invoke (this->state[0].main_loop,
|
|
do_start_done,
|
|
seq,
|
|
sizeof (ac),
|
|
&ac,
|
|
this);
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_send_command (SpaNode *node,
|
|
SpaNodeCommand *command)
|
|
{
|
|
SpaV4l2Source *this;
|
|
|
|
if (node == NULL || command == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
|
|
switch (command->type) {
|
|
case SPA_NODE_COMMAND_INVALID:
|
|
return SPA_RESULT_INVALID_COMMAND;
|
|
|
|
case SPA_NODE_COMMAND_START:
|
|
{
|
|
SpaV4l2State *state = &this->state[0];
|
|
SpaResult res;
|
|
|
|
if (state->current_format == NULL)
|
|
return SPA_RESULT_NO_FORMAT;
|
|
|
|
if (state->n_buffers == 0)
|
|
return SPA_RESULT_NO_BUFFERS;
|
|
|
|
if (state->started)
|
|
return SPA_RESULT_OK;
|
|
|
|
if ((res = spa_v4l2_stream_on (this)) < 0)
|
|
return res;
|
|
|
|
return spa_poll_invoke (this->state[0].data_loop,
|
|
do_start,
|
|
++this->seq,
|
|
command->size,
|
|
command,
|
|
this);
|
|
}
|
|
case SPA_NODE_COMMAND_PAUSE:
|
|
{
|
|
SpaV4l2State *state = &this->state[0];
|
|
|
|
if (state->current_format == NULL)
|
|
return SPA_RESULT_NO_FORMAT;
|
|
|
|
if (state->n_buffers == 0)
|
|
return SPA_RESULT_NO_BUFFERS;
|
|
|
|
if (!state->started)
|
|
return SPA_RESULT_OK;
|
|
|
|
return spa_poll_invoke (this->state[0].data_loop,
|
|
do_pause,
|
|
++this->seq,
|
|
command->size,
|
|
command,
|
|
this);
|
|
}
|
|
|
|
case SPA_NODE_COMMAND_FLUSH:
|
|
case SPA_NODE_COMMAND_DRAIN:
|
|
case SPA_NODE_COMMAND_MARKER:
|
|
return SPA_RESULT_NOT_IMPLEMENTED;
|
|
|
|
case SPA_NODE_COMMAND_CLOCK_UPDATE:
|
|
{
|
|
return SPA_RESULT_OK;
|
|
}
|
|
}
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_set_event_callback (SpaNode *node,
|
|
SpaNodeEventCallback event,
|
|
void *user_data)
|
|
{
|
|
SpaV4l2Source *this;
|
|
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
|
|
this->event_cb = event;
|
|
this->user_data = user_data;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_get_n_ports (SpaNode *node,
|
|
unsigned int *n_input_ports,
|
|
unsigned int *max_input_ports,
|
|
unsigned int *n_output_ports,
|
|
unsigned int *max_output_ports)
|
|
{
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
if (n_input_ports)
|
|
*n_input_ports = 0;
|
|
if (max_input_ports)
|
|
*max_input_ports = 0;
|
|
if (n_output_ports)
|
|
*n_output_ports = 1;
|
|
if (max_output_ports)
|
|
*max_output_ports = 1;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_get_port_ids (SpaNode *node,
|
|
unsigned int n_input_ports,
|
|
uint32_t *input_ids,
|
|
unsigned int n_output_ports,
|
|
uint32_t *output_ids)
|
|
{
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
if (n_output_ports > 0 && output_ids != NULL)
|
|
output_ids[0] = 0;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_add_port (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id)
|
|
{
|
|
return SPA_RESULT_NOT_IMPLEMENTED;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_remove_port (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id)
|
|
{
|
|
return SPA_RESULT_NOT_IMPLEMENTED;
|
|
}
|
|
|
|
static void
|
|
spa_v4l2_format_init (V4l2Format *f)
|
|
{
|
|
f->fmt.props.n_prop_info = 3;
|
|
f->fmt.props.prop_info = f->infos;
|
|
|
|
spa_prop_info_fill_video (&f->infos[0],
|
|
SPA_PROP_ID_VIDEO_FORMAT,
|
|
offsetof (V4l2Format, format));
|
|
spa_prop_info_fill_video (&f->infos[1],
|
|
SPA_PROP_ID_VIDEO_SIZE,
|
|
offsetof (V4l2Format, size));
|
|
spa_prop_info_fill_video (&f->infos[2],
|
|
SPA_PROP_ID_VIDEO_FRAMERATE,
|
|
offsetof (V4l2Format, framerate));
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_port_enum_formats (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
SpaFormat **format,
|
|
const SpaFormat *filter,
|
|
void **state)
|
|
{
|
|
SpaV4l2Source *this;
|
|
SpaResult res;
|
|
|
|
if (node == NULL || format == NULL || state == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
|
|
if (!CHECK_PORT (this, direction, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
res = spa_v4l2_enum_format (this, format, filter, state);
|
|
|
|
return res;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_port_set_format (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
SpaPortFormatFlags flags,
|
|
const SpaFormat *format)
|
|
{
|
|
SpaV4l2Source *this;
|
|
SpaV4l2State *state;
|
|
SpaResult res;
|
|
V4l2Format *f, *tf;
|
|
size_t fs;
|
|
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
|
|
if (!CHECK_PORT (this, direction, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
state = &this->state[port_id];
|
|
|
|
if (format == NULL) {
|
|
spa_v4l2_stream_off (this);
|
|
spa_v4l2_clear_buffers (this);
|
|
spa_v4l2_close (this);
|
|
state->current_format = NULL;
|
|
update_state (this, SPA_NODE_STATE_CONFIGURE);
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
f = &state->format[0];
|
|
tf = &state->format[1];
|
|
fs = sizeof (V4l2Format);
|
|
|
|
if ((SpaFormat*)f != format) {
|
|
spa_v4l2_format_init (f);
|
|
f->fmt.media_type = format->media_type;
|
|
f->fmt.media_subtype = format->media_subtype;
|
|
if ((res = spa_props_copy_values (&format->props, &f->fmt.props) < 0))
|
|
return res;
|
|
} else {
|
|
f = (V4l2Format*)format;
|
|
}
|
|
|
|
if (state->current_format) {
|
|
if (f->fmt.media_type == state->current_format->fmt.media_type &&
|
|
f->fmt.media_subtype == state->current_format->fmt.media_subtype &&
|
|
f->format == state->current_format->format &&
|
|
f->size.width == state->current_format->size.width &&
|
|
f->size.height == state->current_format->size.height)
|
|
return SPA_RESULT_OK;
|
|
|
|
if (!(flags & SPA_PORT_FORMAT_FLAG_TEST_ONLY)) {
|
|
spa_v4l2_use_buffers (this, NULL, 0);
|
|
state->current_format = NULL;
|
|
}
|
|
}
|
|
|
|
if (spa_v4l2_set_format (this, f, flags & SPA_PORT_FORMAT_FLAG_TEST_ONLY) < 0)
|
|
return SPA_RESULT_INVALID_MEDIA_TYPE;
|
|
|
|
if (!(flags & SPA_PORT_FORMAT_FLAG_TEST_ONLY)) {
|
|
memcpy (tf, f, fs);
|
|
state->current_format = tf;
|
|
|
|
update_state (this, SPA_NODE_STATE_READY);
|
|
}
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_port_get_format (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
const SpaFormat **format)
|
|
{
|
|
SpaV4l2Source *this;
|
|
SpaV4l2State *state;
|
|
|
|
if (node == NULL || format == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
|
|
if (!CHECK_PORT (this, direction, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
state = &this->state[port_id];
|
|
|
|
if (state->current_format == NULL)
|
|
return SPA_RESULT_NO_FORMAT;
|
|
|
|
*format = &state->current_format->fmt;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_port_get_info (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
const SpaPortInfo **info)
|
|
{
|
|
SpaV4l2Source *this;
|
|
|
|
if (node == NULL || info == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
|
|
if (!CHECK_PORT (this, direction, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
*info = &this->state[port_id].info;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_port_get_props (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
SpaProps **props)
|
|
{
|
|
return SPA_RESULT_NOT_IMPLEMENTED;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_port_set_props (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
const SpaProps *props)
|
|
{
|
|
return SPA_RESULT_NOT_IMPLEMENTED;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_port_use_buffers (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
SpaBuffer **buffers,
|
|
uint32_t n_buffers)
|
|
{
|
|
SpaV4l2Source *this;
|
|
SpaV4l2State *state;
|
|
SpaResult res;
|
|
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
|
|
if (!CHECK_PORT (this, direction, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
state = &this->state[port_id];
|
|
|
|
if (state->current_format == NULL)
|
|
return SPA_RESULT_NO_FORMAT;
|
|
|
|
if (state->n_buffers) {
|
|
if ((res = spa_v4l2_clear_buffers (this)) < 0)
|
|
return res;
|
|
}
|
|
if (buffers != NULL) {
|
|
if ((res = spa_v4l2_use_buffers (this, buffers, n_buffers)) < 0)
|
|
return res;
|
|
}
|
|
|
|
if (state->n_buffers)
|
|
update_state (this, SPA_NODE_STATE_PAUSED);
|
|
else
|
|
update_state (this, SPA_NODE_STATE_READY);
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_port_alloc_buffers (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
SpaAllocParam **params,
|
|
unsigned int n_params,
|
|
SpaBuffer **buffers,
|
|
unsigned int *n_buffers)
|
|
{
|
|
SpaV4l2Source *this;
|
|
SpaV4l2State *state;
|
|
SpaResult res;
|
|
|
|
if (node == NULL || buffers == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
|
|
if (!CHECK_PORT (this, direction, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
state = &this->state[port_id];
|
|
|
|
if (state->current_format == NULL)
|
|
return SPA_RESULT_NO_FORMAT;
|
|
|
|
res = spa_v4l2_alloc_buffers (this, params, n_params, buffers, n_buffers);
|
|
|
|
if (state->n_buffers) {
|
|
if (state->started)
|
|
update_state (this, SPA_NODE_STATE_STREAMING);
|
|
else
|
|
update_state (this, SPA_NODE_STATE_PAUSED);
|
|
}
|
|
|
|
return res;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_port_get_status (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
const SpaPortStatus **status)
|
|
{
|
|
SpaV4l2Source *this;
|
|
|
|
if (node == NULL || status == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
|
|
if (!CHECK_PORT (this, direction, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
*status = &this->state[port_id].status;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_port_push_input (SpaNode *node,
|
|
unsigned int n_info,
|
|
SpaPortInputInfo *info)
|
|
{
|
|
return SPA_RESULT_INVALID_PORT;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_port_pull_output (SpaNode *node,
|
|
unsigned int n_info,
|
|
SpaPortOutputInfo *info)
|
|
{
|
|
SpaV4l2Source *this;
|
|
SpaV4l2State *state;
|
|
unsigned int i;
|
|
bool have_error = false;
|
|
|
|
if (node == NULL || n_info == 0 || info == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
|
|
for (i = 0; i < n_info; i++) {
|
|
V4l2Buffer *b;
|
|
|
|
if (info[i].port_id != 0) {
|
|
info[i].status = SPA_RESULT_INVALID_PORT;
|
|
have_error = true;
|
|
continue;
|
|
}
|
|
state = &this->state[info[i].port_id];
|
|
|
|
if (state->current_format == NULL) {
|
|
info[i].status = SPA_RESULT_NO_FORMAT;
|
|
have_error = true;
|
|
continue;
|
|
}
|
|
|
|
SPA_QUEUE_POP_HEAD (&state->ready, V4l2Buffer, next, b);
|
|
if (b == NULL) {
|
|
info[i].status = SPA_RESULT_UNEXPECTED;
|
|
have_error = true;
|
|
continue;
|
|
}
|
|
b->outstanding = true;
|
|
|
|
info[i].buffer_id = b->outbuf->id;
|
|
info[i].status = SPA_RESULT_OK;
|
|
}
|
|
if (have_error)
|
|
return SPA_RESULT_ERROR;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_port_reuse_buffer (SpaNode *node,
|
|
uint32_t port_id,
|
|
uint32_t buffer_id)
|
|
{
|
|
SpaV4l2Source *this;
|
|
SpaV4l2State *state;
|
|
SpaResult res;
|
|
|
|
spa_return_val_if_fail (node != NULL, SPA_RESULT_INVALID_ARGUMENTS);
|
|
spa_return_val_if_fail (port_id == 0, SPA_RESULT_INVALID_PORT);
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
state = &this->state[port_id];
|
|
|
|
spa_return_val_if_fail (state->n_buffers > 0, SPA_RESULT_NO_BUFFERS);
|
|
spa_return_val_if_fail (buffer_id < state->n_buffers, SPA_RESULT_INVALID_BUFFER_ID);
|
|
|
|
res = spa_v4l2_buffer_recycle (this, buffer_id);
|
|
|
|
return res;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_port_send_command (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
SpaNodeCommand *command)
|
|
{
|
|
SpaV4l2Source *this;
|
|
SpaResult res;
|
|
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
|
|
if (port_id != 0)
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
switch (command->type) {
|
|
case SPA_NODE_COMMAND_PAUSE:
|
|
res = spa_v4l2_port_set_enabled (this, false);
|
|
break;
|
|
|
|
case SPA_NODE_COMMAND_START:
|
|
res = spa_v4l2_port_set_enabled (this, true);
|
|
break;
|
|
|
|
default:
|
|
res = SPA_RESULT_NOT_IMPLEMENTED;
|
|
break;
|
|
}
|
|
return res;
|
|
}
|
|
|
|
static const SpaNode v4l2source_node = {
|
|
sizeof (SpaNode),
|
|
NULL,
|
|
SPA_NODE_STATE_INIT,
|
|
spa_v4l2_source_node_get_props,
|
|
spa_v4l2_source_node_set_props,
|
|
spa_v4l2_source_node_send_command,
|
|
spa_v4l2_source_node_set_event_callback,
|
|
spa_v4l2_source_node_get_n_ports,
|
|
spa_v4l2_source_node_get_port_ids,
|
|
spa_v4l2_source_node_add_port,
|
|
spa_v4l2_source_node_remove_port,
|
|
spa_v4l2_source_node_port_enum_formats,
|
|
spa_v4l2_source_node_port_set_format,
|
|
spa_v4l2_source_node_port_get_format,
|
|
spa_v4l2_source_node_port_get_info,
|
|
spa_v4l2_source_node_port_get_props,
|
|
spa_v4l2_source_node_port_set_props,
|
|
spa_v4l2_source_node_port_use_buffers,
|
|
spa_v4l2_source_node_port_alloc_buffers,
|
|
spa_v4l2_source_node_port_get_status,
|
|
spa_v4l2_source_node_port_push_input,
|
|
spa_v4l2_source_node_port_pull_output,
|
|
spa_v4l2_source_node_port_reuse_buffer,
|
|
spa_v4l2_source_node_port_send_command,
|
|
};
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_clock_get_props (SpaClock *clock,
|
|
SpaProps **props)
|
|
{
|
|
return SPA_RESULT_NOT_IMPLEMENTED;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_clock_set_props (SpaClock *clock,
|
|
const SpaProps *props)
|
|
{
|
|
return SPA_RESULT_NOT_IMPLEMENTED;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_clock_get_time (SpaClock *clock,
|
|
int32_t *rate,
|
|
int64_t *ticks,
|
|
int64_t *monotonic_time)
|
|
{
|
|
SpaV4l2Source *this;
|
|
SpaV4l2State *state;
|
|
|
|
if (clock == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (clock, SpaV4l2Source, clock);
|
|
state = &this->state[0];
|
|
|
|
if (rate)
|
|
*rate = SPA_USEC_PER_SEC;
|
|
if (ticks)
|
|
*ticks = state->last_ticks;
|
|
if (monotonic_time)
|
|
*monotonic_time = state->last_monotonic;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static const SpaClock v4l2source_clock = {
|
|
sizeof (SpaClock),
|
|
NULL,
|
|
SPA_CLOCK_STATE_STOPPED,
|
|
spa_v4l2_source_clock_get_props,
|
|
spa_v4l2_source_clock_set_props,
|
|
spa_v4l2_source_clock_get_time,
|
|
};
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_get_interface (SpaHandle *handle,
|
|
uint32_t interface_id,
|
|
void **interface)
|
|
{
|
|
SpaV4l2Source *this;
|
|
|
|
if (handle == NULL || interface == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = (SpaV4l2Source *) handle;
|
|
|
|
if (interface_id == this->uri.node)
|
|
*interface = &this->node;
|
|
else if (interface_id == this->uri.clock)
|
|
*interface = &this->clock;
|
|
else
|
|
return SPA_RESULT_UNKNOWN_INTERFACE;
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
v4l2_source_clear (SpaHandle *handle)
|
|
{
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
v4l2_source_init (const SpaHandleFactory *factory,
|
|
SpaHandle *handle,
|
|
const SpaDict *info,
|
|
const SpaSupport *support,
|
|
unsigned int n_support)
|
|
{
|
|
SpaV4l2Source *this;
|
|
unsigned int i;
|
|
const char *str;
|
|
|
|
if (factory == NULL || handle == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
handle->get_interface = spa_v4l2_source_get_interface;
|
|
handle->clear = v4l2_source_clear,
|
|
|
|
this = (SpaV4l2Source *) 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;
|
|
else if (strcmp (support[i].uri, SPA_POLL__MainLoop) == 0)
|
|
this->state[0].main_loop = support[i].data;
|
|
else if (strcmp (support[i].uri, SPA_POLL__DataLoop) == 0)
|
|
this->state[0].data_loop = support[i].data;
|
|
}
|
|
if (this->map == NULL) {
|
|
spa_log_error (this->log, "an id-map is needed");
|
|
return SPA_RESULT_ERROR;
|
|
}
|
|
if (this->state[0].main_loop == NULL) {
|
|
spa_log_error (this->log, "a main_loop is needed");
|
|
return SPA_RESULT_ERROR;
|
|
}
|
|
if (this->state[0].data_loop == NULL) {
|
|
spa_log_error (this->log, "a data_loop is needed");
|
|
return SPA_RESULT_ERROR;
|
|
}
|
|
this->uri.node = spa_id_map_get_id (this->map, SPA_NODE_URI);
|
|
this->uri.clock = spa_id_map_get_id (this->map, SPA_CLOCK_URI);
|
|
|
|
this->node = v4l2source_node;
|
|
this->clock = v4l2source_clock;
|
|
this->props[1].props.n_prop_info = PROP_ID_LAST;
|
|
this->props[1].props.prop_info = prop_info;
|
|
reset_v4l2_source_props (&this->props[1]);
|
|
|
|
SPA_QUEUE_INIT (&this->state[0].ready);
|
|
|
|
this->state[0].log = this->log;
|
|
this->state[0].info.flags = SPA_PORT_INFO_FLAG_LIVE;
|
|
this->state[0].status.flags = SPA_PORT_STATUS_FLAG_NONE;
|
|
|
|
this->state[0].export_buf = true;
|
|
|
|
if (info && (str = spa_dict_lookup (info, "device.path"))) {
|
|
strncpy (this->props[1].device, str, 63);
|
|
this->props[1].props.unset_mask &= ~1;
|
|
}
|
|
|
|
update_state (this, SPA_NODE_STATE_CONFIGURE);
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static const SpaInterfaceInfo v4l2_source_interfaces[] =
|
|
{
|
|
{ SPA_NODE_URI, },
|
|
{ SPA_CLOCK_URI, },
|
|
};
|
|
|
|
static SpaResult
|
|
v4l2_source_enum_interface_info (const SpaHandleFactory *factory,
|
|
const SpaInterfaceInfo **info,
|
|
void **state)
|
|
{
|
|
int index;
|
|
|
|
if (factory == NULL || info == NULL || state == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
index = (*state == NULL ? 0 : *(int*)state);
|
|
|
|
if (index < 0 || index >= SPA_N_ELEMENTS (v4l2_source_interfaces))
|
|
return SPA_RESULT_ENUM_END;
|
|
|
|
*info = &v4l2_source_interfaces[index];
|
|
*(int*)state = ++index;
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
const SpaHandleFactory spa_v4l2_source_factory =
|
|
{ "v4l2-source",
|
|
NULL,
|
|
sizeof (SpaV4l2Source),
|
|
v4l2_source_init,
|
|
v4l2_source_enum_interface_info,
|
|
};
|