Mercurial > mplayer.hg
annotate libvo/vo_fbdev.c @ 393:e847396dc49f
some changes...
author | szabii |
---|---|
date | Fri, 13 Apr 2001 20:34:11 +0000 |
parents | 086c66d570d8 |
children | d75c826a8ab9 |
rev | line source |
---|---|
305 | 1 /* |
2 * Video driver for Framebuffer device | |
3 * by Szabolcs Berecz <szabi@inf.elte.hu> | |
359 | 4 * (C) 2001 |
305 | 5 * |
6 * Some idea and code borrowed from Chris Lawrence's ppmtofb-0.27 | |
7 */ | |
8 | |
393 | 9 #define FBDEV "fbdev: " |
10 | |
225 | 11 #include <stdio.h> |
12 #include <stdlib.h> | |
13 #include <string.h> | |
14 #include <fcntl.h> | |
15 #include <unistd.h> | |
16 #include <errno.h> | |
359 | 17 #include <ctype.h> |
18 #include <assert.h> | |
225 | 19 |
20 #include <sys/mman.h> | |
21 #include <sys/ioctl.h> | |
22 #include <linux/fb.h> | |
23 #include <linux/vt.h> | |
24 | |
25 #include "config.h" | |
26 #include "video_out.h" | |
27 #include "video_out_internal.h" | |
28 | |
29 #include "yuv2rgb.h" | |
311 | 30 extern void rgb15to16_mmx(char *s0, char *d0, int count); |
225 | 31 |
354 | 32 #include "fastmemcpy.h" |
350 | 33 |
225 | 34 LIBVO_EXTERN(fbdev) |
35 | |
36 static vo_info_t vo_info = { | |
37 "Framebuffer Device", | |
38 "fbdev", | |
39 "Szabolcs Berecz <szabi@inf.elte.hu>", | |
40 "" | |
41 }; | |
42 | |
379 | 43 extern int verbose; |
44 | |
359 | 45 /****************************** |
393 | 46 * fb.modes support * |
359 | 47 ******************************/ |
48 | |
49 /* | |
50 * read the fb.modes manual page! | |
51 */ | |
52 | |
53 typedef struct { | |
54 char *name; | |
55 uint32_t xres, yres, vxres, vyres, depth; | |
56 uint32_t pixclock, left, right, upper, lower, hslen, vslen; | |
57 uint32_t sync; | |
58 uint32_t vmode; | |
59 } fb_mode_t; | |
60 | |
61 #define PRINT_LINENUM printf(" at line %d\n", line_num) | |
62 | |
63 #define MAX_NR_TOKEN 16 | |
64 | |
65 #define MAX_LINE_LEN 1000 | |
66 | |
67 #define RET_EOF -1 | |
68 #define RET_EOL -2 | |
69 | |
70 static int validate_mode(fb_mode_t *m) | |
71 { | |
72 if (!m->xres) { | |
73 printf("needs geometry "); | |
74 return 0; | |
75 } | |
76 if (!m->pixclock) { | |
77 printf("needs timings "); | |
78 return 0; | |
79 } | |
80 return 1; | |
81 } | |
82 | |
83 static FILE *fp; | |
84 static int line_num = 0; | |
85 static char *line; | |
86 static char *token[MAX_NR_TOKEN]; | |
87 | |
88 static int get_token(int num) | |
89 { | |
90 static int read_nextline = 1; | |
91 static int line_pos; | |
92 int i; | |
93 char c; | |
94 | |
95 if (num >= MAX_NR_TOKEN) { | |
96 printf("get_token(): max >= MAX_NR_TOKEN!"); | |
97 goto out_eof; | |
98 } | |
99 | |
100 if (read_nextline) { | |
101 if (!fgets(line, MAX_LINE_LEN, fp)) | |
102 goto out_eof; | |
103 line_pos = 0; | |
104 ++line_num; | |
105 read_nextline = 0; | |
106 } | |
107 for (i = 0; i < num; i++) { | |
108 while (isspace(line[line_pos])) | |
109 ++line_pos; | |
110 if (line[line_pos] == '\0' || line[line_pos] == '#') { | |
111 read_nextline = 1; | |
112 if (i == num) | |
113 goto out_ok; | |
114 goto out_eol; | |
115 } | |
116 token[i] = line + line_pos; | |
117 c = line[line_pos]; | |
118 if (c == '"' || c == '\'') { | |
119 token[i]++; | |
120 while (line[++line_pos] != c && line[line_pos]) | |
121 /* NOTHING */; | |
122 } else { | |
123 for (/* NOTHING */; !isspace(line[line_pos]) && | |
124 line[line_pos]; line_pos++) | |
125 /* NOTHING */; | |
126 } | |
127 if (!line[line_pos]) { | |
128 read_nextline = 1; | |
129 if (i == num - 1) | |
130 goto out_ok; | |
131 goto out_eol; | |
132 } | |
133 line[line_pos] = '\0'; | |
134 line_pos++; | |
135 } | |
136 out_ok: | |
137 return i; | |
138 out_eof: | |
139 return RET_EOF; | |
140 out_eol: | |
141 return RET_EOL; | |
142 } | |
143 | |
144 static fb_mode_t *fb_modes = NULL; | |
145 static int nr_modes = 0; | |
146 | |
147 static int parse_fbmode_cfg(char *cfgfile) | |
148 { | |
149 fb_mode_t *mode = NULL; | |
150 char *endptr; // strtoul()... | |
151 int tmp, i; | |
152 | |
153 #ifdef DEBUG | |
154 assert(cfgfile != NULL); | |
155 #endif | |
156 | |
157 printf("Reading %s: ", cfgfile); | |
158 | |
159 if ((fp = fopen(cfgfile, "r")) == NULL) { | |
160 printf("can't open '%s': %s\n", cfgfile, strerror(errno)); | |
161 return -1; | |
162 } | |
163 | |
164 if ((line = (char *) malloc(MAX_LINE_LEN + 1)) == NULL) { | |
165 printf("can't get memory for 'line': %s\n", strerror(errno)); | |
166 return -2; | |
167 } | |
168 | |
169 /* | |
170 * check if the cfgfile starts with 'mode' | |
171 */ | |
172 while ((tmp = get_token(1)) == RET_EOL) | |
173 /* NOTHING */; | |
174 if (tmp == RET_EOF) | |
175 goto out; | |
176 if (!strcmp(token[0], "mode")) | |
177 goto loop_enter; | |
178 goto err_out_parse_error; | |
179 | |
180 while ((tmp = get_token(1)) != RET_EOF) { | |
181 if (tmp == RET_EOL) | |
182 continue; | |
183 if (!strcmp(token[0], "mode")) { | |
184 if (!validate_mode(mode)) | |
185 goto err_out_not_valid; | |
186 loop_enter: | |
187 if (!(fb_modes = (fb_mode_t *) realloc(fb_modes, | |
188 sizeof(fb_mode_t) * (nr_modes + 1)))) { | |
189 printf("can't realloc 'fb_modes': %s\n", strerror(errno)); | |
190 goto err_out; | |
191 } | |
192 mode=fb_modes + nr_modes; | |
193 ++nr_modes; | |
194 memset(mode,0,sizeof(fb_mode_t)); | |
225 | 195 |
359 | 196 if (get_token(1) < 0) |
197 goto err_out_parse_error; | |
198 for (i = 0; i < nr_modes - 1; i++) { | |
199 if (!strcmp(token[0], fb_modes[i].name)) { | |
200 printf("mode name '%s' isn't unique", token[0]); | |
201 goto err_out_print_linenum; | |
202 } | |
203 } | |
204 if (!(mode->name = strdup(token[0]))) { | |
205 printf("can't strdup -> 'name': %s\n", strerror(errno)); | |
206 goto err_out; | |
207 } | |
208 } else if (!strcmp(token[0], "geometry")) { | |
209 if (get_token(5) < 0) | |
210 goto err_out_parse_error; | |
211 mode->xres = strtoul(token[0], &endptr, 0); | |
212 if (*endptr) | |
213 goto err_out_parse_error; | |
214 mode->yres = strtoul(token[1], &endptr, 0); | |
215 if (*endptr) | |
216 goto err_out_parse_error; | |
217 mode->vxres = strtoul(token[2], &endptr, 0); | |
218 if (*endptr) | |
219 goto err_out_parse_error; | |
220 mode->vyres = strtoul(token[3], &endptr, 0); | |
221 if (*endptr) | |
222 goto err_out_parse_error; | |
223 mode->depth = strtoul(token[4], &endptr, 0); | |
224 if (*endptr) | |
225 goto err_out_parse_error; | |
226 } else if (!strcmp(token[0], "timings")) { | |
227 if (get_token(7) < 0) | |
228 goto err_out_parse_error; | |
229 mode->pixclock = strtoul(token[0], &endptr, 0); | |
230 if (*endptr) | |
231 goto err_out_parse_error; | |
232 mode->left = strtoul(token[1], &endptr, 0); | |
233 if (*endptr) | |
234 goto err_out_parse_error; | |
235 mode->right = strtoul(token[2], &endptr, 0); | |
236 if (*endptr) | |
237 goto err_out_parse_error; | |
238 mode->upper = strtoul(token[3], &endptr, 0); | |
239 if (*endptr) | |
240 goto err_out_parse_error; | |
241 mode->lower = strtoul(token[4], &endptr, 0); | |
242 if (*endptr) | |
243 goto err_out_parse_error; | |
244 mode->hslen = strtoul(token[5], &endptr, 0); | |
245 if (*endptr) | |
246 goto err_out_parse_error; | |
247 mode->vslen = strtoul(token[6], &endptr, 0); | |
248 if (*endptr) | |
249 goto err_out_parse_error; | |
250 } else if (!strcmp(token[0], "endmode")) { | |
251 /* NOTHING for now*/ | |
383 | 252 } else if (!strcmp(token[0], "accel")) { |
253 if (get_token(1) < 0) | |
254 goto err_out_parse_error; | |
393 | 255 /* |
256 * it's only used for text acceleration | |
257 * so we just ignore it. | |
258 */ | |
359 | 259 } else if (!strcmp(token[0], "hsync")) { |
260 if (get_token(1) < 0) | |
261 goto err_out_parse_error; | |
262 if (!strcmp(token[0], "low")) | |
263 mode->sync &= ~FB_SYNC_HOR_HIGH_ACT; | |
264 else if(!strcmp(token[0], "high")) | |
265 mode->sync |= FB_SYNC_HOR_HIGH_ACT; | |
266 else | |
267 goto err_out_parse_error; | |
268 } else if (!strcmp(token[0], "vsync")) { | |
269 if (get_token(1) < 0) | |
270 goto err_out_parse_error; | |
271 if (!strcmp(token[0], "low")) | |
272 mode->sync &= ~FB_SYNC_VERT_HIGH_ACT; | |
273 else if(!strcmp(token[0], "high")) | |
274 mode->sync |= FB_SYNC_VERT_HIGH_ACT; | |
275 else | |
276 goto err_out_parse_error; | |
277 } else if (!strcmp(token[0], "csync")) { | |
278 if (get_token(1) < 0) | |
279 goto err_out_parse_error; | |
280 if (!strcmp(token[0], "low")) | |
281 mode->sync &= ~FB_SYNC_COMP_HIGH_ACT; | |
282 else if(!strcmp(token[0], "high")) | |
283 mode->sync |= FB_SYNC_COMP_HIGH_ACT; | |
284 else | |
285 goto err_out_parse_error; | |
286 } else if (!strcmp(token[0], "extsync")) { | |
287 if (get_token(1) < 0) | |
288 goto err_out_parse_error; | |
289 if (!strcmp(token[0], "false")) | |
290 mode->sync &= ~FB_SYNC_EXT; | |
291 else if(!strcmp(token[0], "true")) | |
292 mode->sync |= FB_SYNC_EXT; | |
293 else | |
294 goto err_out_parse_error; | |
295 } else if (!strcmp(token[0], "laced")) { | |
296 if (get_token(1) < 0) | |
297 goto err_out_parse_error; | |
298 if (!strcmp(token[0], "false")) | |
299 mode->vmode = FB_VMODE_NONINTERLACED; | |
300 else if (!strcmp(token[0], "true")) | |
301 mode->vmode = FB_VMODE_INTERLACED; | |
302 else | |
303 goto err_out_parse_error; | |
304 } else if (!strcmp(token[0], "dblscan")) { | |
305 if (get_token(1) < 0) | |
306 goto err_out_parse_error; | |
307 if (!strcmp(token[0], "false")) | |
308 ; | |
309 else if (!strcmp(token[0], "true")) | |
310 mode->vmode = FB_VMODE_DOUBLE; | |
311 else | |
312 goto err_out_parse_error; | |
313 } else | |
314 goto err_out_parse_error; | |
315 } | |
316 if (!validate_mode(mode)) | |
317 goto err_out_not_valid; | |
318 out: | |
319 printf("%d modes\n", nr_modes); | |
320 free(line); | |
321 fclose(fp); | |
322 return nr_modes; | |
323 err_out_parse_error: | |
324 printf("parse error"); | |
325 err_out_print_linenum: | |
326 PRINT_LINENUM; | |
327 err_out: | |
393 | 328 if (fb_modes) { |
359 | 329 free(fb_modes); |
393 | 330 fb_modes = NULL; |
331 } | |
332 nr_modes = 0; | |
359 | 333 free(line); |
334 free(fp); | |
335 return -2; | |
336 err_out_not_valid: | |
337 printf("mode is not definied correctly"); | |
338 goto err_out_print_linenum; | |
339 } | |
340 | |
341 static fb_mode_t *find_mode_by_name(char *name) | |
342 { | |
343 int i; | |
344 | |
345 for (i = 0; i < nr_modes; i++) { | |
346 if (!strcmp(name, fb_modes[i].name)) | |
347 return fb_modes + i; | |
348 } | |
349 return NULL; | |
350 } | |
351 | |
393 | 352 static float dcf(fb_mode_t *m) //driving clock frequency |
353 { | |
354 return 1000000.0f / m->pixclock; | |
355 } | |
356 | |
357 static float hsf(fb_mode_t *m) //horizontal scan frequency | |
358 { | |
359 int htotal = m->left + m->xres + m->right + m->hslen; | |
360 return dcf(m) / htotal; | |
361 } | |
362 | |
363 static float vsf(fb_mode_t *m) //vertical scan frequency | |
364 { | |
365 int vtotal = m->upper + m->yres + m->lower + m->vslen; | |
366 return hsf(m) / vtotal; | |
367 } | |
368 | |
369 typedef struct { | |
370 float min; | |
371 float max; | |
372 } range; | |
373 | |
374 static int in_range(range *r, float f) | |
375 { | |
376 for (/* NOTHING */; r; r++) { | |
377 if (f >= r->min && f <= r->max) | |
378 return 1; | |
379 } | |
380 return 0; | |
381 } | |
382 | |
383 static fb_mode_t *find_best_mode(int xres, int yres, range *hfreq, | |
384 range *vfreq, range *dotclock) | |
385 { | |
386 int i; | |
387 fb_mode_t *best = fb_modes; | |
388 fb_mode_t *curr = fb_modes + 1; | |
389 | |
390 for (i = nr_modes - 1; i; i--, curr++) { | |
391 if (curr->xres >= xres && curr->yres >= yres) { | |
392 if (curr->xres < best->xres && curr->yres < best->yres) { | |
393 if (!in_range(hfreq, hsf(curr))) | |
394 continue; | |
395 if (!in_range(vfreq, vsf(curr))) | |
396 continue; | |
397 if (!in_range(dotclock, dcf(curr))) | |
398 continue; | |
399 best = curr; | |
400 } | |
401 } | |
402 } | |
403 if ((best->xres < xres || best->yres < yres) || | |
404 !in_range(hfreq, hsf(best)) || | |
405 !in_range(vfreq, vsf(best)) || | |
406 !in_range(dotclock, dcf(curr))) | |
407 return NULL; | |
408 return best; | |
409 } | |
410 | |
359 | 411 /****************************** |
412 * vo_fbdev * | |
413 ******************************/ | |
414 | |
393 | 415 /* |
416 * command line/config file options | |
417 */ | |
418 char *fb_dev_name = NULL; | |
419 char *fb_mode_cfgfile = "/etc/fb.modes"; | |
420 char *fb_mode_name = NULL; | |
421 int fb_mode_depth = 0; | |
422 int fb_mode_auto = 0; | |
423 char *monitor_hfreq = NULL; | |
424 char *monitor_vfreq = NULL; | |
425 char *monitor_dotclock = NULL; | |
426 | |
427 static int fb_preinit_done = 0; | |
359 | 428 static int fb_works = 0; |
225 | 429 static int fb_dev_fd; |
430 static size_t fb_size; | |
431 static uint8_t *frame_buffer; | |
359 | 432 static struct fb_fix_screeninfo fb_finfo; |
433 static struct fb_var_screeninfo fb_orig_vinfo; | |
434 static struct fb_var_screeninfo fb_vinfo; | |
435 static struct fb_cmap *fb_oldcmap = NULL; | |
436 static int fb_pixel_size; // 32: 4 24: 3 16: 2 15: 2 | |
437 static int fb_real_bpp; // 32: 24 24: 24 16: 16 15: 15 | |
438 static int fb_bpp; // 32: 32 24: 24 16: 16 15: 15 | |
393 | 439 static int fb_bpp_we_want; // 32: 32 24: 24 16: 16 15: 15 |
359 | 440 static int fb_screen_width; |
441 static fb_mode_t *fb_mode = NULL; | |
442 | |
443 static uint8_t *next_frame; | |
225 | 444 static int in_width; |
445 static int in_height; | |
446 static int out_width; | |
447 static int out_height; | |
448 static uint32_t pixel_format; | |
449 | |
305 | 450 /* |
451 * Note: this function is completely cut'n'pasted from | |
452 * Chris Lawrence's code. | |
311 | 453 * (modified a bit to fit in my code...) |
305 | 454 */ |
455 struct fb_cmap *make_directcolor_cmap(struct fb_var_screeninfo *var) | |
456 { | |
457 /* Hopefully any DIRECTCOLOR device will have a big enough palette | |
458 * to handle mapping the full color depth. | |
459 * e.g. 8 bpp -> 256 entry palette | |
460 * | |
461 * We could handle some sort of gamma here | |
462 */ | |
463 int i, cols, rcols, gcols, bcols; | |
464 uint16_t *red, *green, *blue; | |
465 struct fb_cmap *cmap; | |
466 | |
467 rcols = 1 << var->red.length; | |
468 gcols = 1 << var->green.length; | |
469 bcols = 1 << var->blue.length; | |
470 | |
471 /* Make our palette the length of the deepest color */ | |
472 cols = (rcols > gcols ? rcols : gcols); | |
473 cols = (cols > bcols ? cols : bcols); | |
474 | |
475 red = malloc(cols * sizeof(red[0])); | |
476 if(!red) { | |
477 printf("Can't allocate red palette with %d entries.\n", cols); | |
478 return NULL; | |
479 } | |
480 for(i=0; i< rcols; i++) | |
481 red[i] = (65535/(rcols-1)) * i; | |
482 | |
483 green = malloc(cols * sizeof(green[0])); | |
484 if(!green) { | |
485 printf("Can't allocate green palette with %d entries.\n", cols); | |
486 free(red); | |
487 return NULL; | |
488 } | |
489 for(i=0; i< gcols; i++) | |
490 green[i] = (65535/(gcols-1)) * i; | |
491 | |
492 blue = malloc(cols * sizeof(blue[0])); | |
493 if(!blue) { | |
494 printf("Can't allocate blue palette with %d entries.\n", cols); | |
495 free(red); | |
496 free(green); | |
497 return NULL; | |
498 } | |
499 for(i=0; i< bcols; i++) | |
500 blue[i] = (65535/(bcols-1)) * i; | |
501 | |
502 cmap = malloc(sizeof(struct fb_cmap)); | |
503 if(!cmap) { | |
504 printf("Can't allocate color map\n"); | |
505 free(red); | |
506 free(green); | |
507 free(blue); | |
508 return NULL; | |
509 } | |
510 cmap->start = 0; | |
511 cmap->transp = 0; | |
512 cmap->len = cols; | |
513 cmap->red = red; | |
514 cmap->blue = blue; | |
515 cmap->green = green; | |
516 cmap->transp = NULL; | |
517 | |
518 return cmap; | |
519 } | |
225 | 520 |
393 | 521 static void set_bpp(struct fb_var_screeninfo *p, int bpp) |
379 | 522 { |
393 | 523 p->bits_per_pixel = (bpp == 15) ? 16 : bpp; |
524 p->red.msb_right = p->green.msb_right = p->blue.msb_right = 0; | |
525 switch (bpp) { | |
379 | 526 case 32: |
527 case 24: | |
528 p->red.offset = 16; | |
529 p->red.length = 8; | |
530 p->green.offset = 8; | |
531 p->green.length = 8; | |
532 p->blue.offset = 0; | |
533 p->blue.length = 8; | |
534 break; | |
535 case 16: | |
536 p->red.offset = 11; | |
537 p->red.length = 5; | |
538 p->green.offset = 5; | |
539 p->green.length = 6; | |
540 p->blue.offset = 0; | |
541 p->blue.length = 5; | |
542 break; | |
543 case 15: | |
544 p->red.offset = 10; | |
545 p->red.length = 5; | |
546 p->green.offset = 5; | |
547 p->green.length = 5; | |
548 p->blue.offset = 0; | |
549 p->blue.length = 5; | |
550 break; | |
551 } | |
552 } | |
553 | |
393 | 554 static int fb_preinit(void) |
225 | 555 { |
393 | 556 if (!fb_dev_name && !(fb_dev_name = getenv("FRAMEBUFFER"))) |
557 fb_dev_name = "/dev/fb0"; | |
558 if (verbose > 0) | |
559 printf(FBDEV "using %s\n", fb_dev_name); | |
225 | 560 |
393 | 561 if ((fb_dev_fd = open(fb_dev_name, O_RDWR)) == -1) { |
562 printf(FBDEV "Can't open %s: %s\n", fb_dev_name, strerror(errno)); | |
563 goto err_out; | |
564 } | |
565 if (ioctl(fb_dev_fd, FBIOGET_VSCREENINFO, &fb_vinfo)) { | |
566 printf(FBDEV "Can't get VSCREENINFO: %s\n", strerror(errno)); | |
567 goto err_out_fd; | |
568 } | |
569 | |
570 fb_bpp = (fb_vinfo.bits_per_pixel == 32) ? 32 : | |
571 (fb_vinfo.red.length + fb_vinfo.green.length + | |
572 fb_vinfo.blue.length); | |
573 | |
574 if ((!!fb_mode_name + !!fb_mode_depth + !!fb_mode_auto) > 1) { | |
575 printf(FBDEV "Use can use only one of the following parameters:" | |
576 "-fbmode, -fbdepth, -fbauto\n"); | |
577 goto err_out; | |
578 } | |
579 if (fb_mode_name || fb_mode_auto) | |
359 | 580 if (parse_fbmode_cfg(fb_mode_cfgfile) < 0) |
383 | 581 goto err_out; |
393 | 582 |
583 if (fb_mode_name) { | |
359 | 584 if (!(fb_mode = find_mode_by_name(fb_mode_name))) { |
393 | 585 printf(FBDEV "can't find requested video mode\n"); |
383 | 586 goto err_out; |
359 | 587 } |
393 | 588 fb_bpp = fb_mode->depth; |
363 | 589 } else if (fb_mode_depth) { |
393 | 590 printf(FBDEV "Do _not_ use the 'fbdepth' parameter! " |
363 | 591 "this parameter will be removed\n"); |
364 | 592 if (fb_mode_depth != 15 && fb_mode_depth != 16 && |
593 fb_mode_depth != 24 && fb_mode_depth != 32) { | |
393 | 594 printf(FBDEV "can't switch to %d bpp\n", fb_mode_depth); |
383 | 595 goto err_out; |
363 | 596 } |
393 | 597 fb_bpp = fb_mode_depth; |
598 } else if (fb_mode_auto) { | |
599 printf(FBDEV "Not implemented. try later... :)\n"); | |
600 goto err_out; | |
601 fb_bpp = fb_mode->depth; | |
359 | 602 } |
393 | 603 fb_bpp_we_want = fb_bpp; |
245
cb4c682746c0
disabled scrollback buffer (virtual fb size set to real screen size)
szabii
parents:
231
diff
changeset
|
604 |
393 | 605 fb_preinit_done = 1; |
606 fb_works = 1; | |
607 return 0; | |
608 err_out_fd: | |
609 close(fb_dev_fd); | |
610 fb_dev_fd = -1; | |
611 err_out: | |
612 fb_preinit_done = 1; | |
613 return 1; | |
614 } | |
245
cb4c682746c0
disabled scrollback buffer (virtual fb size set to real screen size)
szabii
parents:
231
diff
changeset
|
615 |
393 | 616 static uint32_t init(uint32_t width, uint32_t height, uint32_t d_width, |
617 uint32_t d_height, uint32_t fullscreen, char *title, | |
618 uint32_t format) | |
619 { | |
620 struct fb_cmap *cmap; | |
621 | |
622 if (!fb_preinit_done) | |
623 if (fb_preinit()) | |
624 return 1; | |
625 if (!fb_works) | |
626 return 1; | |
245
cb4c682746c0
disabled scrollback buffer (virtual fb size set to real screen size)
szabii
parents:
231
diff
changeset
|
627 |
359 | 628 fb_orig_vinfo = fb_vinfo; |
393 | 629 if (fb_mode_name) { |
359 | 630 fb_vinfo.xres = fb_mode->xres; |
631 fb_vinfo.yres = fb_mode->yres; | |
632 fb_vinfo.xres_virtual = fb_mode->vxres; | |
633 fb_vinfo.yres_virtual = fb_mode->vyres; | |
393 | 634 set_bpp(&fb_vinfo, fb_mode->depth); |
359 | 635 fb_vinfo.pixclock = fb_mode->pixclock; |
636 fb_vinfo.left_margin = fb_mode->left; | |
637 fb_vinfo.right_margin = fb_mode->right; | |
638 fb_vinfo.upper_margin = fb_mode->upper; | |
639 fb_vinfo.lower_margin = fb_mode->lower; | |
640 fb_vinfo.hsync_len = fb_mode->hslen; | |
641 fb_vinfo.vsync_len = fb_mode->vslen; | |
642 fb_vinfo.sync = fb_mode->sync; | |
643 fb_vinfo.vmode = fb_mode->vmode; | |
363 | 644 } else if (fb_mode_depth) { |
393 | 645 set_bpp(&fb_vinfo, fb_mode_depth); |
359 | 646 } |
647 fb_vinfo.xres_virtual = fb_vinfo.xres; | |
648 fb_vinfo.yres_virtual = fb_vinfo.yres; | |
245
cb4c682746c0
disabled scrollback buffer (virtual fb size set to real screen size)
szabii
parents:
231
diff
changeset
|
649 |
359 | 650 if (ioctl(fb_dev_fd, FBIOPUT_VSCREENINFO, &fb_vinfo)) { |
393 | 651 printf(FBDEV "Can't put VSCREENINFO: %s\n", strerror(errno)); |
652 return 1; | |
653 } | |
654 if (ioctl(fb_dev_fd, FBIOGET_VSCREENINFO, &fb_vinfo)) { | |
655 printf(FBDEV "Can't get VSCREENINFO: %s\n", strerror(errno)); | |
656 return 1; | |
245
cb4c682746c0
disabled scrollback buffer (virtual fb size set to real screen size)
szabii
parents:
231
diff
changeset
|
657 } |
cb4c682746c0
disabled scrollback buffer (virtual fb size set to real screen size)
szabii
parents:
231
diff
changeset
|
658 |
393 | 659 if (verbose > 0) { |
660 printf(FBDEV "var info:\n"); | |
661 printf(FBDEV "xres: %ul\n", fb_vinfo.xres); | |
662 printf(FBDEV "yres: %ul\n", fb_vinfo.yres); | |
663 printf(FBDEV "xres_virtual: %ul\n", fb_vinfo.xres_virtual); | |
664 printf(FBDEV "yres_virtual: %ul\n", fb_vinfo.yres_virtual); | |
665 printf(FBDEV "xoffset: %ul\n", fb_vinfo.xoffset); | |
666 printf(FBDEV "yoffset: %ul\n", fb_vinfo.yoffset); | |
667 printf(FBDEV "bits_per_pixel: %ul\n", fb_vinfo.bits_per_pixel); | |
668 printf(FBDEV "grayscale: %ul\n", fb_vinfo.grayscale); | |
669 printf(FBDEV "red: %lu %lu %lu\n", | |
670 (unsigned long) fb_vinfo.red.offset, | |
671 (unsigned long) fb_vinfo.red.length, | |
672 (unsigned long) fb_vinfo.red.msb_right); | |
673 printf(FBDEV "green: %lu %lu %lu\n", | |
674 (unsigned long) fb_vinfo.green.offset, | |
675 (unsigned long) fb_vinfo.green.length, | |
676 (unsigned long) fb_vinfo.green.msb_right); | |
677 printf(FBDEV "blue: %lu %lu %lu\n", | |
678 (unsigned long) fb_vinfo.blue.offset, | |
679 (unsigned long) fb_vinfo.blue.length, | |
680 (unsigned long) fb_vinfo.blue.msb_right); | |
681 printf(FBDEV "transp: %lu %lu %lu\n", | |
682 (unsigned long) fb_vinfo.transp.offset, | |
683 (unsigned long) fb_vinfo.transp.length, | |
684 (unsigned long) fb_vinfo.transp.msb_right); | |
685 printf(FBDEV "nonstd: %ul\n", fb_vinfo.nonstd); | |
686 if (verbose > 1) { | |
687 printf(FBDEV "activate: %ul\n", fb_vinfo.activate); | |
688 printf(FBDEV "height: %ul\n", fb_vinfo.height); | |
689 printf(FBDEV "width: %ul\n", fb_vinfo.width); | |
690 printf(FBDEV "accel_flags: %ul\n", fb_vinfo.accel_flags); | |
691 printf(FBDEV "timing:\n"); | |
692 printf(FBDEV "pixclock: %ul\n", fb_vinfo.pixclock); | |
693 printf(FBDEV "left_margin: %ul\n", fb_vinfo.left_margin); | |
694 printf(FBDEV "right_margin: %ul\n", fb_vinfo.right_margin); | |
695 printf(FBDEV "upper_margin: %ul\n", fb_vinfo.upper_margin); | |
696 printf(FBDEV "lower_margin: %ul\n", fb_vinfo.lower_margin); | |
697 printf(FBDEV "hsync_len: %ul\n", fb_vinfo.hsync_len); | |
698 printf(FBDEV "vsync_len: %ul\n", fb_vinfo.vsync_len); | |
699 printf(FBDEV "sync: %ul\n", fb_vinfo.sync); | |
700 printf(FBDEV "vmode: %ul\n", fb_vinfo.vmode); | |
701 } | |
702 } | |
359 | 703 if (ioctl(fb_dev_fd, FBIOGET_FSCREENINFO, &fb_finfo)) { |
393 | 704 printf(FBDEV "Can't get FSCREENINFO: %s\n", strerror(errno)); |
225 | 705 return 1; |
706 } | |
393 | 707 if (verbose > 0) { |
708 printf(FBDEV "fix info:\n"); | |
709 if (verbose > 1) { | |
710 printf(FBDEV "id: %.16s\n", fb_finfo.id); | |
711 printf(FBDEV "smem_start: %p\n", (void *) fb_finfo.smem_start); | |
712 } | |
713 printf(FBDEV "framebuffer size: %d bytes\n", fb_size); | |
714 printf(FBDEV "type: %lu\n", (unsigned long) fb_finfo.type); | |
715 printf(FBDEV "type_aux: %lu\n", (unsigned long) fb_finfo.type_aux); | |
716 printf(FBDEV "visual: %lu\n", (unsigned long) fb_finfo.visual); | |
717 if (verbose > 1) { | |
718 printf(FBDEV "xpanstep: %u\n", fb_finfo.xpanstep); | |
719 printf(FBDEV "ypanstep: %u\n", fb_finfo.ypanstep); | |
720 printf(FBDEV "ywrapstep: %u\n", fb_finfo.ywrapstep); | |
721 } | |
722 printf(FBDEV "line_length: %lu bytes\n", (unsigned long) fb_finfo.line_length); | |
723 if (verbose > 1) { | |
724 printf(FBDEV "mmio_start: %p\n", (void *) fb_finfo.mmio_start); | |
725 printf(FBDEV "mmio_len: %ul bytes\n", fb_finfo.mmio_len); | |
726 printf(FBDEV "accel: %ul\n", fb_finfo.accel); | |
727 } | |
728 } | |
359 | 729 switch (fb_finfo.type) { |
225 | 730 case FB_TYPE_VGA_PLANES: |
393 | 731 printf(FBDEV "FB_TYPE_VGA_PLANES not supported.\n"); |
732 return 1; | |
225 | 733 case FB_TYPE_PLANES: |
393 | 734 printf(FBDEV "FB_TYPE_PLANES not supported.\n"); |
735 return 1; | |
225 | 736 case FB_TYPE_INTERLEAVED_PLANES: |
393 | 737 printf(FBDEV "FB_TYPE_INTERLEAVED_PLANES not supported.\n"); |
738 return 1; | |
225 | 739 #ifdef FB_TYPE_TEXT |
740 case FB_TYPE_TEXT: | |
393 | 741 printf(FBDEV "FB_TYPE_TEXT not supported.\n"); |
742 return 1; | |
225 | 743 #endif |
744 case FB_TYPE_PACKED_PIXELS: | |
745 /* OK */ | |
379 | 746 if (verbose > 0) |
393 | 747 printf(FBDEV "FB_TYPE_PACKED_PIXELS: OK\n"); |
225 | 748 break; |
749 default: | |
393 | 750 printf(FBDEV "unknown FB_TYPE: %d\n", fb_finfo.type); |
751 return 1; | |
305 | 752 } |
379 | 753 switch (fb_finfo.visual) { |
393 | 754 case FB_VISUAL_TRUECOLOR: |
755 break; | |
756 case FB_VISUAL_DIRECTCOLOR: | |
757 if (verbose > 0) | |
758 printf(FBDEV "creating cmap for directcolor\n"); | |
759 if (ioctl(fb_dev_fd, FBIOGETCMAP, fb_oldcmap)) { | |
760 printf(FBDEV "can't get cmap: %s\n", | |
761 strerror(errno)); | |
762 return 1; | |
763 } | |
764 if (!(cmap = make_directcolor_cmap(&fb_vinfo))) | |
765 return 1; | |
766 if (ioctl(fb_dev_fd, FBIOPUTCMAP, cmap)) { | |
767 printf(FBDEV "can't put cmap: %s\n", | |
768 strerror(errno)); | |
769 return 1; | |
770 } | |
771 free(cmap->red); | |
772 free(cmap->green); | |
773 free(cmap->blue); | |
774 free(cmap); | |
775 break; | |
776 case FB_VISUAL_PSEUDOCOLOR: | |
777 printf(FBDEV "visual is FB_VISUAL_PSEUDOCOLOR." | |
778 "it's not tested!\n"); | |
779 break; | |
780 default: | |
781 printf(FBDEV "visual: %d not yet supported\n", | |
782 fb_finfo.visual); | |
783 return 1; | |
245
cb4c682746c0
disabled scrollback buffer (virtual fb size set to real screen size)
szabii
parents:
231
diff
changeset
|
784 } |
cb4c682746c0
disabled scrollback buffer (virtual fb size set to real screen size)
szabii
parents:
231
diff
changeset
|
785 |
359 | 786 fb_pixel_size = fb_vinfo.bits_per_pixel / 8; |
787 fb_real_bpp = fb_vinfo.red.length + fb_vinfo.green.length + | |
788 fb_vinfo.blue.length; | |
789 fb_bpp = (fb_pixel_size == 4) ? 32 : fb_real_bpp; | |
393 | 790 if (fb_bpp_we_want != fb_bpp) |
791 printf(FBDEV "can't set bpp (requested %d, got %d bpp)!!!\n", | |
792 fb_bpp_we_want, fb_bpp); | |
359 | 793 fb_screen_width = fb_finfo.line_length; |
794 fb_size = fb_finfo.smem_len; | |
225 | 795 if ((frame_buffer = (uint8_t *) mmap(0, fb_size, PROT_READ | PROT_WRITE, |
796 MAP_SHARED, fb_dev_fd, 0)) == (uint8_t *) -1) { | |
393 | 797 printf(FBDEV "Can't mmap %s: %s\n", fb_dev_name, strerror(errno)); |
798 return 1; | |
225 | 799 } |
229 | 800 |
393 | 801 if (verbose > 0) { |
802 printf(FBDEV "other:\n"); | |
803 if (verbose > 1) | |
804 printf(FBDEV "frame_buffer @ %p\n", frame_buffer); | |
805 printf(FBDEV "fb_bpp: %d\n", fb_bpp); | |
806 printf(FBDEV "fb_real_bpp: %d\n", fb_real_bpp); | |
807 printf(FBDEV "fb_pixel_size: %d bytes\n", fb_pixel_size); | |
808 printf(FBDEV "pixel per line: %d\n", fb_screen_width / fb_pixel_size); | |
379 | 809 } |
225 | 810 |
811 in_width = width; | |
812 in_height = height; | |
813 out_width = width; | |
814 out_height = height; | |
815 pixel_format = format; | |
278 | 816 if (!(next_frame = (uint8_t *) malloc(in_width * in_height * fb_pixel_size))) { |
393 | 817 printf(FBDEV "Can't malloc next_frame: %s\n", strerror(errno)); |
225 | 818 return 1; |
819 } | |
820 | |
821 if (format == IMGFMT_YV12) | |
359 | 822 yuv2rgb_init(fb_bpp, MODE_RGB); |
225 | 823 return 0; |
824 } | |
825 | |
826 static uint32_t query_format(uint32_t format) | |
827 { | |
393 | 828 if (!fb_preinit_done) |
829 if (fb_preinit()) | |
229 | 830 return 0; |
305 | 831 if (!fb_works) |
832 return 0; | |
833 | |
380 | 834 if (verbose > 0) |
393 | 835 printf(FBDEV "query_format(%#lx(%.4s))\n",(unsigned long) format, |
836 (char *) &format); | |
311 | 837 if ((format & IMGFMT_BGR_MASK) == IMGFMT_BGR) { |
838 int bpp = format & 0xff; | |
359 | 839 if (bpp == fb_bpp) |
311 | 840 return 1; |
359 | 841 else if (bpp == 15 && fb_bpp == 16) |
311 | 842 return 1; |
359 | 843 else if (bpp == 24 && fb_bpp == 32) |
311 | 844 return 1; |
845 } | |
846 if (format == IMGFMT_YV12) | |
847 return 1; | |
848 return 0; | |
225 | 849 } |
850 | |
851 static const vo_info_t *get_info(void) | |
852 { | |
853 return &vo_info; | |
854 } | |
855 | |
393 | 856 extern void vo_draw_alpha_rgb32(int w, int h, unsigned char* src, |
857 unsigned char *srca, int srcstride, unsigned char* dstbase, | |
858 int dststride); | |
859 extern void vo_draw_alpha_rgb24(int w, int h, unsigned char* src, | |
860 unsigned char *srca, int srcstride, unsigned char* dstbase, | |
861 int dststride); | |
862 extern void vo_draw_alpha_rgb16(int w, int h, unsigned char* src, | |
863 unsigned char *srca, int srcstride, unsigned char* dstbase, | |
864 int dststride); | |
865 extern void vo_draw_alpha_rgb15(int w, int h, unsigned char* src, | |
866 unsigned char *srca, int srcstride, unsigned char* dstbase, | |
867 int dststride); | |
868 | |
225 | 869 static void draw_alpha(int x0, int y0, int w, int h, unsigned char *src, |
870 unsigned char *srca, int stride) | |
871 { | |
359 | 872 uint8_t *dst = next_frame + (in_width * y0 + x0) * fb_pixel_size; |
873 int dstride = in_width * fb_pixel_size; | |
874 | |
875 switch (fb_real_bpp) { | |
876 case 24: | |
877 vo_draw_alpha_rgb24(w, h, src, srca, stride, dst, dstride); | |
878 break; | |
879 case 32: | |
880 vo_draw_alpha_rgb32(w, h, src, srca, stride, dst, dstride); | |
881 break; | |
882 case 15: | |
883 vo_draw_alpha_rgb15(w, h, src, srca, stride, dst, dstride); | |
884 break; | |
885 case 16: | |
886 vo_draw_alpha_rgb16(w, h, src, srca, stride, dst, dstride); | |
887 break; | |
888 } | |
225 | 889 } |
890 | |
891 static uint32_t draw_frame(uint8_t *src[]) | |
892 { | |
893 if (pixel_format == IMGFMT_YV12) { | |
894 yuv2rgb(next_frame, src[0], src[1], src[2], in_width, | |
278 | 895 in_height, in_width * fb_pixel_size, |
225 | 896 in_width, in_width / 2); |
311 | 897 } else { |
898 int sbpp = ((pixel_format & 0xff) + 7) / 8; | |
899 char *d = next_frame; | |
900 char *s = src[0]; | |
901 if (sbpp == fb_pixel_size) { | |
359 | 902 if (fb_real_bpp == 16 && pixel_format == (IMGFMT_BGR|15)) { |
311 | 903 #ifdef HAVE_MMX |
904 rgb15to16_mmx(s, d, 2 * in_width * in_height); | |
905 #else | |
906 unsigned short *s1 = (unsigned short *) s; | |
907 unsigned short *d1 = (unsigned short *) d; | |
908 unsigned short *e = s1 + in_width * in_height; | |
909 while (s1<e) { | |
910 register x = *(s1++); | |
911 *(d1++) = (x&0x001f)|((x&0x7fe0)<<1); | |
912 } | |
913 #endif | |
914 } else | |
915 memcpy(d, s, sbpp * in_width * in_height); | |
916 } | |
917 } | |
225 | 918 return 0; |
919 } | |
920 | |
921 static uint32_t draw_slice(uint8_t *src[], int stride[], int w, int h, int x, | |
922 int y) | |
923 { | |
924 uint8_t *dest; | |
925 | |
278 | 926 dest = next_frame + (in_width * y + x) * fb_pixel_size; |
927 yuv2rgb(dest, src[0], src[1], src[2], w, h, in_width * fb_pixel_size, | |
225 | 928 stride[0], stride[1]); |
929 return 0; | |
930 } | |
931 | |
932 static void check_events(void) | |
933 { | |
934 } | |
935 | |
246 | 936 static void put_frame(void) |
225 | 937 { |
938 int i, out_offset = 0, in_offset = 0; | |
939 | |
940 for (i = 0; i < in_height; i++) { | |
941 memcpy(frame_buffer + out_offset, next_frame + in_offset, | |
278 | 942 in_width * fb_pixel_size); |
359 | 943 out_offset += fb_screen_width; |
278 | 944 in_offset += in_width * fb_pixel_size; |
225 | 945 } |
946 } | |
947 | |
393 | 948 extern void vo_draw_text(int dxs, int dys, void (*draw_alpha)(int x0, int y0, |
949 int w, int h, unsigned char *src, unsigned char *srca, | |
950 int stride)); | |
951 | |
246 | 952 static void flip_page(void) |
953 { | |
954 vo_draw_text(in_width, in_height, draw_alpha); | |
955 check_events(); | |
956 put_frame(); | |
957 } | |
958 | |
225 | 959 static void uninit(void) |
960 { | |
379 | 961 if (verbose > 0) |
393 | 962 printf(FBDEV "uninit\n"); |
359 | 963 if (fb_oldcmap) { |
964 if (ioctl(fb_dev_fd, FBIOPUTCMAP, fb_oldcmap)) | |
393 | 965 printf(FBDEV "Can't restore original cmap\n"); |
359 | 966 fb_oldcmap = NULL; |
306 | 967 } |
379 | 968 if (ioctl(fb_dev_fd, FBIOPUT_VSCREENINFO, &fb_orig_vinfo)) |
393 | 969 printf(FBDEV "Can't set virtual screensize to original value: %s\n", strerror(errno)); |
359 | 970 close(fb_dev_fd); |
278 | 971 memset(next_frame, '\0', in_height * in_width * fb_pixel_size); |
246 | 972 put_frame(); |
225 | 973 free(next_frame); |
974 munmap(frame_buffer, fb_size); | |
975 } |