当前位置:   article > 正文

Linux之V4L2驱动框架

v4l2驱动框架

目录

一、V4L2简介

二、V4L2操作流程

 1.打开摄像头

2.查询设备的属性/能力/功能

3.获取摄像头支持的格式

4.设置摄像头的采集通道

5.设置/获取摄像头的采集格式和参数

6.申请帧缓冲、内存映射、入队

(1)申请帧缓冲

(2)内存映射

(3)入队

7.开启视频采集

8.读取数据、对数据进行处理

9.结束视频采集

三、应用编程


一、V4L2简介

V4L2(Video for linux two)是 Linux 内核中视频类设备的一套驱动框架,为视频类设备驱动开发和应用层提供了一套统一的接口规范。使用 V4L2 设备驱动框架注册的设备会在 Linux 系统/dev/目录下生成对应的设备节点文件,设备节点的名称通常为 videoX(X 标准一个数字编号:/dev/videox),每一个 videoX 设备文件就代表一个视频类设备。应用程序通过对 videoX 设备文件进行 I/O 操作来配置、使用设备类设备。
 

二、V4L2操作流程

V4L2摄像头驱动框架的访问是通过系统IO的接口 ------ ioctl函数ioctl专用于硬件控制的系统IO的接口

#include <sys/ioctl.h>     //包含头文件
int ioctl(int fd, unsigned long request, ...);
fd: 文件描述符
request: 此参数与具体要操作的对象有关, 表示向文件描述符请求相应的操作
...: 可变参函数, 第三个参数需要根据 request 参数来决定,配合 request 来使用
返回值: 成功返回 0,失败返回-1

ioctl()是一个文件 IO 操作的杂物箱,可以处理的事情非常杂、不统一,一般用于操作特殊文件或硬件外设,可以通过 ioctl 获取外设相关信息。通过 ioctl()来完成,搭配不同的 V4L2 指令(request
参数)请求不同的操作,这些指令定义在头文件 linux/videodev2.h 中,常用的如下图。

 1.打开摄像头

视频类设备对应的设备节点为/dev/videoX, X 为数字编号,通常从 0 开始,调用 open 打开,得到文件描述符 fd。

  1. int fd = -1;
  2. fd = open("/dev/video0", O_RDWR);
  3. if (0 > fd)
  4. {
  5. perror( "open error");
  6. exit(-1);
  7. }

2.查询设备的属性/能力/功能
 

打开设备后,需要查询设备的属性,确定该设备是否是一个视频采集类设备。通过 ioctl()将获取到一个 struct v4l2_capability 类型数据, struct v4l2_capability 数据结构描述了设备的一些属性,结构体定义如下:

  1. struct v4l2_capability {
  2. __u8 driver[16]; /* 驱动的名字 */
  3. __u8 card[32]; /* 设备的名字 */
  4. __u8 bus_info[32]; /* 总线的名字 */
  5. __u32 version; /* 版本信息 */
  6. __u32 capabilities; /* 设备拥有的能力 */
  7. __u32 device_caps;
  8. __u32 reserved[3]; /* 保留字段 */
  9. };

这里关注capabilities 字段,该字段描述了设备拥有的能力,该字段的值如下

所以可以通过判断 capabilities字段是否包含 V4L2_CAP_VIDEO_CAPTURE、 来确定它是否是一个摄像头设备

  1. struct v4l2_capability cap = {};
  2. ioctl(fd,VIDIOC_QUERYCAP,&cap);
  3. if(cap.capabilities&V4L2_CAP_VIDEO_CAPTURE)
  4. {
  5. //是一个摄像头
  6. }

3.获取摄像头支持的格式

获取支持的像素格式使用 VIDIOC_ENUM_FMT 指令

  1. struct v4l2_fmtdesc {
  2. __u32 index; /*格式编号*/
  3. __u32 type; /*摄像头的格式 V4L2_BUF_TYPE_VIDEO_CAPTURE*/
  4. __u32 flags;
  5. __u8 description[32]; /*描述信息:描述 pixelformat 像素格式。*/
  6. __u32 pixelformat; /*类型格式 --- 4字节:像素格式编号*/
  7. __u32 reserved[4];
  8. };

