linux下摄像头图像数据的获取

2.6.32内核,V4L2架构

亲自测试可用

在友善之臂MINI2440开发板上测试可用

源程序如下


[cpp]  view plain copy
  1. <span style="font-size:18px;">#include <stdio.h>  
  2. #include <stdlib.h>  
  3. #include <string.h>  
  4. #include <assert.h>  
  5.   
  6. #include <getopt.h>              
  7.   
  8. #include <fcntl.h>               
  9. #include <unistd.h>  
  10. #include <errno.h>  
  11. #include <malloc.h>  
  12. #include <sys/stat.h>  
  13. #include <sys/types.h>  
  14. #include <sys/time.h>  
  15. #include <sys/mman.h>  
  16. #include <sys/ioctl.h>  
  17.   
  18. #include <asm/types.h>           
  19. #include <linux/videodev2.h>  
  20.   
  21. #define CLEAR(x) memset (&(x), 0, sizeof (x))  
  22.   
  23. struct buffer {  
  24.         void *                  start;  
  25.         size_t                  length;  
  26. };  
  27.   
  28. static char *           dev_name        = "/dev/video0";//摄像头设备名  
  29. static int              fd              = -1;  
  30. struct buffer *         buffers         = NULL;  
  31. static unsigned int     n_buffers       = 0;  
  32.   
  33. FILE *file_fd;  
  34. static unsigned long file_length;  
  35. static unsigned char *file_name;  
  36. //////////////////////////////////////////////////////  
  37. //获取一帧数据  
  38. //////////////////////////////////////////////////////  
  39. static int read_frame (void)  
  40. {  
  41.     struct v4l2_buffer buf;  
  42.     unsigned int i;  
  43.   
  44.     CLEAR (buf);  
  45.     buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;  
  46.     buf.memory = V4L2_MEMORY_MMAP;  
  47.     int ff = ioctl (fd, VIDIOC_DQBUF, &buf);  
  48.     if(ff<0)  
  49.         printf("failture\n"); //出列采集的帧缓冲  
  50.   
  51.     assert (buf.index < n_buffers);  
  52.         printf ("buf.index dq is %d,\n",buf.index);  
  53.     fwrite(buffers[buf.index].start, buffers[buf.index].length, 1, file_fd); //将其写入文件中  
  54.     
  55.     ff=ioctl (fd, VIDIOC_QBUF, &buf); //再将其入列  
  56.     if(ff<0)  
  57.         printf("failture VIDIOC_QBUF\n");   
  58.     return 1;  
  59. }  
  60.   
  61. int main (int argc,char ** argv)  
  62. {  
  63.     struct v4l2_capability cap;   
  64.     struct v4l2_format fmt;  
  65.     unsigned int i;  
  66.     enum v4l2_buf_type type;  
  67.   
  68.     file_fd = fopen("test.jpg""wb");                 //图片文件名  
  69.   
  70.     fd = open (dev_name, O_RDWR /* required */ |O_NONBLOCK);//打开设备  
  71.     if(fd<0)  
  72.     {     
  73.         perror("open faiure!");  
  74.         exit(1);  
  75.     }  
  76.     int ff=ioctl (fd, VIDIOC_QUERYCAP, &cap);               //获取摄像头参数  
  77.     if(ff<0)  
  78.         printf("failture VIDIOC_QUERYCAP\n");  
  79.   
  80.     struct v4l2_fmtdesc fmt1;  
  81.     int ret;  
  82.     memset(&fmt1, 0, sizeof(fmt1));  
  83.     fmt1.index = 0;            //初始化为0  
  84.     fmt1.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;  
  85.     while ((ret = ioctl(fd, VIDIOC_ENUM_FMT, &fmt1)) == 0)   
  86.     {  
  87.         fmt1.index++;  
  88.         printf("{ pixelformat = '%c%c%c%c', description = '%s' }\n",fmt1.pixelformat & 0xFF,   
  89.                 (fmt1.pixelformat >> 8) & 0xFF,(fmt1.pixelformat >> 16) & 0xFF,   
  90.                 (fmt1.pixelformat >> 24) & 0xFF,fmt1.description);  
  91.     }  
  92.     CLEAR (fmt);  
  93.     fmt.type                = V4L2_BUF_TYPE_VIDEO_CAPTURE;  
  94. //  fmt.fmt.pix.width       = 640;   
  95. //  fmt.fmt.pix.height      = 480;  
  96.     fmt.fmt.pix.width       = 320;   
  97.     fmt.fmt.pix.height      = 240;  
  98.     fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_JPEG;//V4L2_PIX_FMT_YUYV;//V4L2_PIX_FMT_YVU420;//V4L2_PIX_FMT_YUYV;  
  99.     fmt.fmt.pix.field       = V4L2_FIELD_INTERLACED;  
  100.     ff = ioctl (fd, VIDIOC_S_FMT, &fmt); //设置图像格式  
  101.     if(ff<0)  
  102.         printf("failture VIDIOC_S_FMT\n");  
  103.     file_length = fmt.fmt.pix.bytesperline * fmt.fmt.pix.height; //计算图片大小  
  104.   
  105.     struct v4l2_requestbuffers req;  
  106.     CLEAR (req);  
  107.     req.count               = 1;  
  108.     req.type                = V4L2_BUF_TYPE_VIDEO_CAPTURE;  
  109.     req.memory              = V4L2_MEMORY_MMAP;  
  110.   
  111.     ff=ioctl (fd, VIDIOC_REQBUFS, &req); //申请缓冲,count是申请的数量  
  112.     if(ff<0)  
  113.         printf("failture VIDIOC_REQBUFS\n");  
  114.     if (req.count < 1)  
  115.         printf("Insufficient buffer memory\n");  
  116.   
  117.     buffers = calloc (req.count, sizeof (*buffers));//内存中建立对应空间  
  118.   
  119.     for (n_buffers = 0; n_buffers < req.count; ++n_buffers)   
  120.     {  
  121.         struct v4l2_buffer buf;   //驱动中的一帧  
  122.         CLEAR (buf);  
  123.         buf.type        = V4L2_BUF_TYPE_VIDEO_CAPTURE;  
  124.         buf.memory      = V4L2_MEMORY_MMAP;  
  125.         buf.index       = n_buffers;  
  126.   
  127.         if (-1 == ioctl (fd, VIDIOC_QUERYBUF, &buf)) //映射用户空间  
  128.             printf ("VIDIOC_QUERYBUF error\n");  
  129.   
  130.         buffers[n_buffers].length = buf.length;  
  131.         buffers[n_buffers].start =  
  132.         mmap (NULL /* start anywhere */,    //通过mmap建立映射关系  
  133.             buf.length,  
  134.             PROT_READ | PROT_WRITE /* required */,  
  135.             MAP_SHARED /* recommended */,  
  136.             fd, buf.m.offset);  
  137.   
  138.         if (MAP_FAILED == buffers[n_buffers].start)  
  139.         printf ("mmap failed\n");  
  140.     }  
  141.   
  142.     for (i = 0; i < n_buffers; ++i)   
  143.     {  
  144.         struct v4l2_buffer buf;  
  145.         CLEAR (buf);  
  146.   
  147.         buf.type        = V4L2_BUF_TYPE_VIDEO_CAPTURE;  
  148.         buf.memory      = V4L2_MEMORY_MMAP;  
  149.         buf.index       = i;  
  150.   
  151.         if (-1 == ioctl (fd, VIDIOC_QBUF, &buf))//申请到的缓冲进入列队  
  152.             printf ("VIDIOC_QBUF failed\n");  
  153.     }  
  154.                   
  155.     type = V4L2_BUF_TYPE_VIDEO_CAPTURE;  
  156.   
  157.     if (-1 == ioctl (fd, VIDIOC_STREAMON, &type)) //开始捕捉图像数据  
  158.         printf ("VIDIOC_STREAMON failed\n");  
  159.   
  160.     for (;;) //这一段涉及到异步IO  
  161.     {  
  162.         fd_set fds;  
  163.         struct timeval tv;  
  164.         int r;  
  165.   
  166.         FD_ZERO (&fds);//将指定的文件描述符集清空  
  167.         FD_SET (fd, &fds);//在文件描述符集合中增加一个新的文件描述符  
  168.   
  169.        /* Timeout. */  
  170.         tv.tv_sec = 2;  
  171.         tv.tv_usec = 0;  
  172.   
  173.         r = select (fd + 1, &fds, NULL, NULL, &tv);//判断是否可读(即摄像头是否准备好),tv是定时  
  174.   
  175.         if (-1 == r)   
  176.         {  
  177.             if (EINTR == errno)  
  178.                 continue;  
  179.             printf ("select err\n");  
  180.         }  
  181.         if (0 == r)   
  182.         {  
  183.             fprintf (stderr, "select timeout\n");  
  184.             exit (EXIT_FAILURE);  
  185.         }  
  186.   
  187.         if (read_frame ())//如果可读,执行read_frame ()函数,并跳出循环  
  188.             break;  
  189.     }  
  190.   
  191. unmap:  
  192.     for (i = 0; i < n_buffers; ++i)  
  193.         if (-1 == munmap (buffers[i].start, buffers[i].length))  
  194.             printf ("munmap error");  
  195.     type = V4L2_BUF_TYPE_VIDEO_CAPTURE;     
  196.     if (-1 == ioctl(fd, VIDIOC_STREAMOFF, &type))     
  197.         printf("VIDIOC_STREAMOFF");   
  198.     close (fd);  
  199.     fclose (file_fd);  
  200. return 0;  
  201. }</span>

你可能感兴趣的:(linux下摄像头图像数据的获取)