基于ZedBoard的Webcam设计(3)

37if(g1>255)

38 g1 = 255; 39elseif(g1<0)

40 g1 = 0; 41

42if(r2>255)

43 r2 = 255; 44elseif(r2<0)

45 r2 = 0; 46

47if(b2>255)

48 b2 = 255; 49elseif(b2<0)

50 b2 = 0; 51

52if(g2>255)

53 g2 = 255; 54elseif(g2<0)

55 g2 = 0; 56

57 *(frame_buffer + ((480-1-i)*320+j)*6 ) = (unsigned char)b1; 58 *(frame_buffer + ((480-1-i)*320+j)*6 + 1) = (unsigned char)g1; 59 *(frame_buffer + ((480-1-i)*320+j)*6 + 2) = (unsigned char)r1; 60 *(frame_buffer + ((480-1-i)*320+j)*6 + 3) = (unsigned char)b2; 61 *(frame_buffer + ((480-1-i)*320+j)*6 + 4) = (unsigned char)g2; 62 *(frame_buffer + ((480-1-i)*320+j)*6 + 5) = (unsigned char)r2; 63 } 64 }

65printf(\); 66 }

4、停止采集和关闭设备

使用命令VIDIOC_STREAMOFF停止视频采集，并关闭设备。

1int close_v4l2(void) 2{

3ioctl(fd, VIDIOC_STREAMOFF, &buf_type); 4if(fd != -1) 5 { 6close(fd); 7return (TRUE); 8 }

9return (FALSE); 10 }

5、主函数

需要把我们采集到图像数据存储成图片，为了方便调试，先将原始的数据存储为yuv格式文件，再将转换成RGB后的数据存储为BMP。定义BMP头结构体

1typedefstructtagBITMAPFILEHEADER{

2 WORD bfType; // the flag of bmp, value is \ 3 DWORD bfSize; // size BMP file ,unit is bytes 4 DWORD bfReserved; // 0

5 DWORD bfOffBits; // must be 54 6

7}BITMAPFILEHEADER; 8 9

10typedefstructtagBITMAPINFOHEADER{

11 DWORD biSize; // must be 0x28 12 DWORD biWidth; // 13 DWORD biHeight; //

14 WORD biPlanes; // must be 1 15 WORD biBitCount; // 16 DWORD biCompression; // 17 DWORD biSizeImage; // 18 DWORD biXPelsPerMeter; // 19 DWORD biYPelsPerMeter; // 20 DWORD biClrUsed; // 21 DWORD biClrImportant; // 22 }BITMAPINFOHEADER;

完整的主函数

//@超群天晴

//http://www.cnblogs.com/surpassal/ int main(void) {

FILE * fp1,* fp2;

BITMAPFILEHEADER bf; BITMAPINFOHEADER bi;

fp1 = fopen(BMP, \if(!fp1) {

printf(\BMP\

return(FALSE); }

fp2 = fopen(YUV, \if(!fp2) {

printf(\YUV\return(FALSE); }

if(init_v4l2() == FALSE) {

return(FALSE); }

//Set BITMAPINFOHEADER bi.biSize = 40;

bi.biWidth= IMAGEWIDTH; bi.biHeight= IMAGEHEIGHT; bi.biPlanes= 1; bi.biBitCount= 24; bi.biCompression= 0;

bi.biSizeImage= IMAGEWIDTH*IMAGEHEIGHT*3; bi.biXPelsPerMeter= 0; bi.biYPelsPerMeter= 0; bi.biClrUsed= 0;

bi.biClrImportant= 0;

//Set BITMAPFILEHEADER bf.bfType = 0x4d42;

bf.bfSize= 54 +bi.biSizeImage; bf.bfReserved= 0; bf.bfOffBits= 54;

v4l2_grab();

fwrite(buffers[0].start, 640*480*2, 1, fp2); printf(\YUV\

yuyv_2_rgb888(); fwrite(&bf, 14, 1, fp1); fwrite(&bi, 40, 1, fp1);

fwrite(frame_buffer, bi.biSizeImage, 1, fp1); printf(\BMP\

fclose(fp1); fclose(fp2);

close_v4l2();

return(TRUE); }

三、PC测试

程序编写完后，可以先在PC上做测试(实际整个调试过程都是在PC上，直道最后PC上能实现功能再挪到ZedBoard上的)。PC上测试的结果

在/usr目录下可以查看到采集到的图片