/*能成功實現USB攝像頭視頻采集，并且在LCD上實時顯示，另外還添加了GPRS功能，將兩個小數發送到手機上面*/#include <stdio.h>#include <stdlib.h>#include <unistd.h>#include <math.h>#include <errno.h>#include <fcntl.h>#include <string.h>#include <signal.h>#include <pthread.h>#include <sched.h>#include <sys/types.h>#include <sys/time.h>#include <sys/ioctl.h>#include <sys/stat.h>#include <sys/mman.h>#include <termios.h>#include "fb.h"#include "videodev.h"#include "grab-ng.h"#include "uart.c"#define _GNU_SOURCE#include <getopt.h>struct capture_info{	int width, height;	char device[256];};struct fb_dev{	//for frame buffer	int fb;	void *fb_mem;	//frame buffer mmap	int fb_width, fb_height, fb_line_len, fb_size;	int fb_bpp;	//src must be RGB24 format	void (*fb_draw)(struct fb_dev *fbdev, void* src, int x, int y, int width, int height);};static char *default_framebuffer="/dev/fb0";static struct capture_info capinfo={320, 240, "/dev/v4l/video0"};static struct fb_dev fbdev;static char* fb_dev_name=NULL;void send_gprs();#define NUM_CAPBUFFER	32void fb_draw16bpp(struct fb_dev *fbdev, void* src, int x, int y, int width, int height){	int i, j;	int fb_line_len = fbdev->fb_line_len;	__u8 *psrc= (__u8*)src;	__u16* pdsc = (__u16*)fbdev->fb_mem;	__u16 tmp, tmp1;	pdsc+=y*fb_line_len/2 + x;	for(i=0; i<height; i++){		for(j=0; j<width; j++){			/*			tmp = (*psrc)>>3;		tmp<<=11;	*psrc++;		//this is for GIGEND----PC			tmp1 = (*psrc)>>2;	tmp|=(tmp1<<5);	*psrc++;			tmp |= (*psrc)>>3;	*psrc++;			pdsc[j] = tmp;			*/			//this is for little end ----ARM			tmp = (*psrc)>>3;		tmp<<=0;	*psrc++;			//BLUE			tmp1 = (*psrc)>>2;	tmp|=(tmp1<<5);	*psrc++;		//GREEN			tmp |=(((*psrc)>>3) << 11);	*psrc++;					//RED			pdsc[j] = tmp;		}		pdsc+=fb_line_len/2;	}}void fb_draw12bpp(struct fb_dev *fbdev, void* src, int x, int y, int width, int height){	int i, j;	int fb_line_len = fbdev->fb_line_len;	__u8 *psrc= (__u8*)src;	__u8* pdsc = (__u8*)fbdev->fb_mem;	__u8 tmp;	//fixed me! x must be even	pdsc+=y*fb_line_len + x*3/2;	for(i=0; i<height; i++){		for(j=0; j<width*3/2;){			tmp = psrc[2]&0xf0;			tmp |=(psrc[1]>>4);			pdsc[j++] = tmp;			tmp = psrc[0]&0xf0;			tmp |=(psrc[5]>>4);			pdsc[j++] = tmp;			tmp = psrc[4]&0xf0;			tmp |=(psrc[3]>>4);			pdsc[j++] = tmp;			psrc+=6;		}		pdsc+=fb_line_len;	}}int framebuffer_open(void){	int fb;	struct fb_var_screeninfo fb_vinfo;	struct fb_fix_screeninfo fb_finfo;		if (!fb_dev_name && !(fb_dev_name = getenv("FRAMEBUFFER")))		fb_dev_name=default_framebuffer;	fb = open (fb_dev_name, O_RDWR);	if(fb<0){		printf("device %s open failed\n", fb_dev_name);		return -1;	}		if (ioctl(fb, FBIOGET_VSCREENINFO, &fb_vinfo)) {		printf("Can't get VSCREENINFO: %s\n", strerror(errno));		close(fb);		return -1;	}	if (ioctl(fb, FBIOGET_FSCREENINFO, &fb_finfo)) {		printf("Can't get FSCREENINFO: %s\n", strerror(errno));		return 1;	}	fbdev.fb_bpp = fb_vinfo.red.length + fb_vinfo.green.length +		fb_vinfo.blue.length + fb_vinfo.transp.length;	fbdev.fb_width = fb_vinfo.xres;	fbdev.fb_height = fb_vinfo.yres;	fbdev.fb_line_len = fb_finfo.line_length;	fbdev.fb_size = fb_finfo.smem_len;	printf("frame buffer: %dx%d,  %dbpp, 0x%xbyte\n", 		fbdev.fb_width, fbdev.fb_height, fbdev.fb_bpp, fbdev.fb_size);	switch(fbdev.fb_bpp){	case 16:		fbdev.fb_draw = fb_draw16bpp;		break;	case 12:		fbdev.fb_draw = fb_draw12bpp;		break;	default:		printf("Can't support %d bpp draw\n", fbdev.fb_bpp);		return -1;	}	fbdev.fb_mem = mmap (NULL, fbdev.fb_size, PROT_READ|PROT_WRITE,MAP_SHARED,fb,0);	if(fbdev.fb_mem==NULL || (int)fbdev.fb_mem==-1){		fbdev.fb_mem=NULL;		printf("mmap failed\n");		close(fb);		return -1;	}	fbdev.fb=fb;	memset (fbdev.fb_mem, 0x0, fbdev.fb_size);    return 0;}void framebuffer_close(){	if(fbdev.fb_mem){		munmap(fbdev.fb_mem, fbdev.fb_size);		fbdev.fb_mem=NULL;	}	if(fbdev.fb){		close(fbdev.fb);		fbdev.fb=0;	}}int capture(){	void* caphandle;	struct ng_vid_driver *cap_driver = &v4l_driver;	struct ng_video_fmt fmt;	fmt.fmtid = VIDEO_BGR24;	fmt.width = capinfo.width;	fmt.height = capinfo.height;	if(framebuffer_open()<0){		return -1;	}	caphandle=cap_driver->open(capinfo.device);	if(!caphandle){		printf("failed to open video for linux interface!\n");		return -1;	}	if(cap_driver->setformat(caphandle, &fmt)){		printf("failed to set video format!\n");		return -1;	}	cap_driver->startvideo(caphandle, 25,  NUM_CAPBUFFER);	{		struct ng_video_buf* pvideo_buf;		int x, y, width, height;		int diff_width, diff_height;		diff_width = fbdev.fb_width - fmt.width;		diff_height = fbdev.fb_height - fmt.height;		if(diff_width>0){			x =  diff_width/2;			width = fmt.width;		}		else{			x = 0;			width = fbdev.fb_width;		}		if(diff_height>0){			y =  diff_height/2;			height = fmt.height;		}		else{			y = 0;			height = fbdev.fb_height;		}		//begin capture		while(1){			pvideo_buf=cap_driver->nextframe(caphandle);			fbdev.fb_draw(&fbdev, pvideo_buf->data, x, y, width, height);			ng_release_video_buf(pvideo_buf);					}	}	framebuffer_close();	cap_driver->stopvideo(caphandle);	cap_driver->close(caphandle);	return 0;}const char*program_name; void print_usage (FILE*stream,int exit_code){ 	fprintf (stream, "Usage:%s options [ inputfile ....]\n",program_name); 	fprintf (stream, "-h --help Display this usage information.\n"		"-d --device <video device>.\n "		"-f --framebuffer <frame buffer device>.\n "		"-v --verbose <n>.\n "		"-s --size <320:240>\n");	exit (exit_code); } void send_gprs(){	int fdcom, i, SendLen,p1_length,p2_length,p3_length;	double x=1.22;double y=21.32;	struct termios termios_cur;	//char RecvBuf[10];	char *p1="AT\r\n";	char *p2="AT+CMGF=1\r\n";	char *p3="AT+CMGS=15123365525\r\n";		p1_length=strlen(p1);	p2_length=strlen(p2);	p3_length=strlen(p3);	fdcom = PortOpen(&portinfo);	if(fdcom<0){		printf("Error: open serial port error.\n");		exit(1);	}	PortSet(fdcom, &portinfo);	SendLen = PortSend(fdcom, p1, p1_length);	if(SendLen>0){				printf("No %d send %d data information.\n", i, SendLen);			}			else{				printf("Error: send failed.\n");			}	SendLen = PortSend(fdcom, p2, p2_length);	if(SendLen>0){				printf("No %d send %d data information.\n", i, SendLen);			}			else{				printf("Error: send failed.\n");			}	SendLen = PortSend(fdcom, p3, p3_length);	if(SendLen>0){				printf("No %d send %d data information.\n", i, SendLen);			}			else{				printf("Error: send failed.\n");			}	char *info_x,*info_y;	int decpt,sign;	gcvt(x,5,info_x);    info_x_length=strlen(info_x);	gcvt(y,5,info_y);	PortSend(fdcom, info_x, info_x_length);	strcat(info_y,"/x1a");	info_y_length=strlen(info_y);	SendLen = PortSend(fdcom, info_y, info_y_length);	if(SendLen>0){				printf("No %d send %d data information.\n", i, SendLen);			}			else{				printf("Error: send failed.\n");			}	sleep(1000);}static int verbose =0;int main (int argc,char*argv []) { 	int next_option; 	const char*const short_options ="hd:v:f:s:";	const struct option long_options [] ={		{"help",0,NULL,'h' }, 		{"device",1,NULL,'d' }, 		{"framebuffer",1,NULL,'f' }, 		{"verbose",1,NULL,'v' }, 		{"size",0,NULL,'s' }, 		{NULL,0,NULL,0 }}; 	const char*output_filename =NULL; 	program_name =argv [0]; 	do { 		next_option =getopt_long (argc,argv,short_options, long_options,NULL); 		switch (next_option) 		{ 		case 'h':/*-h or --help */ 			print_usage (stdout,0); 		case 's':/*-s or --size */ 			//ip =optarg; 			sscanf(optarg, "%d:%d", &(capinfo.width), &(capinfo.height));			break; 		case 'f':/*-f or --framebuffer */ 			fb_dev_name = optarg;			break; 		case 'd':/*-b or --device */ 			strcpy(capinfo.device, optarg);			break; 		case 'v':/*-v or --verbose */ 			sscanf(optarg, "%d", &verbose);			ng_debug = verbose;			break; 		case '?':/*The user specified an invalid option.*/ 			print_usage (stderr,1); 		case -1:/*Done with options.*/ 			break; 		default:/*Something else:unexpected.*/ 			print_usage (stderr,1); 		}	}while (next_option !=-1);      printf("video %s caputure: %dx%d\n", capinfo.device, capinfo.width, capinfo.height);	pthread_t thread_id1,thread_id2;	pthread_attr_t attr;	struct sched_param param;    pthread_attr_init(&attr);    pthread_attr_getschedparam(&attr,&param);    pthread_create(&thread_id2,&attr,(void*)&send_gprs,NULL);    param.sched_priority++;	pthread_attr_setschedparam(&attr,&param);    pthread_create(&thread_id1,&attr,(void*)&capture,NULL);    pthread_join(thread_id1,NULL);    pthread_join(thread_id2,NULL);	return capture();}