linux下摄像头的测试程序,友善之臂的摄像头测试程序

%:include class TError public:

TError(const char *msg) this->msg = msg;

%>

TError(const TError bitand e) msg = e.msg;

%>

void Output() std::cerr << msg << std::endl;

%>

virtual ~TError()

protected:

TError bitand operator=(const TError bitand);

private:

const char *msg;

%>;

// Linear memory based image

class TRect public:

TRect(): Addr(0), Size(0), Width(0), Height(0), LineLen(0), BPP(16) %>

virtual ~TRect() %>

bool DrawRect(const TRect bitand SrcRect, int x, int y) const if (BPP not_eq 16 or SrcRect.BPP not_eq 16) // don't support that yet

throw TError("does not support other than 16 BPP yet");

%>

// clip

int x0, y0, x1, y1;

x0 = x;

y0 = y;

x1 = x0 + SrcRect.Width - 1;

y1 = y0 + SrcRect.Height - 1;

if (x0 < 0) x0 = 0;

%>

if (x0 > Width - 1) return true;

%>

if( x1 < 0) return true;

%>

if (x1 > Width - 1) x1 = Width - 1;

%>

if (y0 < 0) y0 = 0;

%>

if (y0 > Height - 1) return true;

%>

if (y1 < 0) return true;

%>

if (y1 > Height - 1) y1 = Height -1;

%>

//copy

int copyLineLen = (x1 + 1 - x0) * BPP / 8;

unsigned char *DstPtr = Addr + LineLen * y0 + x0 * BPP / 8;

const unsigned char *SrcPtr = SrcRect.Addr + SrcRect.LineLen *(y0 - y) + (x0 - x) * SrcRect.BPP / 8;

for (int i = y0; i <= y1; i++) memcpy(DstPtr, SrcPtr, copyLineLen);

DstPtr += LineLen;

SrcPtr += SrcRect.LineLen;

%>

return true;

%>

bool DrawRect(const TRect bitand rect) const return DrawRect(rect, (Width - rect.Width) / 2, (Height - rect.Height) / 2);

%>

bool Clear() const int i;

unsigned char *ptr;

for (i = 0, ptr = Addr; i < Height; i++, ptr += LineLen) memset(ptr, 0, Width * BPP / 8);

%>

return true;

%>

protected:

TRect(const TRect bitand);

TRect bitand operator=( const TRect bitand);

protected:

unsigned char *Addr;

int Size;

int Width, Height, LineLen;

unsigned BPP;

%>;

class TFrameBuffer: public TRect public:

TFrameBuffer(const char *DeviceName = "/dev/fb0"): TRect(), fd(-1) Addr = (unsigned char *)MAP_FAILED;

fd = open(DeviceName, O_RDWR);

if (fd < 0) throw TError("cannot open frame buffer");

%>

struct fb_fix_screeninfo Fix;

struct fb_var_screeninfo Var;

if (ioctl(fd, FBIOGET_FSCREENINFO, bitand Fix) < 0 or ioctl(fd, FBIOGET_VSCREENINFO, bitand Var) < 0) throw TError("cannot get frame buffer information");

%>

BPP = Var.bits_per_pixel;

if (BPP not_eq 16) throw TError("support 16BPP frame buffer only");

%>

Width = Var.xres;

Height = Var.yres;

LineLen = Fix.line_length;

Size = LineLen * Height;

int PageSize = getpagesize();

Size = (Size + PageSize - 1) / PageSize * PageSize ;

Addr = (unsigned char *)mmap(NULL, Size, PROT_READ|PROT_WRITE,MAP_SHARED, fd, 0);

if (Addr == (unsigned char *)MAP_FAILED) throw TError("map frame buffer failed");

return;

%>

::close(fd);

fd = -1;

Clear();

%>

virtual ~TFrameBuffer() ::munmap(Addr, Size);

Addr = (unsigned char *)MAP_FAILED;

::close(fd);

fd = -1;

%>

protected:

TFrameBuffer(const TFrameBuffer bitand);

TFrameBuffer bitand operator=( const TFrameBuffer bitand);

private:

int fd;

%>;

class TVideo : public TRect public:

TVideo(const char *DeviceName = "/dev/camera"): TRect(), fd(-1) Addr = 0;

fd = ::open(DeviceName, O_RDONLY);

if (fd < 0) throw TError("cannot open video device");

%>

Width = 640;

Height = 512;

BPP = 16;

LineLen = Width * BPP / 8;

Size = LineLen * Height;

Addr = new unsigned char;

Clear();

%>

bool FetchPicture() const int count = ::read(fd, Addr, Size);

if (count not_eq Size) throw TError("error in fetching picture from video");

%>

return true;

%>

virtual ~TVideo() ::close(fd);

fd = -1;

deleteAddr;

Addr = 0;

%>

protected:

TVideo(const TVideo bitand);

TVideo bitand operator=(const TVideo bitand);

private:

int fd;

%>;

int main(int argc, char **argv)

try TFrameBuffer FrameBuffer;

TVideo Video;

for (;;) Video.FetchPicture();

FrameBuffer.DrawRect(Video);

%>

%> catch (TError bitand e) e.Output();

return 1;

%>

return 0;

%>

这是友善之臂的CMOS摄像头的测试程序，是用C++实现的，

测试成功了，不过对于程序的原理还是不明白，比如在读取图像信息的时候需要设置哪些信息，

需要读取的缓冲区在哪等，希望高手指点，帮忙注视一下这个程序也行。谢谢！