pixelfoemat像素格式:

  1. //定义格式的宏
  2. #define v4l2_fourcc(a, b, c, d)\
  3. ((__u32)(a) | ((__u32)(b) << 8) | ((__u32)(c) << 16) | ((__u32)(d) << 24))
  4. #define V4L2_PIX_FMT_YUYV v4l2_fourcc('Y', 'U', 'Y', 'V') /* 16 YUV 4:2:2 */
  5. #define V4L2_PIX_FMT_YVYU v4l2_fourcc('Y', 'V', 'Y', 'U') /* 16 YVU 4:2:2 */
  6. #define V4L2_PIX_FMT_MJPEG v4l2_fourcc('M', 'J', 'P', 'G') /* Motion-JPEG */
  7. #define V4L2_PIX_FMT_JPEG v4l2_fourcc('J', 'P', 'E', 'G') /* JFIF JPEG */

v4l2_fourcc是 宏定义,通过这个宏以及对应的参数合成的一个u32 类型数据。

type类型:

获取设备的哪种功能对应的像素格式, 因为有些设备它可能即支持视频采集功能、又支持视频输出等其它的功能;

  1. enum v4l2_buf_type {
  2. V4L2_BUF_TYPE_VIDEO_CAPTURE = 1, //视频采集
  3. V4L2_BUF_TYPE_VIDEO_OUTPUT = 2, //视频输出
  4. V4L2_BUF_TYPE_VIDEO_OVERLAY = 3,
  5. V4L2_BUF_TYPE_VBI_CAPTURE = 4,
  6. V4L2_BUF_TYPE_VBI_OUTPUT = 5,
  7. V4L2_BUF_TYPE_SLICED_VBI_CAPTURE = 6,
  8. V4L2_BUF_TYPE_SLICED_VBI_OUTPUT = 7,
  9. V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY = 8,
  10. V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE = 9,
  11. V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE = 10,
  12. V4L2_BUF_TYPE_SDR_CAPTURE = 11,
  13. V4L2_BUF_TYPE_SDR_OUTPUT = 12,
  14. V4L2_BUF_TYPE_META_CAPTURE = 13,
  15. /* Deprecated, do not use */
  16. V4L2_BUF_TYPE_PRIVATE = 0x80,
  17. };

type 字 段 需 要 在 调 用 ioctl() 之 前 设 置 它 的 值 , 对 于 摄 像 头 , 需 要 将 type 字 段 设 置 为V4L2_BUF_TYPE_VIDEO_CAPTURE,指定将要获取的是视频采集的像素格式

  1. struct v4l2_fmtdesc fmt = {};
  2. fmt.index = 0;//第一种格式
  3. fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;//获取摄像头的格式
  4. ioctl(fd,VIDIOC_ENUM_FMT,&fmt);

4.设置摄像头的采集通道

  1. int index = 0;//使用通道0
  2. ioctl(fd,VIDIOC_S_INPUT,&index);

5.设置/获取摄像头的采集格式和参数

使用 VIDIOC_G_FMT 指令查看设备当期的格式和使用 VIDIOC_S_FMT 指令设置设备的格式;

  1. int ioctl(int fd, VIDIOC_G_FMT, struct v4l2_format *fmt);
  2. int ioctl(int fd, VIDIOC_S_FMT, struct v4l2_format *fmt);

