#include "device/device.h" #include "device/buffer.h" #include "device/buffer_list.h" #include "util/opts/log.h" #include "util/opts/opts.h" device_t *device_open(const char *name, const char *path, device_hw_t *hw) { device_t *dev = calloc(1, sizeof(device_t)); dev->name = strdup(name); dev->path = strdup(path); dev->hw = hw; dev->opts.allow_dma = true; if (dev->hw->device_open(dev) < 0) { LOG_ERROR(dev, "Can't open device: %s", path); } return dev; error: device_close(dev); return NULL; } void device_close(device_t *dev) { if(dev == NULL) { return; } if (dev->capture_lists) { for (int i = 0; i < dev->n_capture_list; i++) { buffer_list_close(dev->capture_lists[i]); dev->capture_lists[i] = NULL; } free(dev->capture_lists); dev->capture_lists = NULL; } if (dev->output_list) { buffer_list_close(dev->output_list); dev->output_list = NULL; } dev->hw->device_close(dev); free(dev->name); free(dev->path); free(dev); } buffer_list_t *device_open_buffer_list(device_t *dev, bool do_capture, unsigned width, unsigned height, unsigned format, unsigned bytesperline, int nbufs, bool do_mmap) { return device_open_buffer_list2(dev, NULL, do_capture, width, height, format, bytesperline, nbufs, do_mmap); } buffer_list_t *device_open_buffer_list2(device_t *dev, const char *path, bool do_capture, unsigned width, unsigned height, unsigned format, unsigned bytesperline, int nbufs, bool do_mmap) { char name[64]; int index = 0; buffer_list_t *buf_list; if (!dev) { return NULL; } if (!dev->opts.allow_dma) { do_mmap = true; } if (do_capture) { index = dev->n_capture_list; if (index > 0) sprintf(name, "%s:capture:%d", dev->name, index); else sprintf(name, "%s:capture", dev->name); } else { if (dev->output_list) { LOG_ERROR(dev, "The output_list is already created."); } sprintf(name, "%s:output", dev->name); } buffer_format_t fmt = { .width = width, .height = height, .format = format, .bytesperline = bytesperline, .nbufs = nbufs }; buf_list = buffer_list_open(name, index, dev, path, fmt, do_capture, do_mmap); if (!buf_list) { goto error; } if (do_capture) { dev->capture_lists = reallocarray(dev->capture_lists, dev->n_capture_list+1, sizeof(buffer_list_t*)); dev->capture_lists[dev->n_capture_list++] = buf_list; } else { dev->output_list = buf_list; } return buf_list; error: buffer_list_close(buf_list); return NULL; } buffer_list_t *device_open_buffer_list_output(device_t *dev, buffer_list_t *capture_list) { if (!dev || !capture_list) { return NULL; } return device_open_buffer_list(dev, false, capture_list->fmt.width, capture_list->fmt.height, capture_list->fmt.format, capture_list->fmt.bytesperline, capture_list->nbufs, capture_list->dev->opts.allow_dma ? !capture_list->do_mmap : true); } buffer_list_t *device_open_buffer_list_capture(device_t *dev, const char *path, buffer_list_t *output_list, unsigned width, unsigned height, unsigned format, bool do_mmap) { if (!dev || !output_list) { return NULL; } return device_open_buffer_list2(dev, path, true, width ? width : output_list->fmt.width, height ? height : output_list->fmt.height, format, 0, output_list->nbufs, do_mmap); } int device_set_stream(device_t *dev, bool do_on) { // TODO: support events #if 0 struct v4l2_event_subscription sub = {0}; sub.type = V4L2_EVENT_SOURCE_CHANGE; LOG_DEBUG(dev, "Subscribing to DV-timings events ..."); ioctl_retried(dev_name(dev), dev->v4l2->dev_fd, do_on ? VIDIOC_SUBSCRIBE_EVENT : VIDIOC_UNSUBSCRIBE_EVENT, &sub); #endif for (int i = 0; i < dev->n_capture_list; i++) { if (buffer_list_set_stream(dev->capture_lists[i], do_on) < 0) { return -1; } } if (dev->output_list) { if (buffer_list_set_stream(dev->output_list, do_on) < 0) { return -1; } } return 0; } int device_consume_event(device_t *dev) { // TODO: support events #if 0 struct v4l2_event event; if (!dev) { return -1; } LOG_DEBUG(dev, "Consuming V4L2 event ..."); ERR_IOCTL(dev, dev->v4l2->dev_fd, VIDIOC_DQEVENT, &event, "Got some V4L2 device event, but where is it?"); switch (event.type) { case V4L2_EVENT_SOURCE_CHANGE: LOG_INFO(dev, "Got V4L2_EVENT_SOURCE_CHANGE: source changed"); return -1; case V4L2_EVENT_EOS: LOG_INFO(dev, "Got V4L2_EVENT_EOS: end of stream (ignored)"); return 0; } return 0; error: #endif return -1; } int device_set_decoder_start(device_t *dev, bool do_on) { if (!dev || dev->hw->device_set_decoder_start(dev, do_on) < 0) return -1; dev->decoder_started = do_on; return 0; } int device_video_force_key(device_t *dev) { if (!dev || dev->hw->device_video_force_key(dev) < 0) return -1; return 0; } void device_dump_options(device_t *dev, FILE *stream) { if (dev && dev->hw->device_dump_options) { dev->hw->device_dump_options(dev, stream); } } int device_set_fps(device_t *dev, int desired_fps) { if (!dev || dev->hw->device_set_fps(dev, desired_fps) < 0) return -1; return 0; } int device_set_rotation(device_t *dev, bool vflip, bool hflip) { if (!dev) return -1; if (dev->hw->device_set_rotation) { return dev->hw->device_set_rotation(dev, vflip, hflip); } int hret = device_set_option_string(dev, "horizontal_flip", hflip ? "1" : "0"); int vret = device_set_option_string(dev, "vertical_flip", vflip ? "1" : "0"); return hret ? hret : vret; } int device_set_option_string(device_t *dev, const char *key, const char *value) { if (!dev) { return -1; } return dev->hw->device_set_option(dev, key, value); } void device_set_option_list(device_t *dev, const char *option_list) { if (!dev || !option_list || !option_list[0]) { return; } char *start = strdup(option_list); char *string = start; char *option; while ((option = strsep(&string, OPTION_VALUE_LIST_SEP)) != NULL) { char *value = option; char *key = strsep(&value, "="); if (value) { device_set_option_string(dev, key, value); } else { LOG_INFO(dev, "Missing 'key=value' for '%s'", option); continue; } // consume all separators while (strsep(&value, "=")); } free(start); }