fb_display.rar_fb_fb_display_framebuffer

/* * FrameBuffer Image Display Function * (c) smoku/2000 * */ /* Public Use Functions: * * extern void fb_display(unsigned char *rgbbuff, * int x_size, int y_size, * int x_pan, int y_pan, * int x_offs, int y_offs); * * extern void getCurrentRes(int *x,int *y); * */ #include "fb_display.h" unsigned short red[256], green[256], blue[256]; struct fb_cmap map332 = {0, 256, red, green, blue, NULL}; unsigned short red_b[256], green_b[256], blue_b[256]; struct fb_cmap map_back = {0, 256, red_b, green_b, blue_b, NULL}; int openFB(const char *name); void closeFB(int fh); void getVarScreenInfo(int fh, struct fb_var_screeninfo *var); void setVarScreenInfo(int fh, struct fb_var_screeninfo *var); void getFixScreenInfo(int fh, struct fb_fix_screeninfo *fix); void set332map(int fh); void* convertRGB2FB(int fh, unsigned char *rgbbuff, unsigned long count, int bpp, int *cpp); void blit2FB(int fh, void *fbbuff, unsigned int pic_xs, unsigned int pic_ys, unsigned int scr_xs, unsigned int scr_ys, unsigned int xp, unsigned int yp, unsigned int xoffs, unsigned int yoffs, int cpp); void fb_display(unsigned char *rgbbuff, int x_size, int y_size, int x_pan, int y_pan, int x_offs, int y_offs) { struct fb_var_screeninfo var; unsigned short *fbbuff = NULL; int fh = -1, bp = 0; /* get the framebuffer device handle */ fh = openFB(NULL); /* read current video mode */ getVarScreenInfo(fh, &var); /* correct panning */ if(x_pan > x_size - var.xres) x_pan = 0; if(y_pan > y_size - var.yres) y_pan = 0; /* correct offset */ if(x_offs + x_size > var.xres) x_offs = 0; if(y_offs + y_size > var.yres) y_offs = 0; /* blit buffer 2 fb */ fbbuff = convertRGB2FB(fh, rgbbuff, x_size * y_size, var.bits_per_pixel, &bp); blit2FB(fh, fbbuff, x_size, y_size, var.xres, var.yres, x_pan, y_pan, x_offs, y_offs, bp); free(fbbuff); /* close device */ closeFB(fh); } void getCurrentRes(int *x, int *y) { struct fb_var_screeninfo var; int fh = -1; fh = openFB(NULL); getVarScreenInfo(fh, &var); *x = var.xres; *y = var.yres; closeFB(fh); } int openFB(const char *name) { int fh; char *dev; if(name == NULL){ dev = getenv("FRAMEBUFFER"); if(dev) name = dev; else name = DEFAULT_FRAMEBUFFER; } if ((fh = open(name, O_WRONLY)) == -1){ fprintf(stderr, "open %s: %s\n", name, strerror(errno)); exit(1); } return fh; } void closeFB(int fh) { close(fh); } void getVarScreenInfo(int fh, struct fb_var_screeninfo *var) { if (ioctl(fh, FBIOGET_VSCREENINFO, var)){ fprintf(stderr, "ioctl FBIOGET_VSCREENINFO: %s\n", strerror(errno)); exit(1); } } void setVarScreenInfo(int fh, struct fb_var_screeninfo *var) { if (ioctl(fh, FBIOPUT_VSCREENINFO, var)){ fprintf(stderr, "ioctl FBIOPUT_VSCREENINFO: %s\n", strerror(errno)); exit(1); } } void getFixScreenInfo(int fh, struct fb_fix_screeninfo *fix) { if (ioctl(fh, FBIOGET_FSCREENINFO, fix)){ fprintf(stderr, "ioctl FBIOGET_FSCREENINFO: %s\n", strerror(errno)); exit(1); } } void make332map(struct fb_cmap *map) { int rs, gs, bs, i; int r = 8, g = 8, b = 4; map->red = red; map->green = green; map->blue = blue; rs = 256 / (r - 1); gs = 256 / (g - 1); bs = 256 / (b - 1); for (i = 0; i < 256; i++) { map->red[i] = (rs * ((i / (g * b)) % r)) * 255; map->green[i] = (gs * ((i / b) % g)) * 255; map->blue[i] = (bs * ((i) % b)) * 255; } } void set8map(int fh, struct fb_cmap *map) { if (ioctl(fh, FBIOPUTCMAP, map) < 0) { fprintf(stderr, "Error putting colormap"); exit(1); } } void get8map(int fh, struct fb_cmap *map) { if (ioctl(fh, FBIOGETCMAP, map) < 0) { fprintf(stderr, "Error getting colormap"); exit(1); } } void set332map(int fh) { make332map(&map332); set8map(fh, &map332); } void blit2FB(int fh, void *fbbuff, unsigned int pic_xs, unsigned int pic_ys, unsigned int scr_xs, unsigned int scr_ys, unsigned int xp, unsigned int yp, unsigned int xoffs, unsigned int yoffs, int cpp) { int i, xc, yc; unsigned char *cp; unsigned short *sp; unsigned int *ip; ip = (unsigned int *) fbbuff; sp = (unsigned short *) ip; cp = (unsigned char *) sp; // cp = (unsigned char *) sp = (unsigned short *) ip = (unsigned int *) fbbuff; xc = (pic_xs > scr_xs) ? scr_xs : pic_xs; yc = (pic_ys > scr_ys) ? scr_ys : pic_ys; switch(cpp){ case 1: get8map(fh, &map_back); set332map(fh); for(i = 0; i < yc; i++){ lseek(fh, ((i+yoffs)*scr_xs+xoffs)*cpp, SEEK_SET); write(fh, cp + (i+yp)*pic_xs+xp, xc*cpp); } set8map(fh, &map_back); break; case 2: for(i = 0; i < yc; i++){ lseek(fh, ((i+yoffs)*scr_xs+xoffs)*cpp, SEEK_SET); write(fh, sp + (i+yp)*pic_xs+xp, xc*cpp); } break; case 4: for(i = 0; i < yc; i++){ lseek(fh, ((i+yoffs)*scr_xs+xoffs)*cpp, SEEK_SET); write(fh, ip + (i+yp)*pic_xs+xp, xc*cpp); } break; } } inline unsigned char make8color(unsigned char r, unsigned char g, unsigned char b) { return ( (((r >> 5) & 7) << 5) | (((g >> 5) & 7) << 2) | ((b >> 6) & 3) ); } inline unsigned short make15color(unsigned char r, unsigned char g, unsigned char b) { return ( (((r >> 3) & 31) << 10) | (((g >> 3) & 31) << 5) | ((b >> 3) & 31) ); } inline unsigned short make16color(unsigned char r, unsigned char g, unsigned char b) { return ( (((r >> 3) & 31) << 11) | (((g >> 2) & 63) << 5) | ((b >> 3) & 31) ); } void* convertRGB2FB(int fh, unsigned char *rgbbuff, unsigned long count, int bpp, int *cpp) { unsigned long i; void *fbbuff = NULL; unsigned char *c_fbbuff; unsigned short *s_fbbuff; unsigned int *i_fbbuff; switch(bpp) { case 8: *cpp = 1; c_fbbuff = (unsigned char *) malloc(count * sizeof(unsigned char)); for(i = 0; i < count; i++) c_fbbuff[i] = make8color(rgbbuff[i*3], rgbbuff[i*3+1], rgbbuff[i*3+2]); fbbuff = (void *) c_fbbuff; break; case 15: *cpp = 2; s_fbbuff = (unsigned short *) malloc(count * sizeof(unsigned short)); for(i = 0; i < count ; i++) s_fbbuff[i] = make15color(rgbbuff[i*3], rgbbuff[i*3+1], rgbbuff[i*3+2]); fbbuff = (void *) s_fbbuff; break; case 16: *cpp = 2; s_fbbuff = (unsigned short *) malloc(count * sizeof(unsigned short)); for(i = 0; i < count ; i++) s_fbbuff[i] = make16color(rgbbuff[i*3], rgbbuff[i*3+1], rgbbuff[i*3+2]); fbbuff = (void *) s_fbbuff; break; case 24: case 32: *cpp = 4; i_fbbuff = (unsigned int *) malloc(count * sizeof(unsigned int)); for(i = 0; i < count ; i++) i_fbbuff[i] = ((rgbbuff[i*3] << 16) & 0xFF0000) | ((rgbbuff[i*3+1] << 8) & 0xFF00) | (rgbbuff[i*3+2] & 0xFF); fbbuff = (void *) i_fbbuff; break; default: fprintf(stderr, "Unsupported video mode! You've got: %dbpp\n", bpp); exit(1); } return fbbuff; }