ioctl()会将获取到的数据写入到 fmt 指针所指向的对象中或者会使用 fmt 所指对象的数据去设置设备的格式, struct v4l2_format 结构体描述了格式相关的信息

  1. struct v4l2_format {
  2. __u32 type;//V4L2_BUF_TYPE_VIDEO_CAPTURE
  3. union {
  4. struct v4l2_pix_format pix; /* V4L2_BUF_TYPE_VIDEO_CAPTURE */
  5. struct v4l2_pix_format_mplane pix_mp; /* V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE */
  6. struct v4l2_window win; /* V4L2_BUF_TYPE_VIDEO_OVERLAY */
  7. struct v4l2_vbi_format vbi; /* V4L2_BUF_TYPE_VBI_CAPTURE */
  8. struct v4l2_sliced_vbi_format sliced; /* V4L2_BUF_TYPE_SLICED_VBI_CAPTURE */
  9. struct v4l2_sdr_format sdr; /* V4L2_BUF_TYPE_SDR_CAPTURE */
  10. __u8 raw_data[200]; /* user-defined */
  11. } fmt;
  12. };
  13. struct v4l2_pix_format {
  14. __u32 width;//像素宽度
  15. __u32 height;//像素高度
  16. __u32 pixelformat;//采集格式 V4L2_PIX_FMT_YVYU
  17. __u32 field; /* V4L2_FIELD_NONE */
  18. __u32 bytesperline; /* for padding, zero if unused */
  19. __u32 sizeimage;
  20. __u32 colorspace; /* enum v4l2_colorspace */
  21. __u32 priv; /* private data, depends on pixelformat */
  22. __u32 flags; /* format flags (V4L2_PIX_FMT_FLAG_*) */
  23. __u32 ycbcr_enc; /* enum v4l2_ycbcr_encoding */
  24. __u32 quantization; /* enum v4l2_quantization */
  25. __u32 xfer_func; /* enum v4l2_xfer_func */
  26. };

type 字段依然与前面介绍的结构体中的 type 字段意义相同,不管是获取格式、还是设置格式都需要在调用 ioctl()函数之前设置它的值。接下来是一个 union 共用体,当 type 被设置为V4L2_BUF_TYPE_VIDEO_CAPTURE 时, pix 变量生效,它是一个 struct v4l2_pix_format 类型变量,记录了视频帧格式相关的信息。

获取当前的格式、并设置格式:

  1. struct v4l2_format format = {};
  2. format.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  3. format.fmt.pix.width = 640;
  4. format.fmt.pix.height = 480;
  5. format.fmt.pix.pixelformat = V4L2_PIX_FMT_YUYV;
  6. format.fmt.pix.field= V4L2_FIELD_NONE ;
  7. ioctl(fd,VIDIOC_S_FMT,&format); //S:set


6.申请帧缓冲、内存映射、入队

(1)申请帧缓冲

读取摄像头数据的方式有两种:一种是 read 方式,直接通过 read()系统调用读取摄像头采集到的数据;另一种是 streaming 方式。使用 VIDIOC_QUERYCAP 指令查询设备的属性、得到一个 struct v4l2_capability 类型数据, 其中 capabilities 字段记录了设备拥有的能力,当该字段包含
V4L2_CAP_READWRITE 时,表示设备支持 read I/O 方式读取数据;当该字段包含V4L2_CAP_STREAMING时,表示设备支持 streaming I/O 方式;使用streaming I/O 方式,需要向设备申请帧缓冲,并将帧缓冲映射到应用程序进程地址空间中

 使用 VIDIOC_REQBUFS 指令可申请帧缓冲:

ioctl(int fd, VIDIOC_REQBUFS, struct v4l2_requestbuffers *reqbuf);

调用 ioctl()需要传入一个 struct v4l2_requestbuffers *指针, struct v4l2_requestbuffers 结构体描述了申请帧缓冲的信息, ioctl()会根据 reqbuf 所指对象填充的信息进行申请。
 

  1. struct v4l2_requestbuffers {
  2. __u32 count;//缓冲区块数 ----- 4
  3. __u32 type; /* enum v4l2_buf_type */
  4. __u32 memory; /* enum v4l2_memory */
  5. __u32 reserved[2];
  6. };

