From 3cff136600d3450105b7f7274f5033895827fa3b Mon Sep 17 00:00:00 2001 From: Florent Villard Date: Tue, 26 Feb 2002 13:03:50 +0000 Subject: added fb tools: fbresolution to detect current framebuffer resolution progress to display a colord rectangle in framebuffer --- fb/Makefile | 29 ++++ fb/fbresolution.c | 86 ++++++++++++ fb/progress.c | 398 ++++++++++++++++++++++++++++++++++++++++++++++++++++++ 3 files changed, 513 insertions(+) create mode 100644 fb/Makefile create mode 100644 fb/fbresolution.c create mode 100644 fb/progress.c diff --git a/fb/Makefile b/fb/Makefile new file mode 100644 index 0000000..0ba7cea --- /dev/null +++ b/fb/Makefile @@ -0,0 +1,29 @@ + +VERSION := 0.1.1 + +prefix=/usr/ +bindir=$(prefix)/bin + +CFLAGS=-g -O2 -Wall \ + -DVERSION='"$(VERSION)"' + +PROGS=progress fbresolution + +all build: $(PROGS) + +fbresolution: fbresolution.c + $(CC) $(CFLAGS) -o $@ fbresolution.c + +progress: progress.c + $(CC) $(CFLAGS) $(FSFLAGS) -o $@ progress.c + +install: + mkdir -p $(bindir) + install -s -m755 progress $(bindir) + install -m755 fbresolution $(bindir) + +clean: + rm -f *~ *.o *.bak core + +realclean: clean + rm -f $(PROGS) diff --git a/fb/fbresolution.c b/fb/fbresolution.c new file mode 100644 index 0000000..06a6cd9 --- /dev/null +++ b/fb/fbresolution.c @@ -0,0 +1,86 @@ +/* + * framebuffer tool, inspired from fbi ((c) 1998,99 Gerd Knorr ) + * + * (c) 2002 Florent Villard (warly@mandrakesoft.com) + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +int fd; +static int fb; +struct fb_var_screeninfo fb_var; + +struct option fbresol_options[] = { + {"version", no_argument, NULL, 'v'}, /* version */ + {"help", no_argument, NULL, 'h'}, /* help */ + {0,0,0,0} +}; + +void +version(void) +{ + fprintf(stderr, "fbresolution version " VERSION + " (c) 2002 Florent Villard ; compiled on %s.\n", __DATE__ ); +} + +void +usage(char *name) +{ + char *h; + h = strrchr(name, '/'); + fprintf(stderr, + "\n" + "This program output the current framebuffer resolution.\n" + "\n" + " Usage: %s [ options ]\n" + "\n" + " --help [-h] Print this text\n" + " --version [-v] Show the %s version number\n" + "\n" + "\n" + ,h ? h + 1 : name, h ? h + 1 : name); +} + +int +main(int argc, char *argv[]) +{ + int opt_index = 0; + int c; + for (;;) { + c = getopt_long(argc, argv, "vhnd:t:", fbresol_options, &opt_index); + if (c == -1) + break; + switch (c) { + case 'v': + version(); + exit(1); + break; + default: + case 'h': + usage(argv[0]); + exit(1); + } + } + if (optind > argc) { + usage(argv[0]); + exit(1); + } + if (-1 == (fb = open("/dev/fb0",O_RDWR /* O_WRONLY */))) { + fprintf(stderr,"open /dev/fb0: %s\n",strerror(errno)); + exit(1); + } + if (-1 == ioctl(fb,FBIOGET_VSCREENINFO,&fb_var)) { + perror("ioctl FBIOGET_VSCREENINFO"); + exit(1); + } + printf("%dx%d\n",fb_var.xres,fb_var.yres); + return 0; +} diff --git a/fb/progress.c b/fb/progress.c new file mode 100644 index 0000000..8a0164a --- /dev/null +++ b/fb/progress.c @@ -0,0 +1,398 @@ +/* + * framebuffer tool, inspired from fbi ((c) 1998,99 Gerd Knorr ) + * + * (c) 2002 Florent Villard (warly@mandrakesoft.com) + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +int fd; +static int fb; +unsigned char *fb_mem; +static int tty; +struct fb_fix_screeninfo fb_fix; +struct fb_var_screeninfo fb_var; +static struct fb_var_screeninfo fb_ovar; +static unsigned short ored[256], ogreen[256], oblue[256]; +static struct fb_cmap ocmap = { 0, 256, ored, ogreen, oblue }; +static int kd_mode; +static struct vt_mode vt_omode; +static struct termios term; +int fb_mem_offset = 0; +static int orig_vt_no = 0; +struct termios saved_attributes; +int saved_fl; +char *fbdev = NULL; + +/* Command line options. */ +struct option progress_options[] = { + {"version", no_argument, NULL, 'v'}, /* version */ + {"help", no_argument, NULL, 'h'}, /* help */ + {"device", required_argument, NULL, 'd'}, /* device */ + {"nochange", no_argument, NULL, 'n'}, + {"tty", required_argument, NULL, 't'}, + {0,0,0,0} +}; + + +void +fb_memset (void *addr, int c, size_t len) +{ +#if 1 /* defined(__powerpc__) */ + unsigned int i, *p; + + i = (c & 0xff) << 8; + i |= i << 16; + len >>= 2; + for (p = addr; len--; p++) + *p = i; +#else + memset(addr, c, len); +#endif +} + +void +fb_cleanup(void) +{ + /* restore console */ + if (-1 == ioctl(fb,FBIOPUT_VSCREENINFO,&fb_ovar)) + perror("ioctl FBIOPUT_VSCREENINFO"); + if (-1 == ioctl(fb,FBIOGET_FSCREENINFO,&fb_fix)) + perror("ioctl FBIOGET_FSCREENINFO"); + if (fb_ovar.bits_per_pixel == 8 || + fb_fix.visual == FB_VISUAL_DIRECTCOLOR) { + if (-1 == ioctl(fb,FBIOPUTCMAP,&ocmap)) + perror("ioctl FBIOPUTCMAP"); + } + close(fb); + + if (-1 == ioctl(tty,KDSETMODE, kd_mode)) + perror("ioctl KDSETMODE"); + if (-1 == ioctl(tty,VT_SETMODE, &vt_omode)) + perror("ioctl VT_SETMODE"); + if (orig_vt_no && -1 == ioctl(tty,VT_ACTIVATE, orig_vt_no)) + perror("ioctl VT_ACTIVATE"); + tcsetattr(tty, TCSANOW, &term); + close(tty); +} + +void +fb_setvt(int vtno, int nochange) +{ + struct vt_stat vts; + char vtname[12]; + + if (-1 == ioctl(tty,VT_GETSTATE, &vts)) { + perror("ioctl VT_GETSTATE"); + exit(1); + } + orig_vt_no = vts.v_active; + if ((orig_vt_no != vtno) && nochange) exit(0); + + if (vtno < 0) { + if (-1 == ioctl(tty,VT_OPENQRY, &vtno) || vtno == -1) { + perror("ioctl VT_OPENQRY"); + exit(1); + } + } + + vtno &= 0xff; + sprintf(vtname, "/dev/tty%d", vtno); + chown(vtname, getuid(), getgid()); + if (-1 == access(vtname,R_OK | W_OK)) { + fprintf(stderr,"access %s: %s\n",vtname,strerror(errno)); + exit(1); + } + switch (fork()) { + case 0: + break; + case -1: + perror("fork"); + exit(1); + default: + exit(0); + } + close(tty); + close(0); + close(1); + close(2); + setsid(); + open(vtname,O_RDWR); + dup(0); + dup(0); + + if (-1 == ioctl(tty,VT_ACTIVATE, vtno)) { + perror("ioctl VT_ACTIVATE"); + exit(1); + } + if (-1 == ioctl(tty,VT_WAITACTIVE, vtno)) { + perror("ioctl VT_WAITACTIVE"); + exit(1); + } +} + + +int +fb_init(char *device, int vt, int nochange) +{ + struct stat st; + char fbdev[16]; + + tty = 0; + if (vt != 0) + fb_setvt(vt,nochange); + + /* FIXME: where are MAJOR() / MINOR() ??? */ + fstat(tty,&st); +#if 0 + if (((st.st_rdev >> 8) & 0xff) != TTY_MAJOR) { + /* catch that here, give a more user friendly error message that just + * throw a error about a failed ioctl later on ... */ + fprintf(stderr, + "ERROR: tty is not a linux console. You can not start this\n" + " tool from a pseudo tty (xterm/ssh/screen/...).\n"); + exit(1); + } +#endif + if (NULL == device) { + device = getenv("FRAMEBUFFER"); + if (NULL == device) { + struct fb_con2fbmap c2m; + if (-1 == (fb = open("/dev/fb0",O_WRONLY,0))) { + fprintf(stderr,"open /dev/fb0: %s\n",strerror(errno)); + exit(1); + } + c2m.console = st.st_rdev & 0xff; + if (-1 == ioctl(fb, FBIOGET_CON2FBMAP, &c2m)) { + perror("ioctl FBIOGET_CON2FBMAP"); + exit(1); + } + close(fb); + //fprintf(stderr,"map: vt%02d => fb%d\n",c2m.console,c2m.framebuffer); + sprintf(fbdev,"/dev/fb%d",c2m.framebuffer); + device = fbdev; + } + } + /* get current settings (which we have to restore) */ + if (-1 == (fb = open(device,O_RDWR /* O_WRONLY */))) { + fprintf(stderr,"open %s: %s\n",device,strerror(errno)); + exit(1); + } + if (-1 == ioctl(fb,FBIOGET_VSCREENINFO,&fb_ovar)) { + perror("ioctl FBIOGET_VSCREENINFO"); + exit(1); + } + if (-1 == ioctl(fb,FBIOGET_FSCREENINFO,&fb_fix)) { + perror("ioctl FBIOGET_FSCREENINFO"); + exit(1); + } + if (fb_ovar.bits_per_pixel == 8 || + fb_fix.visual == FB_VISUAL_DIRECTCOLOR) { + if (-1 == ioctl(fb,FBIOGETCMAP,&ocmap)) { + perror("ioctl FBIOGETCMAP"); + exit(1); + } + } + if (-1 == ioctl(tty,KDGETMODE, &kd_mode)) { + perror("ioctl KDGETMODE"); + exit(1); + } + if (-1 == ioctl(tty,VT_GETMODE, &vt_omode)) { + perror("ioctl VT_GETMODE"); + exit(1); + } + tcgetattr(tty, &term); + + /* get mode info */ + if (-1 == ioctl(fb,FBIOGET_VSCREENINFO,&fb_var)) { + perror("ioctl FBIOGET_VSCREENINFO"); + exit(1); + } + + /* checks & initialisation */ + if (-1 == ioctl(fb,FBIOGET_FSCREENINFO,&fb_fix)) { + perror("ioctl FBIOGET_FSCREENINFO"); + exit(1); + } + if (fb_fix.type != FB_TYPE_PACKED_PIXELS) { + fprintf(stderr,"can handle only packed pixel frame buffers\n"); + goto err; + } + fb_mem_offset = (unsigned long)(fb_fix.smem_start) & (~PAGE_MASK); + fb_mem = mmap(NULL,fb_fix.smem_len+fb_mem_offset,PROT_WRITE,MAP_SHARED,fb,0); + if (-1L == (long)fb_mem) { + perror("mmap"); + goto err; + } + /* move viewport to upper left corner */ + if (fb_var.xoffset != 0 || fb_var.yoffset != 0) { + fb_var.xoffset = 0; + fb_var.yoffset = 0; + if (-1 == ioctl(fb,FBIOPAN_DISPLAY,&fb_var)) { + perror("ioctl FBIOPAN_DISPLAY"); + goto err; + } + } +// if (-1 == ioctl(tty,KDSETMODE, KD_GRAPHICS)) { +// perror("ioctl KDSETMODE"); +// goto err; +// } + + /* cls */ + //fb_memset(fb_mem+fb_mem_offset,0,fb_fix.smem_len); + return fb; + + err: + fb_cleanup(); + exit(1); +} + +void +tty_restore() +{ + fcntl(0,F_SETFL,saved_fl); + tcsetattr (0, TCSANOW, &saved_attributes); +} + +void +tty_raw() +{ + struct termios tattr; + + fcntl(0,F_GETFL,&saved_fl); + tcgetattr (0, &saved_attributes); + + fcntl(0,F_SETFL,O_NONBLOCK); + memcpy(&tattr,&saved_attributes,sizeof(struct termios)); + tattr.c_lflag &= ~(ICANON|ECHO); + tattr.c_cc[VMIN] = 1; + tattr.c_cc[VTIME] = 0; + tcsetattr (0, TCSAFLUSH, &tattr); +} + +void +version(void) +{ + fprintf(stderr, "progress version " VERSION + " (c) 2002 Florent Villard ; compiled on %s.\n", __DATE__ ); +} + +void +usage(char *name) +{ + char *h; + h = strrchr(name, '/'); + fprintf(stderr, + "\n" + "This program displays rectangles using the Linux framebuffer device.\n" + "\n" + " Usage: %s [ options ] x y dx dy color\n" + "\n" + " --help [-h] Print this text\n" + " --version [-v] Show the %s version number\n" + " --device [-d] dev Framebuffer device [%s]\n" + " --nochange [-n] Exit if tty is not the current one\n" + " --tty [-t] tty Display on a specific tty (actual if omitted)\n" + "\n" + "\n" + ,h ? h + 1 : name, h ? h + 1 : name,fbdev ? fbdev : "/dev/fb0"); +} + + + +int +main(int argc, char *argv[]) +{ + int i,j,bytes; + int x,y,X,Y; + int color; + int opt_index = 0; + int c,tty=0; + int nochange = 0; + char * tab; + char * a; + for (;;) { + c = getopt_long(argc, argv, "vhnd:t:", progress_options, &opt_index); + if (c == -1) + break; + switch (c) { + case 'd': + fbdev = optarg; + break; + case 'v': + version(); + exit(1); + break; + case 'n': + nochange=1; + break; + case 't': + tty = atoi(optarg); + break; + default: + case 'h': + usage(argv[0]); + exit(1); + } + } + if (optind > argc - 5) { + usage(argv[0]); + exit(1); + } + fd = fb_init(fbdev, tty, nochange); + x = atoi((char *)*(argv+optind++)); + if ( x > fb_var.xres ) x = 0; + y = atoi((char *)*(argv+optind++)); + if ( y > fb_var.yres ) y = 0; + X = atoi((char *)*(argv+optind++)); + if ( X + x > fb_var.xres ) X = fb_var.xres-x; + Y = atoi((char *)*(argv+optind++)); + if ( Y + y > fb_var.yres ) Y = fb_var.yres-y; + color = strtol((char *)*(argv+optind++),NULL,16); + + // printf("x %d y %d X %d Y %d color %x bit per pixel %d red %d green %d blue %d tty %d\n",x,y,X,Y,color,fb_var.bits_per_pixel,fb_var.red.length,fb_var.green.length,fb_var.blue.length,tty); + exit; + switch (fb_var.bits_per_pixel){ + case 24: break; + case 16: + case 15: + color = ((color & 0xff0000) >> 16 >> 3 << (fb_var.green.length + fb_var.blue.length)) + ((color & 0x00ff00) >> 8 >> 2 << (fb_var.blue.length)) + ((color & 0x0000ff) >> 3); + break; + default: + perror("unsupported bits per pixel mode"); + exit(1); + } + bytes = (fb_var.bits_per_pixel+7)/8; + tty_raw(); + tab = (char *)malloc(sizeof(char)*bytes*X); + a = (char *)malloc(sizeof(char)*bytes); + for (j = 0; j < bytes; j++){ + a[j] = color >> (8*j); + } + for (i = 0; i < X; i++) { + for (j = 0; j < bytes; j++){ + tab[bytes*i+j] = a[j]; + } + memcpy(fb_mem+(y*fb_var.xres+x+i)*bytes, a, bytes); + } + for (j = 1; j < Y; j++){ + memcpy(fb_mem+(y+j)*bytes*fb_var.xres+x*bytes, tab, bytes*X); + } + tty_restore(); + return 0; +} -- cgit v1.2.1