mirror of
https://gitlab.freedesktop.org/pipewire/pipewire.git
synced 2025-10-29 05:40:27 -04:00
1024 lines
29 KiB
C
1024 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-utils.h>
|
|
#include <spa/list.h>
|
|
#include <spa/log.h>
|
|
#include <spa/loop.h>
|
|
#include <spa/id-map.h>
|
|
#include <spa/format-builder.h>
|
|
#include <lib/debug.h>
|
|
#include <lib/props.h>
|
|
|
|
typedef struct _SpaV4l2Source SpaV4l2Source;
|
|
|
|
static const char default_device[] = "/dev/video0";
|
|
|
|
typedef struct {
|
|
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);
|
|
}
|
|
|
|
#define MAX_BUFFERS 64
|
|
|
|
typedef struct _V4l2Buffer V4l2Buffer;
|
|
|
|
struct _V4l2Buffer {
|
|
SpaBuffer *outbuf;
|
|
SpaMetaHeader *h;
|
|
bool outstanding;
|
|
bool allocated;
|
|
struct v4l2_buffer v4l2_buffer;
|
|
};
|
|
|
|
typedef struct {
|
|
uint32_t node;
|
|
uint32_t clock;
|
|
SpaMediaTypes media_types;
|
|
SpaMediaSubtypes media_subtypes;
|
|
SpaMediaSubtypesVideo media_subtypes_video;
|
|
SpaPropVideo prop_video;
|
|
SpaVideoFormats video_formats;
|
|
} URI;
|
|
|
|
typedef struct {
|
|
SpaLog *log;
|
|
SpaLoop *main_loop;
|
|
SpaLoop *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;
|
|
|
|
bool have_format;
|
|
SpaVideoInfo current_format;
|
|
uint8_t format_buffer[1024];
|
|
|
|
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];
|
|
uint32_t n_buffers;
|
|
|
|
bool source_enabled;
|
|
SpaSource source;
|
|
|
|
SpaPortInfo info;
|
|
SpaAllocParam *params[2];
|
|
uint8_t params_buffer[1024];
|
|
void *io;
|
|
|
|
int64_t last_ticks;
|
|
int64_t last_monotonic;
|
|
} SpaV4l2State;
|
|
|
|
struct _SpaV4l2Source {
|
|
SpaHandle handle;
|
|
SpaNode node;
|
|
SpaClock clock;
|
|
|
|
SpaIDMap *map;
|
|
SpaLog *log;
|
|
URI uri;
|
|
|
|
uint32_t seq;
|
|
|
|
uint8_t props_buffer[512];
|
|
SpaV4l2SourceProps props;
|
|
|
|
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", 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_R(f,key,type,...) \
|
|
SPA_POD_PROP (f,key,SPA_POD_PROP_FLAG_READABLE,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_EN(f,key,type,n,...) \
|
|
SPA_POD_PROP (f,key,SPA_POD_PROP_FLAG_READWRITE | \
|
|
SPA_POD_PROP_RANGE_ENUM,type,n,__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__)
|
|
#include "v4l2-utils.c"
|
|
|
|
enum {
|
|
PROP_ID_NONE,
|
|
PROP_ID_DEVICE,
|
|
PROP_ID_DEVICE_NAME,
|
|
PROP_ID_DEVICE_FD,
|
|
};
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_get_props (SpaNode *node,
|
|
SpaProps **props)
|
|
{
|
|
SpaV4l2Source *this;
|
|
SpaPODBuilder b = { NULL, };
|
|
SpaPODFrame f[2];
|
|
|
|
if (node == NULL || props == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
|
|
spa_pod_builder_init (&b, this->props_buffer, sizeof (this->props_buffer));
|
|
spa_pod_builder_props (&b, &f[0],
|
|
PROP (&f[1], PROP_ID_DEVICE, -SPA_POD_TYPE_STRING, this->props.device, sizeof (this->props.device)),
|
|
PROP_R (&f[1], PROP_ID_DEVICE_NAME, -SPA_POD_TYPE_STRING, this->props.device_name, sizeof (this->props.device_name)),
|
|
PROP_R (&f[1], PROP_ID_DEVICE_FD, SPA_POD_TYPE_INT, this->props.device_fd));
|
|
*props = SPA_POD_BUILDER_DEREF (&b, f[0].ref, SpaProps);
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_set_props (SpaNode *node,
|
|
const SpaProps *props)
|
|
{
|
|
SpaV4l2Source *this;
|
|
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
|
|
if (props == NULL) {
|
|
reset_v4l2_source_props (&this->props);
|
|
return SPA_RESULT_OK;
|
|
} else {
|
|
spa_props_query (props,
|
|
PROP_ID_DEVICE, -SPA_POD_TYPE_STRING, this->props.device, sizeof (this->props.device),
|
|
0);
|
|
}
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
do_pause_done (SpaLoop *loop,
|
|
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->body.res.value))
|
|
ac->body.res.value = spa_v4l2_stream_off (this);
|
|
|
|
if (SPA_RESULT_IS_OK (ac->body.res.value)) {
|
|
state->started = false;
|
|
update_state (this, SPA_NODE_STATE_PAUSED);
|
|
}
|
|
this->event_cb (&this->node, (SpaNodeEvent *)ac, this->user_data);
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
do_pause (SpaLoop *loop,
|
|
bool async,
|
|
uint32_t seq,
|
|
size_t size,
|
|
void *data,
|
|
void *user_data)
|
|
{
|
|
SpaV4l2Source *this = user_data;
|
|
SpaResult res;
|
|
SpaNodeCommand *cmd = data;
|
|
|
|
res = spa_node_port_send_command (&this->node,
|
|
SPA_DIRECTION_OUTPUT,
|
|
0,
|
|
cmd);
|
|
|
|
if (async) {
|
|
SpaNodeEventAsyncComplete ac = SPA_NODE_EVENT_ASYNC_COMPLETE_INIT (seq, res);
|
|
spa_loop_invoke (this->state[0].main_loop,
|
|
do_pause_done,
|
|
seq,
|
|
sizeof (ac),
|
|
&ac,
|
|
this);
|
|
}
|
|
return res;
|
|
}
|
|
|
|
static SpaResult
|
|
do_start_done (SpaLoop *loop,
|
|
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->body.res.value)) {
|
|
state->started = true;
|
|
update_state (this, SPA_NODE_STATE_STREAMING);
|
|
}
|
|
this->event_cb (&this->node, (SpaNodeEvent *)ac, this->user_data);
|
|
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
static SpaResult
|
|
do_start (SpaLoop *loop,
|
|
bool async,
|
|
uint32_t seq,
|
|
size_t size,
|
|
void *data,
|
|
void *user_data)
|
|
{
|
|
SpaV4l2Source *this = user_data;
|
|
SpaResult res;
|
|
SpaNodeCommand *cmd = data;
|
|
|
|
res = spa_node_port_send_command (&this->node,
|
|
SPA_DIRECTION_OUTPUT,
|
|
0,
|
|
cmd);
|
|
|
|
if (async) {
|
|
SpaNodeEventAsyncComplete ac = SPA_NODE_EVENT_ASYNC_COMPLETE_INIT (seq, res);
|
|
spa_loop_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 (SPA_NODE_COMMAND_TYPE (command)) {
|
|
case SPA_NODE_COMMAND_INVALID:
|
|
return SPA_RESULT_INVALID_COMMAND;
|
|
|
|
case SPA_NODE_COMMAND_START:
|
|
{
|
|
SpaV4l2State *state = &this->state[0];
|
|
SpaResult res;
|
|
|
|
if (!state->have_format)
|
|
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_loop_invoke (this->state[0].data_loop,
|
|
do_start,
|
|
++this->seq,
|
|
SPA_POD_SIZE (command),
|
|
command,
|
|
this);
|
|
}
|
|
case SPA_NODE_COMMAND_PAUSE:
|
|
{
|
|
SpaV4l2State *state = &this->state[0];
|
|
|
|
if (!state->have_format)
|
|
return SPA_RESULT_NO_FORMAT;
|
|
|
|
if (state->n_buffers == 0)
|
|
return SPA_RESULT_NO_BUFFERS;
|
|
|
|
if (!state->started)
|
|
return SPA_RESULT_OK;
|
|
|
|
return spa_loop_invoke (this->state[0].data_loop,
|
|
do_pause,
|
|
++this->seq,
|
|
SPA_POD_SIZE (command),
|
|
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,
|
|
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 = 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,
|
|
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_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 SpaResult
|
|
spa_v4l2_source_node_port_enum_formats (SpaNode *node,
|
|
SpaDirection direction,
|
|
uint32_t port_id,
|
|
SpaFormat **format,
|
|
const SpaFormat *filter,
|
|
uint32_t index)
|
|
{
|
|
SpaV4l2Source *this;
|
|
SpaResult res;
|
|
|
|
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;
|
|
|
|
res = spa_v4l2_enum_format (this, format, filter, index);
|
|
|
|
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;
|
|
SpaVideoInfo info;
|
|
|
|
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->have_format = false;
|
|
update_state (this, SPA_NODE_STATE_CONFIGURE);
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
if ((res = spa_format_video_parse (format, &info)) < 0)
|
|
return res;
|
|
|
|
if (state->have_format) {
|
|
if (info.media_type == state->current_format.media_type &&
|
|
info.media_subtype == state->current_format.media_subtype &&
|
|
info.info.raw.format == state->current_format.info.raw.format &&
|
|
info.info.raw.size.width == state->current_format.info.raw.size.width &&
|
|
info.info.raw.size.height == state->current_format.info.raw.size.height)
|
|
return SPA_RESULT_OK;
|
|
|
|
if (!(flags & SPA_PORT_FORMAT_FLAG_TEST_ONLY)) {
|
|
spa_v4l2_use_buffers (this, NULL, 0);
|
|
state->have_format = false;
|
|
}
|
|
}
|
|
|
|
if (spa_v4l2_set_format (this, &info, flags & SPA_PORT_FORMAT_FLAG_TEST_ONLY) < 0)
|
|
return SPA_RESULT_INVALID_MEDIA_TYPE;
|
|
|
|
if (!(flags & SPA_PORT_FORMAT_FLAG_TEST_ONLY)) {
|
|
state->current_format = info;
|
|
state->have_format = true;
|
|
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;
|
|
SpaPODBuilder b = { NULL, };
|
|
SpaPODFrame f[2];
|
|
|
|
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->have_format)
|
|
return SPA_RESULT_NO_FORMAT;
|
|
|
|
b.data = state->format_buffer;
|
|
b.size = sizeof (state->format_buffer);
|
|
|
|
spa_pod_builder_push_format (&b, &f[0],
|
|
state->current_format.media_type,
|
|
state->current_format.media_subtype);
|
|
|
|
if (state->current_format.media_subtype == this->uri.media_subtypes.raw) {
|
|
spa_pod_builder_add (&b,
|
|
PROP (&f[1], this->uri.prop_video.format, SPA_POD_TYPE_URI, state->current_format.info.raw.format),
|
|
PROP (&f[1], this->uri.prop_video.size, -SPA_POD_TYPE_RECTANGLE, &state->current_format.info.raw.size),
|
|
PROP (&f[1], this->uri.prop_video.framerate, -SPA_POD_TYPE_FRACTION, &state->current_format.info.raw.framerate),
|
|
0);
|
|
}
|
|
else if (state->current_format.media_subtype == this->uri.media_subtypes_video.mjpg ||
|
|
state->current_format.media_subtype == this->uri.media_subtypes_video.jpeg) {
|
|
spa_pod_builder_add (&b,
|
|
PROP (&f[1], this->uri.prop_video.size, -SPA_POD_TYPE_RECTANGLE, &state->current_format.info.mjpg.size),
|
|
PROP (&f[1], this->uri.prop_video.framerate, -SPA_POD_TYPE_FRACTION, &state->current_format.info.mjpg.framerate),
|
|
0);
|
|
}
|
|
else if (state->current_format.media_subtype == this->uri.media_subtypes_video.h264) {
|
|
spa_pod_builder_add (&b,
|
|
PROP (&f[1], this->uri.prop_video.size, -SPA_POD_TYPE_RECTANGLE, &state->current_format.info.h264.size),
|
|
PROP (&f[1], this->uri.prop_video.framerate, -SPA_POD_TYPE_FRACTION, &state->current_format.info.h264.framerate),
|
|
0);
|
|
} else
|
|
return SPA_RESULT_NO_FORMAT;
|
|
|
|
spa_pod_builder_pop (&b, &f[0]);
|
|
|
|
*format = SPA_POD_BUILDER_DEREF (&b, f[0].ref, SpaFormat);
|
|
|
|
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->have_format)
|
|
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,
|
|
uint32_t n_params,
|
|
SpaBuffer **buffers,
|
|
uint32_t *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->have_format)
|
|
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_set_input (SpaNode *node,
|
|
uint32_t port_id,
|
|
SpaPortInput *input)
|
|
{
|
|
return SPA_RESULT_NOT_IMPLEMENTED;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_port_set_output (SpaNode *node,
|
|
uint32_t port_id,
|
|
SpaPortOutput *output)
|
|
{
|
|
SpaV4l2Source *this;
|
|
|
|
if (node == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
this = SPA_CONTAINER_OF (node, SpaV4l2Source, node);
|
|
|
|
if (!CHECK_PORT (this, SPA_DIRECTION_OUTPUT, port_id))
|
|
return SPA_RESULT_INVALID_PORT;
|
|
|
|
this->state[port_id].io = output;
|
|
|
|
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 (SPA_NODE_COMMAND_TYPE (command)) {
|
|
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 SpaResult
|
|
spa_v4l2_source_node_process_input (SpaNode *node)
|
|
{
|
|
return SPA_RESULT_INVALID_PORT;
|
|
}
|
|
|
|
static SpaResult
|
|
spa_v4l2_source_node_process_output (SpaNode *node)
|
|
{
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
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_set_input,
|
|
spa_v4l2_source_node_port_set_output,
|
|
spa_v4l2_source_node_port_reuse_buffer,
|
|
spa_v4l2_source_node_port_send_command,
|
|
spa_v4l2_source_node_process_input,
|
|
spa_v4l2_source_node_process_output,
|
|
};
|
|
|
|
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,
|
|
uint32_t n_support)
|
|
{
|
|
SpaV4l2Source *this;
|
|
uint32_t 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_LOOP__MainLoop) == 0)
|
|
this->state[0].main_loop = support[i].data;
|
|
else if (strcmp (support[i].uri, SPA_LOOP__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);
|
|
spa_media_types_fill (&this->uri.media_types, this->map);
|
|
spa_media_subtypes_map (this->map, &this->uri.media_subtypes);
|
|
spa_media_subtypes_video_map (this->map, &this->uri.media_subtypes_video);
|
|
spa_prop_video_map (this->map, &this->uri.prop_video);
|
|
spa_video_formats_map (this->map, &this->uri.video_formats);
|
|
|
|
this->node = v4l2source_node;
|
|
this->clock = v4l2source_clock;
|
|
|
|
reset_v4l2_source_props (&this->props);
|
|
|
|
this->state[0].log = this->log;
|
|
this->state[0].info.flags = SPA_PORT_INFO_FLAG_LIVE;
|
|
|
|
this->state[0].export_buf = true;
|
|
|
|
if (info && (str = spa_dict_lookup (info, "device.path"))) {
|
|
strncpy (this->props.device, str, 63);
|
|
}
|
|
|
|
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,
|
|
uint32_t index)
|
|
{
|
|
if (factory == NULL || info == NULL)
|
|
return SPA_RESULT_INVALID_ARGUMENTS;
|
|
|
|
if (index < 0 || index >= SPA_N_ELEMENTS (v4l2_source_interfaces))
|
|
return SPA_RESULT_ENUM_END;
|
|
|
|
*info = &v4l2_source_interfaces[index];
|
|
return SPA_RESULT_OK;
|
|
}
|
|
|
|
const SpaHandleFactory spa_v4l2_source_factory =
|
|
{ "v4l2-source",
|
|
NULL,
|
|
sizeof (SpaV4l2Source),
|
|
v4l2_source_init,
|
|
v4l2_source_enum_interface_info,
|
|
};
|