type 字段与前面所提及到的 type 字段意义相同,count 字段用于指定申请帧缓冲的数量
memory 字段可取值如下:

  1. enum v4l2_memory {
  2. V4L2_MEMORY_MMAP = 1,
  3. V4L2_MEMORY_USERPTR = 2,
  4. V4L2_MEMORY_OVERLAY = 3,
  5. V4L2_MEMORY_DMABUF = 4,
  6. };

通常将 memory 设置为 V4L2_MEMORY_MMAP
申请缓存:

  1. struct v4l2_requestbuffers req = {};
  2. req.count = 4; //申请4个帧缓存
  3. req.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  4. req.memory = V4L2_MEMORY_MMAP;
  5. ioctl(fd,VIDIOC_REQBUFS,&req);

streaming I/O 方式会在内核空间中维护一个帧缓冲队列, 驱动程序会将从摄像头读取的一帧数据写入到队列中的一个帧缓冲,接着将下一帧数据写入到队列中的下一个帧缓冲;当应用程序需要读取一帧数据时,需要从队列中取出一个装满一帧数据的帧缓冲,这个取出过程就叫做出队;当应用程序处理完这一帧数据后,需要再把这个帧缓冲加入到内核的帧缓冲队列中,这个过程叫做入队。

使用 VIDIOC_REQBUFS 指令申请帧缓冲, 该缓冲区是由内核所维护的,应用程序不能直接读取该缓冲区的数据,需要将其映射到用户空间中,应用程序读取映射区的数据实际上是读取内核维护的帧缓冲中的数据。

(2)内存映射

在映射之前,需要查询帧缓冲的信息:帧缓冲的长度、偏移量。使用VIDIOC_QUERYBUF指令查询:

ioctl(int fd, VIDIOC_QUERYBUF, struct v4l2_buffer *buf);

调用 ioctl()需要传入一个 struct v4l2_buffer *指针, struct v4l2_buffer 结构体描述了帧缓冲的信息, ioctl()会将获取到的数据写入到 buf 指针所指的对象中。

  1. struct v4l2_buffer {
  2. __u32 index;//编号
  3. __u32 type;//V4L2_BUF_TYPE_VIDEO_CAPTURE
  4. __u32 bytesused;//使用的字节数
  5. __u32 flags;
  6. __u32 field;
  7. struct timeval timestamp;
  8. struct v4l2_timecode timecode;
  9. __u32 sequence;
  10. /* memory location */
  11. __u32 memory;//V4L2_MEMORY_MMAP
  12. union {
  13. __u32 offset;//偏移
  14. unsigned long userptr;
  15. struct v4l2_plane *planes;
  16. __s32 fd;
  17. } m;
  18. __u32 length;//长度
  19. __u32 reserved2;
  20. __u32 reserved;
  21. };


index 字段表示一个编号, 申请的多个帧缓冲、 每一个帧缓冲都有一个编号,从 0 开始。一次 ioctl()调用只能获取指定编号对应的帧缓冲的信息,所以要获取多个帧缓冲的信息,需要重复调用多次,每调用一次ioctl()、 index 加 1,指向下一个帧缓冲。

type 字段和memory 字段与前面介绍的一样。length 字段表示帧缓冲的长度,共同体中的 offset 表示帧缓冲的偏移量。因为应用程序通过 VIDIOC_REQBUFS 指令申请帧缓冲时,内核会向操作系统申请一块内存空间作为帧缓冲区,内存空间的大小就等于申请的帧缓冲数量 * 每一个帧缓冲的大小,每一个帧缓冲对应到这一块内存空间的某一段,所以它们都有一个地址偏移量。
 

申请帧缓冲后、调用 mmap()将帧缓冲映射到用户地址空间
 

  1. struct v4l2_buffer buf = {};
  2. buf.index = xxx;//0~3
  3. but.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  4. buf.memory = V4L2_MEMORY_MMAP;
  5. ioctl(fd,VIDIOC_QUERYBUF,&buf);
  6. //映射到用户空间
  7. mmap(NULL,buf.length,.......,fd,buf.m.offset);

