97 lines
2.3 KiB
C
97 lines
2.3 KiB
C
#include "v4l2.h"
|
|
#include "device/device.h"
|
|
#include "util/opts/log.h"
|
|
|
|
int v4l2_device_open(device_t *dev)
|
|
{
|
|
dev->v4l2 = calloc(1, sizeof(device_v4l2_t));
|
|
dev->v4l2->dev_fd = -1;
|
|
dev->v4l2->subdev_fd = -1;
|
|
|
|
dev->v4l2->dev_fd = open(dev->path, O_RDWR|O_NONBLOCK);
|
|
if (dev->v4l2->dev_fd < 0) {
|
|
LOG_ERROR(dev, "Can't open device: %s", dev->path);
|
|
goto error;
|
|
}
|
|
|
|
LOG_INFO(dev, "Device path=%s fd=%d opened", dev->path, dev->v4l2->dev_fd);
|
|
|
|
LOG_DEBUG(dev, "Querying device capabilities ...");
|
|
struct v4l2_capability v4l2_cap;
|
|
ERR_IOCTL(dev, dev->v4l2->dev_fd, VIDIOC_QUERYCAP, &v4l2_cap, "Can't query device capabilities");
|
|
|
|
if (!(v4l2_cap.capabilities & V4L2_CAP_STREAMING)) {
|
|
LOG_ERROR(dev, "Device doesn't support streaming IO");
|
|
}
|
|
|
|
strcpy(dev->bus_info, (char *)v4l2_cap.bus_info);
|
|
dev->v4l2->subdev_fd = v4l2_device_open_v4l2_subdev(dev, 0);
|
|
|
|
v4l2_device_query_controls(dev, dev->v4l2->dev_fd);
|
|
v4l2_device_query_controls(dev, dev->v4l2->subdev_fd);
|
|
return 0;
|
|
|
|
error:
|
|
return -1;
|
|
}
|
|
|
|
void v4l2_device_close(device_t *dev)
|
|
{
|
|
if (dev->v4l2->subdev_fd >= 0) {
|
|
close(dev->v4l2->subdev_fd);
|
|
}
|
|
|
|
if(dev->v4l2->dev_fd >= 0) {
|
|
close(dev->v4l2->dev_fd);
|
|
}
|
|
|
|
free(dev->v4l2);
|
|
dev->v4l2 = NULL;
|
|
}
|
|
|
|
int v4l2_device_set_decoder_start(device_t *dev, bool do_on)
|
|
{
|
|
struct v4l2_decoder_cmd cmd = {0};
|
|
|
|
cmd.cmd = do_on ? V4L2_DEC_CMD_START : V4L2_DEC_CMD_STOP;
|
|
|
|
LOG_DEBUG(dev, "Setting decoder state %s...", do_on ? "Start" : "Stop");
|
|
ERR_IOCTL(dev, dev->v4l2->dev_fd, VIDIOC_DECODER_CMD, &cmd, "Cannot set decoder state");
|
|
|
|
return 0;
|
|
|
|
error:
|
|
return -1;
|
|
}
|
|
|
|
int v4l2_device_video_force_key(device_t *dev)
|
|
{
|
|
struct v4l2_control ctl = {0};
|
|
ctl.id = V4L2_CID_MPEG_VIDEO_FORCE_KEY_FRAME;
|
|
ctl.value = 1;
|
|
LOG_DEBUG(dev, "Forcing keyframe ...");
|
|
ERR_IOCTL(dev, dev->v4l2->dev_fd, VIDIOC_S_CTRL, &ctl, "Can't force keyframe");
|
|
return 0;
|
|
|
|
error:
|
|
return -1;
|
|
}
|
|
|
|
int v4l2_device_set_fps(device_t *dev, int desired_fps)
|
|
{
|
|
struct v4l2_streamparm setfps = {0};
|
|
|
|
if (!dev) {
|
|
return -1;
|
|
}
|
|
|
|
setfps.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
|
|
setfps.parm.output.timeperframe.numerator = 1;
|
|
setfps.parm.output.timeperframe.denominator = desired_fps;
|
|
LOG_DEBUG(dev, "Configuring FPS ...");
|
|
ERR_IOCTL(dev, dev->v4l2->dev_fd, VIDIOC_S_PARM, &setfps, "Can't set FPS");
|
|
return 0;
|
|
error:
|
|
return -1;
|
|
}
|