USB Camera 预览 拍照

USB Camera 预览 拍照USB Camera 预览（C270 YUV422） 拍照(BMP)  在Qt210,实现。

当触摸屏幕的时候，可以实现自动拍照，并把拍摄的照片（BMP格式）保存在/udisk/camtest/ 目录下

代码如下

#include <stdio.h>#include <string.h>#include <errno.h>#include <stdlib.h>#include <sys/types.h>#include <sys/stat.h>#include <fcntl.h>#include <time.h>#include <sys/mman.h>#include <assert.h>#include <linux/videodev2.h>#include <linux/fb.h>#include <pthread.h>//照相机延时等待#define TimeOut 5 //拍照 个数#define CapNum 10//设置照片宽度 高度#define CapWidth 320#define CapHeight 240//申请Buf个数#define ReqButNum 4//使用前置或者后置Camera 前置设0，后置设1#define IsRearCamera 0//设置帧率#define  FPS 10//设置格式#define PIXELFMT V4L2_PIX_FMT_YUYV#define CapDelay 100*1000#define CLEAR(x)    memset(&(x), 0, sizeof(x))typedef unsigned char BYTE;typedef unsigned short WORD;typedef unsigned int DWORD;typedef long LONG;typedef struct{void *start;int length;}BUFTYPE;struct tsp_event {struct timeval time;unsigned short type;unsigned short code;unsigned int value;};typedef struct tagBITMAPFILEHEADER {  WORD  bfType;  DWORD bfSize;  WORD  bfReserved1;  WORD  bfReserved2;  DWORD bfOffBits;}__attribute__((packed)) BITMAPFILEHEADER, *PBITMAPFILEHEADER;typedef struct tagBITMAPINFOHEADER {  DWORD biSize;  LONG  biWidth;  LONG  biHeight;  WORD  biPlanes;  WORD  biBitCount;  DWORD biCompression;  DWORD biSizeImage;  LONG  biXPelsPerMeter;  LONG  biYPelsPerMeter;  DWORD biClrUsed;  DWORD biClrImportant;}__attribute__((packed)) BITMAPINFOHEADER, *PBITMAPINFOHEADER;static BITMAPFILEHEADER file_head;static BITMAPINFOHEADER info_head;typedef struct tagRGBQUAD {  BYTE rgbBlue;  BYTE rgbGreen;  BYTE rgbRed;  BYTE rgbReserved;}__attribute__((packed)) RGBQUAD;BUFTYPE *user_buf;static int n_buffer = 0;static struct fb_var_screeninfo vinfo;static struct fb_fix_screeninfo finfo;static int lcd_buf_size;static char *fb_buf = NULL;static int tsp_fd;static pthread_t capture_tid; int display_x = 0;int display_y = 0;int save_image(){FILE *fp;static int num = 0;char picture_name[40]={'\0'};char *addr = (char *)fb_buf;int length = CapWidth * CapHeight * vinfo.bits_per_pixel / 8;int fd;int data_size;int i,j,k;char *tmp_buf;tmp_buf = (char *)malloc(length);if(tmp_buf == NULL){printf("tmp_buf alloc fail\n");exit(EXIT_FAILURE);}if(access("/udisk/camtest",0)!=0){mkdir("/udisk/camtest", 0777);}sprintf(picture_name,"/udisk/camtest/picture%d.bmp",num ++);printf("write image to sdcard:name:%s\n",picture_name);data_size = length;    file_head.bfType = 0x4d42;    file_head.bfSize = sizeof(file_head) + sizeof(info_head) + data_size;    file_head.bfReserved1 = file_head.bfReserved2 = 0;    file_head.bfOffBits = sizeof(file_head) + sizeof(info_head);            info_head.biSize = sizeof(info_head);    info_head.biWidth = CapWidth;    info_head.biHeight = CapHeight;    info_head.biPlanes = 1;    info_head.biBitCount = 32;    info_head.biCompression = 0;    info_head.biSizeImage = 0;    info_head.biXPelsPerMeter = 0;    info_head.biYPelsPerMeter = 0;    info_head.biClrUsed = 0;    info_head.biClrImportant = 0;fd = open(picture_name, O_RDWR | O_CREAT, 0644);if(fd < 0){perror("create image error\n");close (fd);exit(EXIT_FAILURE);}write(fd, &file_head, sizeof(file_head));write(fd, &info_head, sizeof(info_head));int bmpLineLenth = CapWidth * vinfo.bits_per_pixel / 8;for(i = 0; i < length; i++){tmp_buf[i] = fb_buf[(CapHeight - i/bmpLineLenth - 1) * finfo.line_length + i%bmpLineLenth];}for(i = 0; i < length; i++){fb_buf[(i/bmpLineLenth) * finfo.line_length + i%bmpLineLenth + bmpLineLenth] = tmp_buf[i] ;}write(fd, tmp_buf, length);usleep(500);close(fd);return 0;}static void *capture_thread(void *pVoid){int ret;int key_change = 0;struct tsp_event tsp_value;#define BTN_TOUCH       0x14awhile(1){printf("capture_thread\n");ret = read(tsp_fd, &tsp_value, sizeof(struct tsp_event)); /* 如果无数据则休眠 */if (ret < 0){printf("fail to read\n");return;}//如果触摸释放掉，则开始保存图片if((tsp_value.code == BTN_TOUCH) && (tsp_value.value == 0))save_image();printf("code:%04d,value:%04d\n",tsp_value.code, tsp_value.value);}}//打开摄像头设备int open_camer_device(){int fd;//非阻塞方式打开，如果打开错误，会立即返回if((fd = open("/dev/video0",O_RDWR | O_NONBLOCK)) < 0){perror("Fail to open");exit(EXIT_FAILURE);} printf("open cam success %d\n",fd);return fd;}//打开摄像头设备int open_lcd_device(){int fd;//非阻塞方式打开，如果打开错误，会立即返回if((fd = open("/dev/fb0",O_RDWR | O_NONBLOCK)) < 0){perror("Fail to open");exit(EXIT_FAILURE);} printf("open lcd success %d\n",fd);return fd;}//申请Camera Buf，并映射到用户空间，利用全局变量user_buf保存映射信息int init_mmap(int lcd_fd, int cam_fd){int i = 0;int err;int ret;struct v4l2_control ctrl;struct v4l2_requestbuffers reqbuf;    //mmap framebuffer        fb_buf = (char *)mmap(    NULL,    lcd_buf_size,    PROT_READ | PROT_WRITE,MAP_SHARED ,    lcd_fd,     0);    if(NULL == fb_buf){perror("Fail to mmap fb_buf");exit(EXIT_FAILURE);}bzero(&reqbuf,sizeof(reqbuf));reqbuf.count = ReqButNum;reqbuf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;reqbuf.memory = V4L2_MEMORY_MMAP;printf("start VIDIOC_REQBUFS\n");//申请视频缓冲区(这个缓冲区位于内核空间，需要通过mmap映射)//这一步操作可能会修改reqbuf.count的值，修改为实际成功申请缓冲区个数if(-1 == ioctl(cam_fd,VIDIOC_REQBUFS,&reqbuf)){perror("Fail to ioctl 'VIDIOC_REQBUFS'");exit(EXIT_FAILURE);}n_buffer = reqbuf.count;user_buf = calloc(reqbuf.count,sizeof(*user_buf));if(user_buf == NULL){fprintf(stderr,"Out of memory\n");exit(EXIT_FAILURE);}//将内核缓冲区映射到用户进程空间for(i = 0; i < reqbuf.count; i ++){struct v4l2_buffer buf;bzero(&buf,sizeof(buf));buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;buf.memory = V4L2_MEMORY_MMAP;buf.index = i;//查询申请到内核缓冲区的信息if(-1 == ioctl(cam_fd,VIDIOC_QUERYBUF,&buf)){perror("Fail to ioctl : VIDIOC_QUERYBUF");exit(EXIT_FAILURE);}user_buf[i].length = buf.length;user_buf[i].start = mmap(NULL,/*start anywhere*/buf.length,PROT_READ | PROT_WRITE,MAP_SHARED,cam_fd,buf.m.offset);if(MAP_FAILED == user_buf[i].start){perror("Fail to mmap\n");printf("%d\n",i);exit(EXIT_FAILURE);}//printf("start:08%lx\n",user_buf[i].start);}return 0;}//初始化视频设备int init_device(int lcd_fd, int cam_fd){struct v4l2_fmtdesc fmt;struct v4l2_capability cap;struct v4l2_format stream_fmt;struct v4l2_input input;struct v4l2_control ctrl;struct v4l2_streamparm stream;int err;int ret;if(-1 == ioctl(lcd_fd,FBIOGET_FSCREENINFO,&finfo)){perror("Fail to ioctl:FBIOGET_FSCREENINFO\n");exit(EXIT_FAILURE);}if (-1==ioctl(lcd_fd, FBIOGET_VSCREENINFO, &vinfo)) {perror("Fail to ioctl:FBIOGET_VSCREENINFO\n");exit(EXIT_FAILURE);}    lcd_buf_size = vinfo.xres * vinfo.yres * vinfo.bits_per_pixel / 8;printf("vinfo.xres:%d, vinfo.yres:%d, vinfo.bits_per_pixel:%d, lcd_buf_size:%d, finfo.line_length:%d\n",vinfo.xres, vinfo.yres, vinfo.bits_per_pixel, lcd_buf_size, finfo.line_length); memset(&fmt,0,sizeof(fmt));fmt.index = 0;fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;//枚举视频设置支持的格式while((ret = ioctl(cam_fd,VIDIOC_ENUM_FMT,&fmt)) == 0){fmt.index ++ ;printf("{pixelformat = %c%c%c%c},description = '%s'\n",fmt.pixelformat & 0xff,(fmt.pixelformat >> 8)&0xff,(fmt.pixelformat >> 16) & 0xff,(fmt.pixelformat >> 24)&0xff,fmt.description);}//查询视频设备支持的功能ret = ioctl(cam_fd,VIDIOC_QUERYCAP,&cap);if(ret < 0){perror("FAIL to ioctl VIDIOC_QUERYCAP");exit(EXIT_FAILURE);}if(!(cap.capabilities & V4L2_CAP_VIDEO_CAPTURE)){printf("The Current device is not a video capture device\n");exit(EXIT_FAILURE);}if(!(cap.capabilities & V4L2_CAP_STREAMING)){printf("The Current device does not support streaming i/o\n");exit(EXIT_FAILURE);}CLEAR(stream_fmt);//设置摄像头采集数据格式，如设置采集数据的//长,宽，图像格式(JPEG,YUYV,MJPEG等格式)stream_fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;stream_fmt.fmt.pix.width = CapWidth;stream_fmt.fmt.pix.height = CapHeight;stream_fmt.fmt.pix.pixelformat = PIXELFMT;stream_fmt.fmt.pix.field = V4L2_FIELD_INTERLACED;if(-1 == ioctl(cam_fd,VIDIOC_S_FMT,&stream_fmt)){printf("Can't set the fmt\n");perror("Fail to ioctl\n");exit(EXIT_FAILURE);}printf("VIDIOC_S_FMT successfully\n");init_mmap(lcd_fd, cam_fd);//通过S_PARM来设置FPS/* fimc_v4l2_s_parm */  CLEAR(stream);    stream.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;    stream.parm.capture.capturemode = 0;    stream.parm.capture.timeperframe.numerator = 1;    stream.parm.capture.timeperframe.denominator = FPS;    err = ioctl(cam_fd, VIDIOC_S_PARM, &stream);if(err < 0)    printf("FimcV4l2 start: error %d, VIDIOC_S_PARM", err);return 0;}int start_capturing(int cam_fd){unsigned int i;enum v4l2_buf_type type;//将申请的内核缓冲区放入一个队列中for(i = 0;i < n_buffer;i ++){struct v4l2_buffer buf;bzero(&buf,sizeof(buf));buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;buf.memory = V4L2_MEMORY_MMAP;buf.index = i;if(-1 == ioctl(cam_fd,VIDIOC_QBUF,&buf)){perror("Fail to ioctl 'VIDIOC_QBUF'");exit(EXIT_FAILURE);}}//开始采集数据type = V4L2_BUF_TYPE_VIDEO_CAPTURE;if(-1 == ioctl(cam_fd,VIDIOC_STREAMON,&type)){printf("i = %d.\n",i);perror("Fail to ioctl 'VIDIOC_STREAMON'");exit(EXIT_FAILURE);}return 0;}inline int clip(int value, int min, int max) {    return (value > max ? max : value < min ? min : value); }//将采集好的数据放到文件中int process_image(void *addr,int length){    unsigned char* in=(char*)addr;    int width=CapWidth;    int height=CapHeight;    int istride=CapWidth *2;    int x,y,j;   int y0,u,y1,v,r,g,b;    long location=0; //printf("vinfo.xoffset:%d,vinfo.yoffset:%d\n",vinfo.xoffset,vinfo.yoffset);   for ( y = 0; y < height; ++y){        for (j = 0, x=0; j < width * 2 ; j += 4,x +=2){         location = (x+display_x) * (vinfo.bits_per_pixel/8) + (y+display_y) * finfo.line_length; y0 = in[j];         u = in[j + 1] - 128;y1 = in[j + 2];                  v = in[j + 3] - 128; r = (298 * y0 + 409 * v + 128) >> 8;g = (298 * y0 - 100 * u - 208 * v + 128) >> 8;b = (298 * y0 + 516 * u + 128) >> 8;  fb_buf[ location + 0] = clip(b, 0, 255);fb_buf[ location + 1] = clip(g, 0, 255);fb_buf[ location + 2] = clip(r, 0, 255);fb_buf[ location + 3] = 255; r = (298 * y1 + 409 * v + 128) >> 8; g = (298 * y1 - 100 * u - 208 * v + 128) >> 8;b = (298 * y1 + 516 * u + 128) >> 8; fb_buf[ location + 4] = clip(b, 0, 255);fb_buf[ location + 5] = clip(g, 0, 255);  fb_buf[ location + 6] = clip(r, 0, 255);fb_buf[ location + 7] = 255;              }        in +=istride;      }//usleep(500);return 0;}int read_frame(int cam_fd){struct v4l2_buffer buf;unsigned int i;bzero(&buf,sizeof(buf));buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;buf.memory = V4L2_MEMORY_MMAP;//从Camera buf中把数据拿出来if(-1 == ioctl(cam_fd,VIDIOC_DQBUF,&buf)){perror("Fail to ioctl 'VIDIOC_DQBUF'");exit(EXIT_FAILURE);}    assert(buf.index < n_buffer);process_image(user_buf[buf.index].start,user_buf[buf.index].length);//把处理过的Buf 重新入队if(-1 == ioctl(cam_fd,VIDIOC_QBUF,&buf)){perror("Fail to ioctl 'VIDIOC_QBUF'");exit(EXIT_FAILURE);}return 1;}//利用select 进行超时处理int mainloop(int cam_fd){ int count = 1;//CapNum;clock_t startTime, finishTime;double selectTime, frameTime;while(count++  > 0){for(;;){fd_set fds;struct timeval tv;int r;//startTime = clock();FD_ZERO(&fds);FD_SET(cam_fd,&fds);/*Timeout*/tv.tv_sec = TimeOut;tv.tv_usec = 0;r = select(cam_fd + 1,&fds,NULL,NULL,&tv);if(-1 == r){if(EINTR == errno)continue;perror("Fail to select");exit(EXIT_FAILURE);}if(0 == r){fprintf(stderr,"select Timeout\n");exit(EXIT_FAILURE);}startTime = clock();if(read_frame(cam_fd)){finishTime = clock();//printf("delta:%dms\n", (finishTime - startTime)/1000);break;}}usleep(CapDelay);}return 0;}void stop_capturing(int cam_fd){enum v4l2_buf_type type;type = V4L2_BUF_TYPE_VIDEO_CAPTURE;if(-1 == ioctl(cam_fd,VIDIOC_STREAMOFF,&type)){perror("Fail to ioctl 'VIDIOC_STREAMOFF'");exit(EXIT_FAILURE);}return;}void uninit_camer_device(){unsigned int i;for(i = 0;i < n_buffer;i ++){if(-1 == munmap(user_buf[i].start, user_buf[i].length)){exit(EXIT_FAILURE);}}if (-1 == munmap(fb_buf, lcd_buf_size)) {          perror(" Error: framebuffer device munmap() failed.\n");          exit (EXIT_FAILURE) ;       }   free(user_buf);return;}void close_camer_device(int lcd_fd, int cam_fd){if(-1 == close(lcd_fd)){perror("Fail to close lcd_fd");exit(EXIT_FAILURE);}if(-1 == close(cam_fd)){perror("Fail to close cam_fd");exit(EXIT_FAILURE);}return;}int main(){ int lcd_fd;int cam_fd;if((tsp_fd = open("/dev/event0", O_RDWR)) < 0){printf("Fail to open");return -1;} lcd_fd = open_lcd_device();cam_fd = open_camer_device();pthread_create(&capture_tid,NULL,capture_thread,(void *)NULL);  init_device(lcd_fd, cam_fd);//init_mmap(lcd_fd, cam_fd);start_capturing(cam_fd);mainloop(cam_fd);stop_capturing(cam_fd);uninit_camer_device();close_camer_device(lcd_fd, cam_fd);return 0;}