(3)入队

使用 VIDIOC_QBUF 指令将帧缓冲放入到内核的帧缓冲队列中,调用 ioctl()之前,需要设置 struct v4l2_buffer 类型对象的 memory、 type 字段

ioctl(fd,VIDIOC_QBUF,&buf);

7.开启视频采集

使用 VIDIOC_DQBUF 指令开启视频采集,

  1. ioctl(int fd, VIDIOC_STREAMON, int *type); //开启视频采集
  2. ioctl(int fd, VIDIOC_STREAMOFF, int *type); //停止视频采集
  1. enum v4l2_buf_type buf_type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  2. ioctl(fd,VIDIOC_STREAMON,&buf_type);

8.读取数据、对数据进行处理

开启视频采集之后,便可以去读取数据 ,直接读取每一个帧缓冲的在用户空间的映射区即可读取到摄像头采集的每一帧图像数据。在读取数据之前,需要将帧缓冲从内核的帧缓冲队列中取出,这个操作叫做帧缓冲出队。帧缓冲出队,便可读取数据,对数据进行处理:将摄像头采集的图像显示到 LCD屏上;数据处理完成之后,再将帧缓冲入队,往复操作。

使用 VIDIOC_DQBUF 指令执行出队操作

ioctl(int fd, VIDIOC_DQBUF, struct v4l2_buffer *buf);
  1. while(1){
  2. //从采集队列中取出一帧
  3. ioctl(fd,VIDIOC_DQBUF,&buf);
  4. //将该帧的数据拷贝走
  5. memcpy(....);
  6. //将取出的一帧放回队列
  7. ioctl(fd,VIDIOC_QBUF,&buf);
  8. //显示,存储......
  9. }

9.结束视频采集

结束视频采集,使用 VIDIOC_STREAMOFF 指令

  1. enum v4l2_buf_type buf_type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  2. ioctl(fd,VIDIOC_STREAMOFF,&buf_type);
  3. //解除映射
  4. //关闭设备文件

