mirror of
				https://gitlab.freedesktop.org/pipewire/pipewire.git
				synced 2025-11-03 09:01:54 -05:00 
			
		
		
		
	
		
			
				
	
	
		
			923 lines
		
	
	
	
		
			24 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			923 lines
		
	
	
	
		
			24 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 *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;
 | 
						|
 | 
						|
  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)
 | 
						|
{
 | 
						|
  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
 | 
						|
spa_v4l2_source_node_send_command (SpaNode        *node,
 | 
						|
                                   SpaNodeCommand *command)
 | 
						|
{
 | 
						|
  SpaV4l2Source *this;
 | 
						|
  SpaResult res;
 | 
						|
 | 
						|
  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];
 | 
						|
 | 
						|
      if (state->current_format == NULL)
 | 
						|
        return SPA_RESULT_NO_FORMAT;
 | 
						|
 | 
						|
      if (state->n_buffers == 0)
 | 
						|
        return SPA_RESULT_NO_BUFFERS;
 | 
						|
 | 
						|
      if ((res = spa_v4l2_start (this)) < 0)
 | 
						|
        return res;
 | 
						|
 | 
						|
      break;
 | 
						|
    }
 | 
						|
    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 ((res = spa_v4l2_pause (this)) < 0)
 | 
						|
        return res;
 | 
						|
 | 
						|
      break;
 | 
						|
    }
 | 
						|
 | 
						|
    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_pause (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_push_event (SpaNode      *node,
 | 
						|
                                      SpaDirection  direction,
 | 
						|
                                      uint32_t      port_id,
 | 
						|
                                      SpaNodeEvent *event)
 | 
						|
{
 | 
						|
  return SPA_RESULT_NOT_IMPLEMENTED;
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
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_push_event,
 | 
						|
};
 | 
						|
 | 
						|
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__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].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,
 | 
						|
};
 |