基于飞凌2440linux 的摄像头采集源码

#include <stdio.h> #include <stdlib.h> #include <unistd.h> #include <error.h> #include <assert.h> #include <fcntl.h> #include <sys/ioctl.h> #include <sys/mman.h> #include "v4l.h" #define FALSE 0 #define TRUE -1 #define DEFAULT_DEVICE "/dev/video0" int v4l_open(char *dev, v4l_device *vd) { if (!dev) dev = DEFAULT_DEVICE; if ((vd->fd = open(dev, O_RDWR)) < 0) { perror("v4l_open:"); return -1; } if (v4l_get_capability(vd)) return -1; if (v4l_get_picture(vd)) return -1; return 0; } int v4l_grab_picture(v4l_device *vd, unsigned int size) { if (read(vd->fd, &(vd->map), size) == 0) return -1; return 0; } int v4l_get_capability(v4l_device *vd) { if (ioctl(vd->fd, VIDIOCGCAP, &(vd->capability)) < 0) { perror("v4l_get_capability:"); return -1; } return 0; } /* norm: VIDEO_MODE_PAL | VIDEO_MODE_NTSC | VIDEO_MODE_SECAM | VIDEO_MODE_AUTO (see videodev.h) */ int v4l_set_norm(v4l_device *vd, int norm) { int i; for (i = 0; i < vd->capability.channels; i++) { vd->channel[i].norm = norm; //vd->channel[i].type = VIDEO_TYPE_TV; //default (VIDEO_TYPE_TV | VIDEO_TYPE_CAMERA) } if (v4l_get_capability(vd)) { perror("v4l_set_norm"); return -1; } if (v4l_get_picture(vd)) { perror("v4l_set_norm"); } return 0; } int v4l_get_channels(v4l_device *vd) { int i; for (i = 0; i < vd->capability.channels; i++) { vd->channel[i].channel = i; if (ioctl(vd->fd, VIDIOCGCHAN, &(vd->channel[i])) < 0) { perror("v4l_get_channel:"); return -1; } } return 0; } /* * v4l_switch_channel - select (switch) the video source * * c: the channel number */ int v4l_switch_channel(v4l_device *vd, int c) { if (ioctl(vd->fd, VIDIOCSCHAN, &(vd->channel[c])) < 0) { perror("v4l_switch_channel:"); return -1; } return 0; } int v4l_get_audios(v4l_device *vd) { int i; for (i = 0; i < vd->capability.audios; i++) { vd->audio[i].audio = i; if (ioctl(vd->fd, VIDIOCGAUDIO, &(vd->audio[i])) < 0) { perror("v4l_get_audio:"); return -1; } } return 0; } int v4l_get_picture(v4l_device *vd) { if (ioctl(vd->fd, VIDIOCGPICT, &(vd->picture)) < 0) { perror("v4l_get_picture"); return -1; } return 0; } /* ...may be not necessarily... */ int v4l_set_picture(v4l_device *vd, int br, int hue, int col, int cont, int white) { if (br) vd->picture.brightness = br; if (hue) vd->picture.hue = hue; if (col) vd->picture.colour = col; if (cont) vd->picture.contrast = cont; if (white) vd->picture.whiteness = white; if(ioctl(vd->fd, VIDIOCSPICT, &(vd->picture)) < 0) { perror("v4l_set_picture"); return -1; } return 0; } int v4l_close(v4l_device *vd) { close(vd->fd); return 0; } int v4l_get_mbuf(v4l_device *vd) { if (ioctl(vd->fd, VIDIOCGMBUF, &(vd->mbuf)) < 0) { perror("v4l_get_mbuf"); return -1; } return 0; } int v4l_mmap_init(v4l_device *vd) { //vd->mbuf.size = 0x151000; //vd->mbuf.offsets[0] = 0; if (v4l_get_mbuf(vd) < 0) return -1; if ((vd->map = mmap(0, vd->mbuf.size, PROT_READ|PROT_WRITE, MAP_SHARED, vd->fd, 0)) < 0) { perror("v4l_mmap_init:mmap"); return -1; /*yangdaqian add * before vd->map in this statement */ } return 0; } /* * v4l_grab_init - initalizate mmap buffer * * width: width of mmap's buffer * height: width of mmap's buffer */ int v4l_grab_init(v4l_device *vd, int width, int height) { vd->mmap.width = width; //width; vd->mmap.height = height; //height; vd->mmap.format = vd->picture.palette; vd->frame_current = 0; vd->frame_using[0] = FALSE; vd->frame_using[1] = FALSE; return v4l_grab_frame(vd, 0); } /* * v4l_grab_frame - activate capturing * * frame: frame number to store image data */ int v4l_grab_frame(v4l_device *vd, int frame) { if (vd->frame_using[frame]) { fprintf(stderr, "v4l_grab_frame: frame %d is already used.\n", frame); return -1; } vd->mmap.frame = frame; if (ioctl(vd->fd, VIDIOCMCAPTURE, &(vd->mmap)) < 0) { perror("v4l_grab_frame"); return -1; } vd->frame_using[frame] = TRUE; vd->frame_current = frame; return 0; } int v4l_grab_sync(v4l_device *vd) { if (ioctl(vd->fd, VIDIOCSYNC, &(vd->frame_current)) < 0) { perror("v4l_grab_sync"); } vd->frame_using[vd->frame_current] = FALSE; return 0; } int v4l_get_buffer(v4l_device *vd) { if (ioctl(vd->fd, VIDIOCGFBUF, &(vd->buffer)) < 0) { perror("v4l_get_buffer"); } return 0; } int v4l_set_buffer(v4l_device *vd) { if (ioctl(vd->fd, VIDIOCSFBUF, &(vd->buffer)) < 0) { perror("v4l_set_buffer"); return -1; } return 0; } int v4l_set_palette(v4l_device *vd, int pal, int dep) { vd->picture.palette = pal; vd->picture.depth = dep; vd->mmap.format =pal; if (ioctl(vd->fd, VIDIOCSPICT, &(vd->picture)) < 0) { perror("v4l_set_palette"); return -1; } return 0; } //***************************************************************************** int capture_init(char *dev,v4l_device *vd,int width,int high) { if (v4l_open(dev,vd)!=0) { printf("Can not open v4l\n"); return -1; } if(v4l_get_channels(vd)!=0) { printf("Can not get channel\n"); return -1; } printf("Device : %s \n",dev); printf("Name : %s \n",vd->capability.name); printf("Channels: %d \n",vd->capability.channels); printf("Audios : %d \n",vd->capability.audios); if(v4l_set_norm(vd, VIDEO_MODE_NTSC)!=0) // initial set 5 { printf("v4l set norm error\n"); return -1; } if(v4l_mmap_init(vd)!= 0) // improve mmap { printf("v4l mmap error\n"); return -1; } if(v4l_grab_init(vd,width,high)!= 0) // improve grab_init { printf("v4l grab init fail\n"); return -1; } return 0; } //***************************************************************************** void capture_close(v4l_device *vd) { munmap(vd->map,vd->mbuf.size); v4l_close(vd); } //***************************************************************************** unsigned char *get_picture(v4l_device *video) { if(v4l_grab_sync(video)) { printf("v4l grab sync fail\n"); return NULL; } video->frame_current^=1; if(v4l_grab_frame(video,video->frame_current)<0) { printf("get picture fail\n"); return NULL; } return (video->map+video->mbuf.offsets[video->frame_current]); } //***************************************************************************** #define IMAGINE_SIZE 7000 int save_picture(unsigned char *image,unsigned char *name) { FILE *fp; if(image==NULL) { printf("Cannt save picture\n"); return -1; } fp=fopen(name,"w"); fwrite(image,IMAGINE_SIZE,1,fp); fclose(fp); printf("Capture picture:%s\n",name); return 0; }