三、应用编程

  1. #include <stdio.h>
  2. #include <stdlib.h>
  3. #include <fcntl.h>
  4. #include <sys/types.h>
  5. #include <sys/stat.h>
  6. #include <unistd.h>
  7. #include <sys/ioctl.h>
  8. #include <linux/videodev2.h>
  9. #include <sys/mman.h>
  10. #include <string.h>
  11. typedef struct{
  12. char *start;
  13. size_t length;
  14. }buffer_t;
  15. buffer_t buffer[4];
  16. buffer_t current;//保存当前取出的一帧
  17. int lcd_fd;
  18. int *memp;
  19. unsigned int sign3 = 0;
  20. int yuyv2rgb(int y, int u, int v)
  21. {
  22. unsigned int pixel24 = 0;
  23. unsigned char *pixel = (unsigned char *)&pixel24;
  24. int r, g, b;
  25. static int ruv, guv, buv;
  26. if(sign3)
  27. {
  28. sign3 = 0;
  29. ruv = 1159*(v-128);
  30. guv = 380*(u-128) + 813*(v-128);
  31. buv = 2018*(u-128);
  32. }
  33. r = (1164*(y-16) + ruv) / 1000;
  34. g = (1164*(y-16) - guv) / 1000;
  35. b = (1164*(y-16) + buv) / 1000;
  36. if(r > 255) r = 255;
  37. if(g > 255) g = 255;
  38. if(b > 255) b = 255;
  39. if(r < 0) r = 0;
  40. if(g < 0) g = 0;
  41. if(b < 0) b = 0;
  42. pixel[0] = r;
  43. pixel[1] = g;
  44. pixel[2] = b;
  45. return pixel24;
  46. }
  47. int yuyv2rgb0(unsigned char *yuv, unsigned char *rgb, unsigned int width, unsigned int height)
  48. {
  49. unsigned int in, out;
  50. int y0, u, y1, v;
  51. unsigned int pixel24;
  52. unsigned char *pixel = (unsigned char *)&pixel24;
  53. unsigned int size = width*height*2;
  54. for(in = 0, out = 0; in < size; in += 4, out += 6)
  55. {
  56. y0 = yuv[in+0];
  57. u = yuv[in+1];
  58. y1 = yuv[in+2];
  59. v = yuv[in+3];
  60. sign3 = 1;
  61. pixel24 = yuyv2rgb(y0, u, v);
  62. rgb[out+0] = pixel[0];
  63. rgb[out+1] = pixel[1];
  64. rgb[out+2] = pixel[2];
  65. pixel24 = yuyv2rgb(y1, u, v);
  66. rgb[out+3] = pixel[0];
  67. rgb[out+4] = pixel[1];
  68. rgb[out+5] = pixel[2];
  69. }
  70. return 0;
  71. }
  72. //LCD初始化
  73. void lcd_init()
  74. {
  75. lcd_fd = open("/dev/fb0",O_RDWR);
  76. if(lcd_fd==-1){
  77. perror("open");;
  78. exit(-1);
  79. }
  80. //映射
  81. memp = mmap(NULL,800*480*4,PROT_READ|PROT_WRITE,MAP_SHARED,lcd_fd,0);
  82. if(memp==MAP_FAILED){
  83. perror("mmap");;
  84. exit(-1);
  85. }
  86. }
  87. void lcd_uninit()
  88. {
  89. munmap(memp,800*480*4);
  90. close(lcd_fd);
  91. }
  92. int main()
  93. {
  94. lcd_init();
  95. //1.打开摄像头
  96. int fd = open("/dev/video7",O_RDWR);
  97. if(fd==-1){
  98. perror("open");
  99. exit(-1);
  100. }
  101. //2.获取功能参数
  102. struct v4l2_capability cap = {};
  103. int res = ioctl(fd,VIDIOC_QUERYCAP,&cap);
  104. if(res==-1){
  105. perror("ioctl cap");
  106. exit(-1);
  107. }
  108. if(cap.capabilities&V4L2_CAP_VIDEO_CAPTURE){
  109. //设备是一个摄像头
  110. printf("capture device!\n");
  111. }
  112. else{
  113. printf("not a capture device!\n");
  114. exit(-1);
  115. }
  116. //3.获取摄像头支持的格式
  117. struct v4l2_fmtdesc fmt = {};
  118. fmt.index = 0;//第一种格式
  119. fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;//获取摄像头的格式
  120. while((res=ioctl(fd,VIDIOC_ENUM_FMT,&fmt))==0){
  121. printf("pixformat=%c%c%c%c,description=%s\n",fmt.pixelformat&0xff,(fmt.pixelformat>>8)&0xff,
  122. (fmt.pixelformat>>16)&0xff,(fmt.pixelformat>>24)&0xff,fmt.description);
  123. fmt.index++;
  124. }
  125. //4.设置采集通道
  126. int index = 0;//使用通道0
  127. res = ioctl(fd,VIDIOC_S_INPUT,&index);
  128. if(res==-1){
  129. perror("ioctl s_input");
  130. exit(-1);
  131. }
  132. //5.设置摄像头的采集格式
  133. struct v4l2_format format = {};
  134. format.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  135. format.fmt.pix.width = 640;
  136. format.fmt.pix.height = 480;
  137. format.fmt.pix.pixelformat = V4L2_PIX_FMT_YUYV;//YUYV格式
  138. format.fmt.pix.field= V4L2_FIELD_NONE;
  139. res = ioctl(fd,VIDIOC_S_FMT,&format);
  140. if(res==-1){
  141. perror("ioctl s_fmt");
  142. exit(-1);
  143. }
  144. //6.申请缓存空间
  145. struct v4l2_requestbuffers req = {};
  146. req.count = 4;
  147. req.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  148. req.memory = V4L2_MEMORY_MMAP;
  149. res = ioctl(fd,VIDIOC_REQBUFS,&req);
  150. if(res==-1){
  151. perror("ioctl reqbufs");
  152. exit(-1);
  153. }
  154. //7.分配,映射,入队
  155. size_t i,max_len = 0;
  156. for(i=0;i<4;i++){
  157. struct v4l2_buffer buf = {};
  158. buf.index = i;//0~3
  159. buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  160. buf.memory = V4L2_MEMORY_MMAP;
  161. res = ioctl(fd,VIDIOC_QUERYBUF,&buf);
  162. if(res==-1){
  163. perror("ioctl querybuf");
  164. exit(-1);
  165. }
  166. //记录最大长度
  167. if(buf.length>max_len)
  168. max_len = buf.length;
  169. //映射
  170. buffer[i].length = buf.length;
  171. buffer[i].start = mmap(NULL,buf.length,PROT_READ|PROT_WRITE,MAP_SHARED,fd,buf.m.offset);
  172. if(buffer[i].start==MAP_FAILED){
  173. perror("mmap");
  174. exit(-1);
  175. }
  176. //入队
  177. res = ioctl(fd,VIDIOC_QBUF,&buf);
  178. if(res==-1){
  179. perror("ioctl qbuf");
  180. exit(-1);
  181. }
  182. }
  183. //申请临时缓冲区
  184. current.start = malloc(max_len);
  185. if(current.start==NULL){
  186. perror("malloc");
  187. exit(-1);
  188. }
  189. //8.启动摄像头
  190. enum v4l2_buf_type buf_type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  191. res = ioctl(fd,VIDIOC_STREAMON,&buf_type);
  192. if(res==-1){
  193. perror("ioctl streamon");
  194. exit(-1);
  195. }
  196. //延时
  197. sleep(1);
  198. //RGB缓冲区
  199. char rgb[640*480*3];
  200. //9.采集数据
  201. while(1){
  202. struct v4l2_buffer buf = {};
  203. buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  204. buf.memory = V4L2_MEMORY_MMAP;
  205. //出队
  206. res = ioctl(fd,VIDIOC_DQBUF,&buf);
  207. if(res==-1){
  208. perror("ioctl dqbuf");
  209. }
  210. //拷贝数据
  211. memcpy(current.start,buffer[buf.index].start,buf.bytesused);
  212. current.length = buf.bytesused;
  213. //入队
  214. res = ioctl(fd,VIDIOC_QBUF,&buf);
  215. if(res==-1){
  216. perror("ioctl qbuf");
  217. }
  218. //显示 保存 传输.....
  219. //YUYV转RGB
  220. yuyv2rgb0(current.start,rgb,640,480);
  221. //显示到LCD
  222. int x,y;
  223. for(y=0;y<480;y++){
  224. for(x=0;x<640;x++){
  225. *(memp+y*800+x) = rgb[3*(y*640+x)]<<16 | rgb[3*(y*640+x)+1]<<8 | rgb[3*(y*640+x)+2];
  226. }
  227. }
  228. }
  229. //10.关闭摄像头采集
  230. buf_type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  231. res = ioctl(fd,VIDIOC_STREAMOFF,&buf_type);
  232. if(res==-1){
  233. perror("ioctl streamoff");
  234. exit(-1);
  235. }
  236. //解除映射
  237. for(i=0;i<4;i++){
  238. munmap(buffer[i].start,buffer[i].length);
  239. }
  240. free(current.start);
  241. close(fd);
  242. lcd_uninit();
  243. return 0;
  244. }

声明:本文内容由网友自发贡献,不代表【wpsshop博客】立场,版权归原作者所有,本站不承担相应法律责任。如您发现有侵权的内容,请联系我们。转载请注明出处:https://www.wpsshop.cn/w/我家自动化/article/detail/444440
推荐阅读
相关标签
  

闽ICP备14008679号