From 1fdd8901a1dfa26ffac8d7c9678e61444cbd0cd9 Mon Sep 17 00:00:00 2001 From: Tonton Th Date: Mon, 27 May 2019 17:11:43 +0200 Subject: [PATCH] pretty formating the kluge --- v4l2/v4l2grab.c | 231 ++++++++++++++++++++++++++++-------------------- 1 file changed, 135 insertions(+), 96 deletions(-) diff --git a/v4l2/v4l2grab.c b/v4l2/v4l2grab.c index 9796144..ccef514 100644 --- a/v4l2/v4l2grab.c +++ b/v4l2/v4l2grab.c @@ -30,19 +30,34 @@ size_t length; }; - static void xioctl(int fh, int request, void *arg) - { - int r; +int verbosity; - do { - r = v4l2_ioctl(fh, request, arg); - } while (r == -1 && ((errno == EINTR) || (errno == EAGAIN))); +/* --------------------------------------------------------------------- */ - if (r == -1) { - fprintf(stderr, "error %d, %s\n", errno, strerror(errno)); - exit(EXIT_FAILURE); - } - } +static void xioctl(int fh, int request, void *arg) +{ +int r; + +do { + r = v4l2_ioctl(fh, request, arg); + } while (r == -1 && ((errno == EINTR) || (errno == EAGAIN))); + +if (r == -1) { + fprintf(stderr, "error %d, %s\n", errno, strerror(errno)); + exit(EXIT_FAILURE); + } +} +/* --------------------------------------------------------------------- */ +void help(int v) +{ +puts("options :"); +puts("\t-d /dev/?\tselect video device"); +puts("\t-n NNN\t\thow many frames ?"); +puts("\t-p NNN\t\tperiod in seconds"); +puts("\t-v\t\tincrease verbosity"); +exit(0); +} +/* --------------------------------------------------------------------- */ int main(int argc, char **argv) { @@ -59,106 +74,130 @@ FILE *fout; struct buffer *buffers; - fd = v4l2_open(dev_name, O_RDWR | O_NONBLOCK, 0); - if (fd < 0) { - perror("Cannot open device"); - exit(EXIT_FAILURE); - } + int period = 10; /* delai entre les captures */ + int nbre_capt = 1; /* nombre de captures */ + int opt; - CLEAR(fmt); - fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - fmt.fmt.pix.width = 640; - fmt.fmt.pix.height = 480; - fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_RGB24; - fmt.fmt.pix.field = V4L2_FIELD_INTERLACED; - xioctl(fd, VIDIOC_S_FMT, &fmt); - if (fmt.fmt.pix.pixelformat != V4L2_PIX_FMT_RGB24) { - printf("Libv4l didn't accept RGB24 format. Can't proceed.\n"); - exit(EXIT_FAILURE); - } - if ((fmt.fmt.pix.width != 640) || (fmt.fmt.pix.height != 480)) - printf("Warning: driver is sending image at %dx%d\n", +while ((opt = getopt(argc, argv, "d:hn:p:v")) != -1) { + switch(opt) { + case 'd': dev_name = optarg; break; + case 'h': help(0); break; + case 'n': nbre_capt = atoi(optarg); break; + case 'p': period = atoi(optarg); break; + case 'v': verbosity++; break; + } + } + + + +fd = v4l2_open(dev_name, O_RDWR | O_NONBLOCK, 0); +if (fd < 0) { + perror("Cannot open device"); + exit(EXIT_FAILURE); + } + +CLEAR(fmt); +fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; +fmt.fmt.pix.width = 640; +fmt.fmt.pix.height = 480; +fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_RGB24; +fmt.fmt.pix.field = V4L2_FIELD_INTERLACED; +xioctl(fd, VIDIOC_S_FMT, &fmt); +if (fmt.fmt.pix.pixelformat != V4L2_PIX_FMT_RGB24) { + printf("Libv4l didn't accept RGB24 format. Can't proceed.\n"); + exit(EXIT_FAILURE); + } +if ((fmt.fmt.pix.width != 640) || (fmt.fmt.pix.height != 480)) { + printf("Warning: driver is sending image at %dx%d\n", fmt.fmt.pix.width, fmt.fmt.pix.height); + } - CLEAR(req); - req.count = 2; - req.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - req.memory = V4L2_MEMORY_MMAP; - xioctl(fd, VIDIOC_REQBUFS, &req); +CLEAR(req); +req.count = 2; +req.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; +req.memory = V4L2_MEMORY_MMAP; +xioctl(fd, VIDIOC_REQBUFS, &req); - buffers = calloc(req.count, sizeof(*buffers)); - for (n_buffers = 0; n_buffers < req.count; ++n_buffers) { - CLEAR(buf); +buffers = calloc(req.count, sizeof(*buffers)); +for (n_buffers = 0; n_buffers < req.count; ++n_buffers) { + CLEAR(buf); - buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - buf.memory = V4L2_MEMORY_MMAP; - buf.index = n_buffers; + buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; + buf.memory = V4L2_MEMORY_MMAP; + buf.index = n_buffers; - xioctl(fd, VIDIOC_QUERYBUF, &buf); + xioctl(fd, VIDIOC_QUERYBUF, &buf); - buffers[n_buffers].length = buf.length; - buffers[n_buffers].start = v4l2_mmap(NULL, buf.length, - PROT_READ | PROT_WRITE, MAP_SHARED, - fd, buf.m.offset); + buffers[n_buffers].length = buf.length; + buffers[n_buffers].start = v4l2_mmap(NULL, buf.length, + PROT_READ | PROT_WRITE, MAP_SHARED, + fd, buf.m.offset); - if (MAP_FAILED == buffers[n_buffers].start) { - perror("mmap"); - exit(EXIT_FAILURE); - } - } + if (MAP_FAILED == buffers[n_buffers].start) { + perror("mmap"); + exit(EXIT_FAILURE); + } + } - for (i = 0; i < n_buffers; ++i) { - CLEAR(buf); - buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - buf.memory = V4L2_MEMORY_MMAP; - buf.index = i; - xioctl(fd, VIDIOC_QBUF, &buf); - } - type = V4L2_BUF_TYPE_VIDEO_CAPTURE; +for (i = 0; i < n_buffers; ++i) { + CLEAR(buf); + buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; + buf.memory = V4L2_MEMORY_MMAP; + buf.index = i; + xioctl(fd, VIDIOC_QBUF, &buf); + } - xioctl(fd, VIDIOC_STREAMON, &type); - for (i = 0; i < 10; i++) { - do { - FD_ZERO(&fds); - FD_SET(fd, &fds); +type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - /* Timeout. */ - tv.tv_sec = 2; - tv.tv_usec = 0; +xioctl(fd, VIDIOC_STREAMON, &type); +for (i = 0; i < nbre_capt; i++) { + do { + FD_ZERO(&fds); + FD_SET(fd, &fds); - r = select(fd + 1, &fds, NULL, NULL, &tv); - } while ((r == -1 && (errno = EINTR))); - if (r == -1) { - perror("select"); - return errno; - } + /* Timeout. */ + tv.tv_sec = 2; + tv.tv_usec = 0; - CLEAR(buf); - buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - buf.memory = V4L2_MEMORY_MMAP; - xioctl(fd, VIDIOC_DQBUF, &buf); + r = select(fd + 1, &fds, NULL, NULL, &tv); + } while ((r == -1 && (errno = EINTR))); - sprintf(out_name, "out%03d.ppm", i); - fprintf(stderr, "--> %s\n", out_name); - fout = fopen(out_name, "w"); - if (!fout) { - perror("Cannot open image"); - exit(EXIT_FAILURE); - } - fprintf(fout, "P6\n%d %d 255\n", + if (r == -1) { + perror("select"); + return errno; + } + + CLEAR(buf); + buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; + buf.memory = V4L2_MEMORY_MMAP; + xioctl(fd, VIDIOC_DQBUF, &buf); + + sprintf(out_name, "out%03d.ppm", i); + if (verbosity) fprintf(stderr, "--> %s\n", out_name); + + fout = fopen(out_name, "w"); + if (!fout) { + perror("Cannot open image"); + exit(EXIT_FAILURE); + } + fprintf(fout, "P6\n%d %d 255\n", fmt.fmt.pix.width, fmt.fmt.pix.height); - fwrite(buffers[buf.index].start, buf.bytesused, 1, fout); - fclose(fout); - sleep(666); + fwrite(buffers[buf.index].start, buf.bytesused, 1, fout); + fclose(fout); + if (nbre_capt > 1 && period) { + sleep(period); + } - xioctl(fd, VIDIOC_QBUF, &buf); - } + xioctl(fd, VIDIOC_QBUF, &buf); +} - type = V4L2_BUF_TYPE_VIDEO_CAPTURE; - xioctl(fd, VIDIOC_STREAMOFF, &type); - for (i = 0; i < n_buffers; ++i) - v4l2_munmap(buffers[i].start, buffers[i].length); - v4l2_close(fd); +type = V4L2_BUF_TYPE_VIDEO_CAPTURE; +xioctl(fd, VIDIOC_STREAMOFF, &type); +for (i = 0; i < n_buffers; ++i) { + v4l2_munmap(buffers[i].start, buffers[i].length); + } - return 0; - } +v4l2_close(fd); + +return 0; +}