int camdata_count;
int cam_fd=open("/dev/camera",O_RDONLY);
printf("Camera init!\n");
while(1){
camdata_count=read(cam_fd,cam_data,640*512*2);
if(camdata_count==640*512*2){
/*視頻數(shù)據(jù)處理與傳輸?shù)拇a*/
}
else{
printf("CAMERA Error!\n");
}
}
close(cam_fd);

// st是一個(gè)已經(jīng)建立的MemoryStream對(duì)象，bmp_data是bmp數(shù)據(jù)（byte數(shù)組）,bmpSize是BMP圖像大?。▎挝皇荁）。
st.Write(bmp_data, 0, bmpSize);
try
{
picBox.Image = Image.FromStream(st);//picBox是已經(jīng)建立的PictureBox對(duì)象，呈現(xiàn)在圖形界面上
}
catch (Exception e)
{
richTextBox2.Text += "error\n";//如果BMP數(shù)據(jù)錯(cuò)誤，則輸出如下錯(cuò)誤
}
//st對(duì)象清空
st.SetLength(0);
st.Position = 0;
st.Flush();

count=read(fd,cam_data,WIDTH*HEIGHT*2);//縮小圖片大小，data_buf為原圖像數(shù)據(jù)，cam_data為縮小后的圖像數(shù)據(jù)，兩者都為字符數(shù)組類型
if(count==WIDTH*HEIGHT*2){
shrink(data_buf,cam_data,WIDTH,HEIGHT);
for(i=0;i30;i++){
//用UDP分包傳輸圖像數(shù)據(jù)
sendto(sockfd,data_buf+(i*32768),32768,0,(struct sockaddr *)addr,len);
usleep(2000);//給與一定的延時(shí)
}
printf("One picture sended!\n");//一幀傳輸完畢
usleep(100000);
}
else{
printf("Error\n");
}

shrink(data_buf,cam_data,WIDTH,HEIGHT);//縮小圖片大小，data_buf為原圖像數(shù)據(jù)，cam_data為縮小后的圖像數(shù)據(jù)，兩者都為字符數(shù)組類型
for(i=0;i16;i++)
{
bzero(cut_buf,1152);
cut_buf[0]=(uchar)i;//將要傳輸?shù)臄?shù)據(jù)首個(gè)字節(jié)設(shè)為順序號(hào)
for(j=0;j9202;j++)
{
//每個(gè)像素按位分位平面數(shù)據(jù)包
cut_buf[j/8+1]|=(uchar)(((uchar)(data_buf[j]>>bit_index(i))0x01)(j%8));
}
sendto(sockfd,cut_buf,1152,0,(struct sockaddr *)cam_addr,sockaddr_len);//發(fā)送數(shù)據(jù)
usleep(1000);//傳輸每個(gè)數(shù)據(jù)包之間的延時(shí)
}
printf("One picture sended!\n");//傳輸每幀圖像之間的延時(shí)
usleep(100000);

private void picDataCopy(byte[] bBuf,byte[] bData) //bBuf為接收到的數(shù)據(jù)，bData是重組后的數(shù)據(jù)存放的數(shù)組
{
int index=bBuf[0];
for (int i = 0; i 9202;i++ )//循環(huán)9202次，逐位進(jìn)行數(shù)據(jù)的重組
{
if(index15){
bData[3*i + 2 - (index%3)] |=
(byte)(((bBuf[i/8 + 1] >> (i%8)) 0x01) (7 - index/3));
}
else if(index==15){
bData[3*i+1]|=
(byte)(((bBuf[i/8 + 1] >> (i%8)) 0x01) 2);
}
}
}