/* * Video driver for Framebuffer device * by Szabolcs Berecz * (C) 2001 * * Some idea and code borrowed from Chris Lawrence's ppmtofb-0.27 */ #define FBDEV "fbdev: " #include #include #include #include #include #include #include #include #include #include #include #include #include "config.h" #include "video_out.h" #include "video_out_internal.h" #include "fastmemcpy.h" #include "sub.h" #include "../postproc/rgb2rgb.h" #ifdef CONFIG_VIDIX #include "vosub_vidix.h" #endif #include "aspect.h" #ifdef HAVE_PNG extern vo_functions_t video_out_png; #endif static vo_info_t info = { "Framebuffer Device", "fbdev", "Szabolcs Berecz ", "" }; LIBVO_EXTERN(fbdev) extern int verbose; #ifdef CONFIG_VIDIX /* Name of VIDIX driver */ static const char *vidix_name = NULL; #endif static signed int pre_init_err = -2; /****************************** * fb.modes support * ******************************/ extern char *monitor_hfreq_str; extern char *monitor_vfreq_str; extern char *monitor_dotclock_str; static range_t *monitor_hfreq = NULL; static range_t *monitor_vfreq = NULL; static range_t *monitor_dotclock = NULL; typedef struct { char *name; uint32_t xres, yres, vxres, vyres, depth; uint32_t pixclock, left, right, upper, lower, hslen, vslen; uint32_t sync; uint32_t vmode; } fb_mode_t; #define PRINT_LINENUM printf(" at line %d\n", line_num) #define MAX_NR_TOKEN 16 #define MAX_LINE_LEN 1000 #define RET_EOF -1 #define RET_EOL -2 static int validate_mode(fb_mode_t *m) { if (!m->xres) { printf("needs geometry "); return 0; } if (!m->pixclock) { printf("needs timings "); return 0; } return 1; } static FILE *fp; static int line_num = 0; static char *line; static char *token[MAX_NR_TOKEN]; static uint32_t dstFourcc; static int get_token(int num) { static int read_nextline = 1; static int line_pos; int i; char c; if (num >= MAX_NR_TOKEN) { printf("get_token(): max >= MAX_NR_TOKEN!"); goto out_eof; } if (read_nextline) { if (!fgets(line, MAX_LINE_LEN, fp)) goto out_eof; line_pos = 0; ++line_num; read_nextline = 0; } for (i = 0; i < num; i++) { while (isspace(line[line_pos])) ++line_pos; if (line[line_pos] == '\0' || line[line_pos] == '#') { read_nextline = 1; goto out_eol; } token[i] = line + line_pos; c = line[line_pos]; if (c == '"' || c == '\'') { token[i]++; while (line[++line_pos] != c && line[line_pos]) /* NOTHING */; if (!line[line_pos]) goto out_eol; line[line_pos] = ' '; } else { for (/* NOTHING */; !isspace(line[line_pos]) && line[line_pos]; line_pos++) /* NOTHING */; } if (!line[line_pos]) { read_nextline = 1; if (i == num - 1) goto out_ok; goto out_eol; } line[line_pos++] = '\0'; } out_ok: return i; out_eof: return RET_EOF; out_eol: return RET_EOL; } static fb_mode_t *fb_modes = NULL; static int nr_modes = 0; static int parse_fbmode_cfg(char *cfgfile) { #define CHECK_IN_MODE_DEF\ do {\ if (!in_mode_def) {\ printf("'needs 'mode' first");\ goto err_out_print_linenum;\ }\ } while (0) fb_mode_t *mode = NULL; char *endptr; // strtoul()... int in_mode_def = 0; int tmp, i; if (verbose > 0) printf("Reading %s: ", cfgfile); if ((fp = fopen(cfgfile, "r")) == NULL) { printf("can't open '%s': %s\n", cfgfile, strerror(errno)); return -1; } if ((line = (char *) malloc(MAX_LINE_LEN + 1)) == NULL) { printf("can't get memory for 'line': %s\n", strerror(errno)); return -2; } /* * check if the cfgfile starts with 'mode' */ while ((tmp = get_token(1)) == RET_EOL) /* NOTHING */; if (tmp == RET_EOF) goto out; if (!strcmp(token[0], "mode")) goto loop_enter; goto err_out_parse_error; while ((tmp = get_token(1)) != RET_EOF) { if (tmp == RET_EOL) continue; if (!strcmp(token[0], "mode")) { if (in_mode_def) { printf("'endmode' required"); goto err_out_print_linenum; } if (!validate_mode(mode)) goto err_out_not_valid; loop_enter: if (!(fb_modes = (fb_mode_t *) realloc(fb_modes, sizeof(fb_mode_t) * (nr_modes + 1)))) { printf("can't realloc 'fb_modes' (nr_modes = %d):" " %s\n", nr_modes, strerror(errno)); goto err_out; } mode=fb_modes + nr_modes; ++nr_modes; memset(mode,0,sizeof(fb_mode_t)); if (get_token(1) < 0) goto err_out_parse_error; for (i = 0; i < nr_modes - 1; i++) { if (!strcmp(token[0], fb_modes[i].name)) { printf("mode name '%s' isn't unique", token[0]); goto err_out_print_linenum; } } if (!(mode->name = strdup(token[0]))) { printf("can't strdup -> 'name': %s\n", strerror(errno)); goto err_out; } in_mode_def = 1; } else if (!strcmp(token[0], "geometry")) { CHECK_IN_MODE_DEF; if (get_token(5) < 0) goto err_out_parse_error; mode->xres = strtoul(token[0], &endptr, 0); if (*endptr) goto err_out_parse_error; mode->yres = strtoul(token[1], &endptr, 0); if (*endptr) goto err_out_parse_error; mode->vxres = strtoul(token[2], &endptr, 0); if (*endptr) goto err_out_parse_error; mode->vyres = strtoul(token[3], &endptr, 0); if (*endptr) goto err_out_parse_error; mode->depth = strtoul(token[4], &endptr, 0); if (*endptr) goto err_out_parse_error; } else if (!strcmp(token[0], "timings")) { CHECK_IN_MODE_DEF; if (get_token(7) < 0) goto err_out_parse_error; mode->pixclock = strtoul(token[0], &endptr, 0); if (*endptr) goto err_out_parse_error; mode->left = strtoul(token[1], &endptr, 0); if (*endptr) goto err_out_parse_error; mode->right = strtoul(token[2], &endptr, 0); if (*endptr) goto err_out_parse_error; mode->upper = strtoul(token[3], &endptr, 0); if (*endptr) goto err_out_parse_error; mode->lower = strtoul(token[4], &endptr, 0); if (*endptr) goto err_out_parse_error; mode->hslen = strtoul(token[5], &endptr, 0); if (*endptr) goto err_out_parse_error; mode->vslen = strtoul(token[6], &endptr, 0); if (*endptr) goto err_out_parse_error; } else if (!strcmp(token[0], "endmode")) { CHECK_IN_MODE_DEF; in_mode_def = 0; } else if (!strcmp(token[0], "accel")) { CHECK_IN_MODE_DEF; if (get_token(1) < 0) goto err_out_parse_error; /* * it's only used for text acceleration * so we just ignore it. */ } else if (!strcmp(token[0], "hsync")) { CHECK_IN_MODE_DEF; if (get_token(1) < 0) goto err_out_parse_error; if (!strcmp(token[0], "low")) mode->sync &= ~FB_SYNC_HOR_HIGH_ACT; else if(!strcmp(token[0], "high")) mode->sync |= FB_SYNC_HOR_HIGH_ACT; else goto err_out_parse_error; } else if (!strcmp(token[0], "vsync")) { CHECK_IN_MODE_DEF; if (get_token(1) < 0) goto err_out_parse_error; if (!strcmp(token[0], "low")) mode->sync &= ~FB_SYNC_VERT_HIGH_ACT; else if(!strcmp(token[0], "high")) mode->sync |= FB_SYNC_VERT_HIGH_ACT; else goto err_out_parse_error; } else if (!strcmp(token[0], "csync")) { CHECK_IN_MODE_DEF; if (get_token(1) < 0) goto err_out_parse_error; if (!strcmp(token[0], "low")) mode->sync &= ~FB_SYNC_COMP_HIGH_ACT; else if(!strcmp(token[0], "high")) mode->sync |= FB_SYNC_COMP_HIGH_ACT; else goto err_out_parse_error; } else if (!strcmp(token[0], "extsync")) { CHECK_IN_MODE_DEF; if (get_token(1) < 0) goto err_out_parse_error; if (!strcmp(token[0], "false")) mode->sync &= ~FB_SYNC_EXT; else if(!strcmp(token[0], "true")) mode->sync |= FB_SYNC_EXT; else goto err_out_parse_error; } else if (!strcmp(token[0], "laced")) { CHECK_IN_MODE_DEF; if (get_token(1) < 0) goto err_out_parse_error; if (!strcmp(token[0], "false")) mode->vmode = FB_VMODE_NONINTERLACED; else if (!strcmp(token[0], "true")) mode->vmode = FB_VMODE_INTERLACED; else goto err_out_parse_error; } else if (!strcmp(token[0], "double")) { CHECK_IN_MODE_DEF; if (get_token(1) < 0) goto err_out_parse_error; if (!strcmp(token[0], "false")) ; else if (!strcmp(token[0], "true")) mode->vmode = FB_VMODE_DOUBLE; else goto err_out_parse_error; } else goto err_out_parse_error; } if (!validate_mode(mode)) goto err_out_not_valid; out: if (verbose > 0) printf("%d modes\n", nr_modes); free(line); fclose(fp); return nr_modes; err_out_parse_error: printf("parse error"); err_out_print_linenum: PRINT_LINENUM; err_out: if (fb_modes) { free(fb_modes); fb_modes = NULL; } nr_modes = 0; free(line); free(fp); return -2; err_out_not_valid: printf("previous mode is not correct"); goto err_out_print_linenum; } static fb_mode_t *find_mode_by_name(char *name) { int i; for (i = 0; i < nr_modes; i++) if (!strcmp(name, fb_modes[i].name)) return fb_modes + i; return NULL; } static float dcf(fb_mode_t *m) //driving clock frequency { return 1e12f / m->pixclock; } static float hsf(fb_mode_t *m) //horizontal scan frequency { int htotal = m->left + m->xres + m->right + m->hslen; return dcf(m) / htotal; } static float vsf(fb_mode_t *m) //vertical scan frequency { int vtotal = m->upper + m->yres + m->lower + m->vslen; return hsf(m) / vtotal; } static int mode_works(fb_mode_t *m, range_t *hfreq, range_t *vfreq, range_t *dotclock) { float h = hsf(m); float v = vsf(m); float d = dcf(m); int ret = 1; if (verbose > 1) printf(FBDEV "mode %dx%d:", m->xres, m->yres); if (!in_range(hfreq, h)) { ret = 0; if (verbose > 1) printf(" hsync out of range."); } if (!in_range(vfreq, v)) { ret = 0; if (verbose > 1) printf(" vsync out of range."); } if (!in_range(dotclock, d)) { ret = 0; if (verbose > 1) printf(" dotclock out of range."); } if (verbose > 1) { if (ret) printf(" hsync, vsync, dotclock ok.\n"); else printf("\n"); } return ret; } static fb_mode_t *find_best_mode(int xres, int yres, range_t *hfreq, range_t *vfreq, range_t *dotclock) { int i; fb_mode_t *best = fb_modes; fb_mode_t *curr; if (verbose > 1) printf(FBDEV "Searching for first working mode\n"); for (i = 0; i < nr_modes; i++, best++) if (mode_works(best, hfreq, vfreq, dotclock)) break; if (i == nr_modes) return NULL; if (i == nr_modes - 1) return best; if (verbose > 1) { printf(FBDEV "First working mode: %dx%d\n", best->xres, best->yres); printf(FBDEV "Searching for better modes\n"); } for (curr = best + 1; i < nr_modes - 1; i++, curr++) { if (!mode_works(curr, hfreq, vfreq, dotclock)) continue; if (verbose > 1) printf(FBDEV); if (best->xres < xres || best->yres < yres) { if (curr->xres > best->xres || curr->yres > best->yres) { if (verbose > 1) printf("better than %dx%d, which is too small.\n", best->xres, best->yres); best = curr; } else if (verbose > 1) printf("too small.\n"); } else if (curr->xres == best->xres && curr->yres == best->yres && vsf(curr) > vsf(best)) { if (verbose > 1) printf("faster screen refresh.\n"); best = curr; } else if ((curr->xres <= best->xres && curr->yres <= best->yres) && (curr->xres >= xres && curr->yres >= yres)) { if (verbose > 1) printf("better than %dx%d, which is too large.\n", best->xres, best->yres); best = curr; } else if (verbose > 1) { if (curr->xres < xres || curr->yres < yres) printf("too small.\n"); else if (curr->xres > best->xres || curr->yres > best->yres) printf("too large.\n"); else printf("it's worse, don't know why.\n"); } } return best; } static void set_bpp(struct fb_var_screeninfo *p, int bpp) { p->bits_per_pixel = (bpp + 1) & ~1; p->red.msb_right = p->green.msb_right = p->blue.msb_right = p->transp.msb_right = 0; p->transp.offset = p->transp.length = 0; p->blue.offset = 0; switch (bpp) { case 32: p->transp.offset = 24; p->transp.length = 8; case 24: p->red.offset = 16; p->red.length = 8; p->green.offset = 8; p->green.length = 8; p->blue.length = 8; break; case 16: p->red.offset = 11; p->green.length = 6; p->red.length = 5; p->green.offset = 5; p->blue.length = 5; break; case 15: p->red.offset = 10; p->green.length = 5; p->red.length = 5; p->green.offset = 5; p->blue.length = 5; break; } } static void fb_mode2fb_vinfo(fb_mode_t *m, struct fb_var_screeninfo *v) { v->xres = m->xres; v->yres = m->yres; v->xres_virtual = m->vxres; v->yres_virtual = m->vyres; set_bpp(v, m->depth); v->pixclock = m->pixclock; v->left_margin = m->left; v->right_margin = m->right; v->upper_margin = m->upper; v->lower_margin = m->lower; v->hsync_len = m->hslen; v->vsync_len = m->vslen; v->sync = m->sync; v->vmode = m->vmode; } /****************************** * vo_fbdev * ******************************/ /* command line/config file options */ char *fb_dev_name = NULL; char *fb_mode_cfgfile = "/etc/fb.modes"; char *fb_mode_name = NULL; static fb_mode_t *fb_mode = NULL; /* vt related variables */ static int vt_fd; static FILE *vt_fp; static int vt_doit = 1; /* vo_fbdev related variables */ static int fb_dev_fd; static int fb_tty_fd; static size_t fb_size; static uint8_t *frame_buffer; static uint8_t *L123123875; /* thx .so :) */ static struct fb_fix_screeninfo fb_finfo; static struct fb_var_screeninfo fb_orig_vinfo; static struct fb_var_screeninfo fb_vinfo; static struct fb_cmap fb_oldcmap; static int fb_cmap_changed = 0; static int fb_pixel_size; // 32: 4 24: 3 16: 2 15: 2 static int fb_real_bpp; // 32: 24 24: 24 16: 16 15: 15 static int fb_bpp; // 32: 32 24: 24 16: 16 15: 15 static int fb_bpp_we_want; // 32: 32 24: 24 16: 16 15: 15 static int fb_line_len; static int fb_xres; static int fb_yres; static void (*draw_alpha_p)(int w, int h, unsigned char *src, unsigned char *srca, int stride, unsigned char *dst, int dstride); static uint8_t *next_frame; static int in_width; static int in_height; static int out_width; static int out_height; static int first_row; static int last_row; static uint32_t pixel_format; static int fs; static int flip; /* * Note: this function is completely cut'n'pasted from * Chris Lawrence's code. * (modified a bit to fit in my code...) */ struct fb_cmap *make_directcolor_cmap(struct fb_var_screeninfo *var) { /* Hopefully any DIRECTCOLOR device will have a big enough palette * to handle mapping the full color depth. * e.g. 8 bpp -> 256 entry palette * * We could handle some sort of gamma here */ int i, cols, rcols, gcols, bcols; uint16_t *red, *green, *blue; struct fb_cmap *cmap; rcols = 1 << var->red.length; gcols = 1 << var->green.length; bcols = 1 << var->blue.length; /* Make our palette the length of the deepest color */ cols = (rcols > gcols ? rcols : gcols); cols = (cols > bcols ? cols : bcols); red = malloc(cols * sizeof(red[0])); if(!red) { printf("Can't allocate red palette with %d entries.\n", cols); return NULL; } for(i=0; i< rcols; i++) red[i] = (65535/(rcols-1)) * i; green = malloc(cols * sizeof(green[0])); if(!green) { printf("Can't allocate green palette with %d entries.\n", cols); free(red); return NULL; } for(i=0; i< gcols; i++) green[i] = (65535/(gcols-1)) * i; blue = malloc(cols * sizeof(blue[0])); if(!blue) { printf("Can't allocate blue palette with %d entries.\n", cols); free(red); free(green); return NULL; } for(i=0; i< bcols; i++) blue[i] = (65535/(bcols-1)) * i; cmap = malloc(sizeof(struct fb_cmap)); if(!cmap) { printf("Can't allocate color map\n"); free(red); free(green); free(blue); return NULL; } cmap->start = 0; cmap->transp = 0; cmap->len = cols; cmap->red = red; cmap->blue = blue; cmap->green = green; cmap->transp = NULL; return cmap; } #ifdef CONFIG_VIDIX static uint32_t parseSubDevice(const char *sd) { if(memcmp(sd,"vidix",5) == 0) vidix_name = &sd[5]; /* vidix_name will be valid within init() */ else { printf(FBDEV "Unknown subdevice: '%s'\n", sd); return -1; } return 0; } #endif static int fb_preinit(void) { static int fb_preinit_done = 0; static int fb_works = 0; if (fb_preinit_done) return fb_works; if (!fb_dev_name && !(fb_dev_name = getenv("FRAMEBUFFER"))) fb_dev_name = "/dev/fb0"; if (verbose > 0) printf(FBDEV "using %s\n", fb_dev_name); if ((fb_dev_fd = open(fb_dev_name, O_RDWR)) == -1) { printf(FBDEV "Can't open %s: %s\n", fb_dev_name, strerror(errno)); goto err_out; } if (ioctl(fb_dev_fd, FBIOGET_VSCREENINFO, &fb_vinfo)) { printf(FBDEV "Can't get VSCREENINFO: %s\n", strerror(errno)); goto err_out_fd; } fb_orig_vinfo = fb_vinfo; if ((fb_tty_fd = open("/dev/tty", O_RDWR)) < 0) { if (verbose > 0) printf(FBDEV "notice: Can't open /dev/tty: %s\n", strerror(errno)); } fb_bpp = fb_vinfo.bits_per_pixel; if (fb_bpp == 8 && !vo_dbpp) { printf(FBDEV "8 bpp output is not supported.\n"); goto err_out_tty_fd; } /* 16 and 15 bpp is reported as 16 bpp */ if (fb_bpp == 16) fb_bpp = fb_vinfo.red.length + fb_vinfo.green.length + fb_vinfo.blue.length; if (vo_dbpp) { if (vo_dbpp != 15 && vo_dbpp != 16 && vo_dbpp != 24 && vo_dbpp != 32) { printf(FBDEV "can't switch to %d bpp\n", vo_dbpp); goto err_out_fd; } fb_bpp = vo_dbpp; } fb_preinit_done = 1; fb_works = 1; return 1; err_out_tty_fd: close(fb_tty_fd); fb_tty_fd = -1; err_out_fd: close(fb_dev_fd); fb_dev_fd = -1; err_out: fb_preinit_done = 1; fb_works = 0; return 0; } static void lots_of_printf(void) { if (verbose > 0) { printf(FBDEV "var info:\n"); printf(FBDEV "xres: %u\n", fb_vinfo.xres); printf(FBDEV "yres: %u\n", fb_vinfo.yres); printf(FBDEV "xres_virtual: %u\n", fb_vinfo.xres_virtual); printf(FBDEV "yres_virtual: %u\n", fb_vinfo.yres_virtual); printf(FBDEV "xoffset: %u\n", fb_vinfo.xoffset); printf(FBDEV "yoffset: %u\n", fb_vinfo.yoffset); printf(FBDEV "bits_per_pixel: %u\n", fb_vinfo.bits_per_pixel); printf(FBDEV "grayscale: %u\n", fb_vinfo.grayscale); printf(FBDEV "red: %lu %lu %lu\n", (unsigned long) fb_vinfo.red.offset, (unsigned long) fb_vinfo.red.length, (unsigned long) fb_vinfo.red.msb_right); printf(FBDEV "green: %lu %lu %lu\n", (unsigned long) fb_vinfo.green.offset, (unsigned long) fb_vinfo.green.length, (unsigned long) fb_vinfo.green.msb_right); printf(FBDEV "blue: %lu %lu %lu\n", (unsigned long) fb_vinfo.blue.offset, (unsigned long) fb_vinfo.blue.length, (unsigned long) fb_vinfo.blue.msb_right); printf(FBDEV "transp: %lu %lu %lu\n", (unsigned long) fb_vinfo.transp.offset, (unsigned long) fb_vinfo.transp.length, (unsigned long) fb_vinfo.transp.msb_right); printf(FBDEV "nonstd: %u\n", fb_vinfo.nonstd); if (verbose > 1) { printf(FBDEV "activate: %u\n", fb_vinfo.activate); printf(FBDEV "height: %u\n", fb_vinfo.height); printf(FBDEV "width: %u\n", fb_vinfo.width); printf(FBDEV "accel_flags: %u\n", fb_vinfo.accel_flags); printf(FBDEV "timing:\n"); printf(FBDEV "pixclock: %u\n", fb_vinfo.pixclock); printf(FBDEV "left_margin: %u\n", fb_vinfo.left_margin); printf(FBDEV "right_margin: %u\n", fb_vinfo.right_margin); printf(FBDEV "upper_margin: %u\n", fb_vinfo.upper_margin); printf(FBDEV "lower_margin: %u\n", fb_vinfo.lower_margin); printf(FBDEV "hsync_len: %u\n", fb_vinfo.hsync_len); printf(FBDEV "vsync_len: %u\n", fb_vinfo.vsync_len); printf(FBDEV "sync: %u\n", fb_vinfo.sync); printf(FBDEV "vmode: %u\n", fb_vinfo.vmode); } printf(FBDEV "fix info:\n"); printf(FBDEV "framebuffer size: %d bytes\n", fb_finfo.smem_len); printf(FBDEV "type: %lu\n", (unsigned long) fb_finfo.type); printf(FBDEV "type_aux: %lu\n", (unsigned long) fb_finfo.type_aux); printf(FBDEV "visual: %lu\n", (unsigned long) fb_finfo.visual); printf(FBDEV "line_length: %lu bytes\n", (unsigned long) fb_finfo.line_length); if (verbose > 1) { printf(FBDEV "id: %.16s\n", fb_finfo.id); printf(FBDEV "smem_start: %p\n", (void *) fb_finfo.smem_start); printf(FBDEV "xpanstep: %u\n", fb_finfo.xpanstep); printf(FBDEV "ypanstep: %u\n", fb_finfo.ypanstep); printf(FBDEV "ywrapstep: %u\n", fb_finfo.ywrapstep); printf(FBDEV "mmio_start: %p\n", (void *) fb_finfo.mmio_start); printf(FBDEV "mmio_len: %u bytes\n", fb_finfo.mmio_len); printf(FBDEV "accel: %u\n", fb_finfo.accel); } printf(FBDEV "fb_bpp: %d\n", fb_bpp); printf(FBDEV "fb_real_bpp: %d\n", fb_real_bpp); printf(FBDEV "fb_pixel_size: %d bytes\n", fb_pixel_size); printf(FBDEV "other:\n"); printf(FBDEV "in_width: %d\n", in_width); printf(FBDEV "in_height: %d\n", in_height); printf(FBDEV "out_width: %d\n", out_width); printf(FBDEV "out_height: %d\n", out_height); printf(FBDEV "first_row: %d\n", first_row); printf(FBDEV "last_row: %d\n", last_row); if (verbose > 1) printf(FBDEV "draw_alpha_p:%dbpp = %p\n", fb_bpp, draw_alpha_p); } } static void vt_set_textarea(int u, int l) { /* how can I determine the font height? * just use 16 for now */ int urow = ((u + 15) / 16) + 1; int lrow = l / 16; if (verbose > 1) printf(FBDEV "vt_set_textarea(%d,%d): %d,%d\n", u, l, urow, lrow); if(vt_fp) { fprintf(vt_fp, "\33[%d;%dr\33[%d;%dH", urow, lrow, lrow, 0); fflush(vt_fp); } } static uint32_t config(uint32_t width, uint32_t height, uint32_t d_width, uint32_t d_height, uint32_t flags, char *title, uint32_t format) { struct fb_cmap *cmap; int vm = flags & 0x02; int zoom = flags & 0x04; fs = flags & 0x01; flip = flags & 0x08; if(pre_init_err == -2) { printf(FBDEV "Internal fatal error: init() was called before preinit()\n"); return -1; } if (pre_init_err) return 1; #if 0 if (zoom #ifdef CONFIG_VIDIX && !vidix_name #endif ) { printf(FBDEV "-zoom is not supported\n"); return 1; } #endif if (fb_mode_name && !vm) { printf(FBDEV "-fbmode can only be used with -vm\n"); return 1; } if (vm && (parse_fbmode_cfg(fb_mode_cfgfile) < 0)) return 1; if (d_width && (fs || vm)) { out_width = d_width; out_height = d_height; } else { out_width = width; out_height = height; } in_width = width; in_height = height; pixel_format = format; if (fb_mode_name) { if (!(fb_mode = find_mode_by_name(fb_mode_name))) { printf(FBDEV "can't find requested video mode\n"); return 1; } fb_mode2fb_vinfo(fb_mode, &fb_vinfo); } else if (vm) { monitor_hfreq = str2range(monitor_hfreq_str); monitor_vfreq = str2range(monitor_vfreq_str); monitor_dotclock = str2range(monitor_dotclock_str); if (!monitor_hfreq || !monitor_vfreq || !monitor_dotclock) { printf(FBDEV "you have to specify the capabilities of" " the monitor.\n"); return 1; } if (!(fb_mode = find_best_mode(out_width, out_height, monitor_hfreq, monitor_vfreq, monitor_dotclock))) { printf(FBDEV "can't find best video mode\n"); return 1; } printf(FBDEV "using mode %dx%d @ %.1fHz\n", fb_mode->xres, fb_mode->yres, vsf(fb_mode)); fb_mode2fb_vinfo(fb_mode, &fb_vinfo); } fb_bpp_we_want = fb_bpp; set_bpp(&fb_vinfo, fb_bpp); fb_vinfo.xres_virtual = fb_vinfo.xres; fb_vinfo.yres_virtual = fb_vinfo.yres; if (fb_tty_fd >= 0 && ioctl(fb_tty_fd, KDSETMODE, KD_GRAPHICS) < 0) { if (verbose > 0) printf(FBDEV "Can't set graphics mode: %s\n", strerror(errno)); close(fb_tty_fd); fb_tty_fd = -1; } if (ioctl(fb_dev_fd, FBIOPUT_VSCREENINFO, &fb_vinfo)) { printf(FBDEV "Can't put VSCREENINFO: %s\n", strerror(errno)); if (fb_tty_fd >= 0 && ioctl(fb_tty_fd, KDSETMODE, KD_TEXT) < 0) { printf(FBDEV "Can't restore text mode: %s\n", strerror(errno)); } return 1; } fb_pixel_size = fb_vinfo.bits_per_pixel / 8; fb_real_bpp = fb_vinfo.red.length + fb_vinfo.green.length + fb_vinfo.blue.length; fb_bpp = (fb_pixel_size == 4) ? 32 : fb_real_bpp; if (fb_bpp_we_want != fb_bpp) printf(FBDEV "requested %d bpp, got %d bpp!!!\n", fb_bpp_we_want, fb_bpp); switch (fb_bpp) { case 32: draw_alpha_p = vo_draw_alpha_rgb32; dstFourcc = IMGFMT_BGR32; break; case 24: draw_alpha_p = vo_draw_alpha_rgb24; dstFourcc = IMGFMT_BGR24; break; default: case 16: draw_alpha_p = vo_draw_alpha_rgb16; dstFourcc = IMGFMT_BGR16; break; case 15: draw_alpha_p = vo_draw_alpha_rgb15; dstFourcc = IMGFMT_BGR15; break; } if (flip & ((((pixel_format & 0xff) + 7) / 8) != fb_pixel_size)) { printf(FBDEV "Flipped output with depth conversion is not " "supported\n"); return 1; } fb_xres = fb_vinfo.xres; fb_yres = fb_vinfo.yres; if (vm || fs) { out_width = fb_xres; out_height = fb_yres; } if (out_width < in_width || out_height < in_height) { printf(FBDEV "screensize is smaller than video size\n"); return 1; } first_row = (out_height - in_height) / 2; last_row = (out_height + in_height) / 2; if (ioctl(fb_dev_fd, FBIOGET_FSCREENINFO, &fb_finfo)) { printf(FBDEV "Can't get FSCREENINFO: %s\n", strerror(errno)); return 1; } lots_of_printf(); if (fb_finfo.type != FB_TYPE_PACKED_PIXELS) { printf(FBDEV "type %d not supported\n", fb_finfo.type); return 1; } switch (fb_finfo.visual) { case FB_VISUAL_TRUECOLOR: break; case FB_VISUAL_DIRECTCOLOR: if (verbose > 0) printf(FBDEV "creating cmap for directcolor\n"); if (ioctl(fb_dev_fd, FBIOGETCMAP, &fb_oldcmap)) { printf(FBDEV "can't get cmap: %s\n", strerror(errno)); return 1; } if (!(cmap = make_directcolor_cmap(&fb_vinfo))) return 1; if (ioctl(fb_dev_fd, FBIOPUTCMAP, cmap)) { printf(FBDEV "can't put cmap: %s\n", strerror(errno)); return 1; } fb_cmap_changed = 1; free(cmap->red); free(cmap->green); free(cmap->blue); free(cmap); break; default: printf(FBDEV "visual: %d not yet supported\n", fb_finfo.visual); return 1; } fb_line_len = fb_finfo.line_length; fb_size = fb_finfo.smem_len; frame_buffer = NULL; next_frame = NULL; #ifdef CONFIG_VIDIX if(vidix_name) { unsigned image_width,image_height,x_offset,y_offset; if(zoom || fs){ aspect_save_orig(width,height); aspect_save_prescale(d_width,d_height); aspect_save_screenres(fb_xres,fb_yres); aspect(&image_width,&image_height,fs ? A_ZOOM : A_NOZOOM); } else { image_width=width; image_height=height; } geometry(&x_offset,&y_offset,fb_xres,fb_yres,image_width,image_height,fs); if(vidix_init(width,height,x_offset,y_offset,image_width, image_height,format,fb_bpp, fb_xres,fb_yres) != 0) { printf(FBDEV "Can't initialize VIDIX driver\n"); vidix_name = NULL; vidix_term(); return -1; } else printf(FBDEV "Using VIDIX\n"); vidix_start(); } else #endif { int x_offset,y_offset; if ((frame_buffer = (uint8_t *) mmap(0, fb_size, PROT_READ | PROT_WRITE, MAP_SHARED, fb_dev_fd, 0)) == (uint8_t *) -1) { printf(FBDEV "Can't mmap %s: %s\n", fb_dev_name, strerror(errno)); return 1; } geometry(&x_offset,&y_offset,fb_xres,fb_yres,out_width,out_height,fs); L123123875 = frame_buffer + (out_width - in_width) * fb_pixel_size / 2 + ( (out_height - in_height) / 2 ) * fb_line_len + x_offset * fb_pixel_size + y_offset * fb_line_len; if (verbose > 0) { if (verbose > 1) { printf(FBDEV "frame_buffer @ %p\n", frame_buffer); printf(FBDEV "L123123875 @ %p\n", L123123875); } printf(FBDEV "pixel per line: %d\n", fb_line_len / fb_pixel_size); } if (!(next_frame = (uint8_t *) malloc(in_width * in_height * fb_pixel_size))) { printf(FBDEV "Can't malloc next_frame: %s\n", strerror(errno)); return 1; } if (fs || vm) memset(frame_buffer, '\0', fb_line_len * fb_yres); if (format == IMGFMT_YV12) yuv2rgb_init(fb_bpp, MODE_RGB); } if (vt_doit && (vt_fd = open("/dev/tty", O_WRONLY)) == -1) { printf(FBDEV "can't open /dev/tty: %s\n", strerror(errno)); vt_doit = 0; } if (vt_doit && !(vt_fp = fdopen(vt_fd, "w"))) { printf(FBDEV "can't fdopen /dev/tty: %s\n", strerror(errno)); vt_doit = 0; } if (vt_doit) vt_set_textarea(last_row, fb_yres); return 0; } static uint32_t query_format(uint32_t format) { int ret = VFCAP_OSD|VFCAP_CSP_SUPPORTED; /* osd/sub is supported on every bpp */ if (!fb_preinit()) return 0; #ifdef CONFIG_VIDIX if(vidix_name) return (vidix_query_fourcc(format)); #endif if ((format & IMGFMT_BGR_MASK) == IMGFMT_BGR) { int bpp = format & 0xff; if (bpp == fb_bpp) return ret|VFCAP_CSP_SUPPORTED_BY_HW; else if (bpp == 15 && fb_bpp == 16) return ret; else if (bpp == 24 && fb_bpp == 32) return ret; } if (format == IMGFMT_YV12) return ret; return 0; } static void draw_alpha(int x0, int y0, int w, int h, unsigned char *src, unsigned char *srca, int stride) { unsigned char *dst; int dstride; #ifdef USE_CONVERT2FB if (pixel_format == IMGFMT_YV12) { dst = L123123875 + (fb_xres * y0 + x0) * fb_pixel_size; dstride = fb_xres * fb_pixel_size; } else #endif { dst = next_frame + (in_width * y0 + x0) * fb_pixel_size; dstride = in_width * fb_pixel_size; } (*draw_alpha_p)(w, h, src, srca, stride, dst, dstride); } static uint32_t draw_frame(uint8_t *src[]) { if (pixel_format == IMGFMT_YV12) { #ifdef USE_CONVERT2FB yuv2rgb(L123123875, src[0], src[1], src[2], fb_xres, fb_yres, fb_xres * fb_pixel_size, in_width, in_width / 2); #else yuv2rgb(next_frame, src[0], src[1], src[2], in_width, in_height, in_width * fb_pixel_size, in_width, in_width / 2); #endif } else if (flip) { int h = in_height; int len = in_width * fb_pixel_size; char *d = next_frame + (in_height - 1) * len; char *s = src[0]; while (h--) { memcpy(d, s, len); s += len; d -= len; } } else { int sbpp = ((pixel_format & 0xff) + 7) / 8; char *d = next_frame; char *s = src[0]; if (sbpp == fb_pixel_size) { if (fb_real_bpp == 16 && pixel_format == (IMGFMT_BGR|15)) rgb15to16(s, d, 2 * in_width * in_height); else memcpy(d, s, sbpp * in_width * in_height); } } return 0; } static uint32_t draw_slice(uint8_t *src[], int stride[], int w, int h, int x, int y) { uint8_t *dest; #ifdef USE_CONVERT2FB if (pixel_format == IMGFMT_YV12) { if(x < fb_xres && y < fb_yres) { if(x+w > fb_xres) w= fb_xres-x; if(y+h > fb_yres) h= fb_yres-y; dest = L123123875 + (fb_xres * y + x) * fb_pixel_size; yuv2rgb(dest, src[0], src[1], src[2], w, h, fb_xres * fb_pixel_size, stride[0], stride[1]); } return 0; } #endif dest = next_frame + (in_width * y + x) * fb_pixel_size; yuv2rgb(dest, src[0], src[1], src[2], w, h, in_width * fb_pixel_size, stride[0], stride[1]); return 0; } static void check_events(void) { } static void put_frame(void) { int i, out_offset = 0, in_offset = 0; #ifdef USE_CONVERT2FB if(pixel_format == IMGFMT_YV12) return; #endif for (i = 0; i < in_height; i++) { memcpy(L123123875 + out_offset, next_frame + in_offset, in_width * fb_pixel_size); out_offset += fb_line_len; in_offset += in_width * fb_pixel_size; } } static void draw_osd(void) { vo_draw_text(in_width, in_height, draw_alpha); } static void flip_page(void) { put_frame(); } static void uninit(void) { if (verbose > 0) printf(FBDEV "uninit\n"); if (fb_cmap_changed) { if (ioctl(fb_dev_fd, FBIOPUTCMAP, &fb_oldcmap)) printf(FBDEV "Can't restore original cmap\n"); fb_cmap_changed = 0; } if(next_frame) free(next_frame); if (ioctl(fb_dev_fd, FBIOGET_VSCREENINFO, &fb_vinfo)) printf(FBDEV "ioctl FBIOGET_VSCREENINFO: %s\n", strerror(errno)); fb_orig_vinfo.xoffset = fb_vinfo.xoffset; fb_orig_vinfo.yoffset = fb_vinfo.yoffset; if (ioctl(fb_dev_fd, FBIOPUT_VSCREENINFO, &fb_orig_vinfo)) printf(FBDEV "Can't reset original fb_var_screeninfo: %s\n", strerror(errno)); if (fb_tty_fd >= 0) { if (ioctl(fb_tty_fd, KDSETMODE, KD_TEXT) < 0) printf(FBDEV "Can't restore text mode: %s\n", strerror(errno)); } if (vt_doit) vt_set_textarea(0, fb_orig_vinfo.yres); close(fb_tty_fd); close(fb_dev_fd); if(frame_buffer) munmap(frame_buffer, fb_size); #ifdef CONFIG_VIDIX if(vidix_name) vidix_term(); #endif } static uint32_t preinit(const char *vo_subdevice) { pre_init_err = 0; #ifdef CONFIG_VIDIX if(vo_subdevice) parseSubDevice(vo_subdevice); if(vidix_name) pre_init_err = vidix_preinit(vidix_name,&video_out_fbdev); if(verbose > 2) printf("vo_subdevice: initialization returns: %i\n",pre_init_err); #endif if(!pre_init_err) return (pre_init_err=(fb_preinit()?0:-1)); return(-1); } static uint32_t control(uint32_t request, void *data, ...) { switch (request) { case VOCTRL_QUERY_FORMAT: return query_format(*((uint32_t*)data)); } return VO_NOTIMPL; }