rpm: Remove MEncoder from rpm packaging
[mplayer/glamo.git] / libvo / vo_s3fb.c
blob5b884b75b80292ac736f1b91cf70b5fe7c2f2a63
1 /*
2 * copyright (C) 2006 Mark Sanderson <mmp@kiora.ath.cx>
4 * 30-Mar-2006 Modified from tdfxfb.c by Mark Zealey
6 * This file is part of MPlayer.
8 * MPlayer is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
13 * MPlayer is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License along
19 * with MPlayer; if not, write to the Free Software Foundation, Inc.,
20 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
23 /* Hints and tricks:
24 * - Use -dr to get direct rendering
25 * - Use -vf yuy2 to get yuy2 rendering, *MUCH* faster than yv12
28 #include <stdio.h>
29 #include <stdlib.h>
30 #include <errno.h>
31 #include <string.h>
32 #include <unistd.h>
33 #include <sys/ioctl.h>
34 #include <fcntl.h>
35 #include <linux/fb.h>
36 #include <sys/io.h>
38 #include "config.h"
39 #ifdef HAVE_SYS_MMAN_H
40 #include <sys/mman.h>
41 #endif
42 #include "mp_msg.h"
43 #include "fastmemcpy.h"
44 #include "video_out.h"
45 #include "video_out_internal.h"
46 #include "aspect.h"
47 #include "sub.h"
49 static const vo_info_t info =
51 "S3 Virge over fbdev",
52 "s3fb",
53 "Mark Sanderson <mmp@kiora.ath.cx>",
57 const LIBVO_EXTERN(s3fb)
59 typedef struct vga_type {
60 int cr38, cr39, cr53;
61 unsigned char *mmio;
62 } vga_t;
64 static vga_t *v = NULL;
65 static int fd = -1;
66 static struct fb_fix_screeninfo fb_finfo;
67 static struct fb_var_screeninfo fb_vinfo;
68 static uint32_t in_width, in_height, in_format, in_depth, in_s3_format,
69 screenwidth, screenheight, screendepth, screenstride,
70 vidwidth, vidheight, vidx, vidy, page, offset, sreg;
71 static char *inpage, *inpage0, *smem = NULL;
72 static void (*alpha_func)();
74 static void clear_screen(void);
76 /* streams registers */
77 #define PSTREAM_CONTROL_REG 0x8180
78 #define COL_CHROMA_KEY_CONTROL_REG 0x8184
79 #define SSTREAM_CONTROL_REG 0x8190
80 #define CHROMA_KEY_UPPER_BOUND_REG 0x8194
81 #define SSTREAM_STRETCH_REG 0x8198
82 #define BLEND_CONTROL_REG 0x81A0
83 #define PSTREAM_FBADDR0_REG 0x81C0
84 #define PSTREAM_FBADDR1_REG 0x81C4
85 #define PSTREAM_STRIDE_REG 0x81C8
86 #define DOUBLE_BUFFER_REG 0x81CC
87 #define SSTREAM_FBADDR0_REG 0x81D0
88 #define SSTREAM_FBADDR1_REG 0x81D4
89 #define SSTREAM_STRIDE_REG 0x81D8
90 #define OPAQUE_OVERLAY_CONTROL_REG 0x81DC
91 #define K1_VSCALE_REG 0x81E0
92 #define K2_VSCALE_REG 0x81E4
93 #define DDA_VERT_REG 0x81E8
94 #define STREAMS_FIFO_REG 0x81EC
95 #define PSTREAM_START_REG 0x81F0
96 #define PSTREAM_WINDOW_SIZE_REG 0x81F4
97 #define SSTREAM_START_REG 0x81F8
98 #define SSTREAM_WINDOW_SIZE_REG 0x81FC
100 #define S3_MEMBASE sreg
101 #define S3_NEWMMIO_REGBASE 0x1000000 /* 16MB */
102 #define S3_NEWMMIO_REGSIZE 0x10000 /* 64KB */
103 #define S3V_MMIO_REGSIZE 0x8000 /* 32KB */
104 #define S3_NEWMMIO_VGABASE (S3_NEWMMIO_REGBASE + 0x8000)
106 #define OUTREG(mmreg, value) *(unsigned int *)(&v->mmio[mmreg]) = value
108 int readcrtc(int reg) {
109 outb(reg, 0x3d4);
110 return inb(0x3d5);
113 void writecrtc(int reg, int value) {
114 outb(reg, 0x3d4);
115 outb(value, 0x3d5);
118 // enable S3 registers
119 int enable(void) {
120 int fd;
122 if (v)
123 return 1;
124 errno = 0;
125 v = malloc(sizeof(vga_t));
126 if (v) {
127 if (ioperm(0x3d4, 2, 1) == 0) {
128 fd = open("/dev/mem", O_RDWR);
129 if (fd != -1) {
130 v->mmio = mmap(0, S3_NEWMMIO_REGSIZE, PROT_READ|PROT_WRITE, MAP_SHARED, fd,
131 S3_MEMBASE + S3_NEWMMIO_REGBASE);
132 close(fd);
133 if (v->mmio != MAP_FAILED) {
134 v->cr38 = readcrtc(0x38);
135 v->cr39 = readcrtc(0x39);
136 v->cr53 = readcrtc(0x53);
137 writecrtc(0x38, 0x48);
138 writecrtc(0x39, 0xa5);
139 writecrtc(0x53, 0x08);
140 return 1;
143 iopl(0);
145 free(v);
146 v = NULL;
148 return 0;
151 void disable(void) {
152 if (v) {
153 writecrtc(0x53, v->cr53);
154 writecrtc(0x39, v->cr39);
155 writecrtc(0x38, v->cr38);
156 ioperm(0x3d4, 2, 0);
157 munmap(v->mmio, S3_NEWMMIO_REGSIZE);
158 free(v);
159 v = NULL;
163 int yuv_on(int format, int src_w, int src_h, int dst_x, int dst_y, int dst_w, int dst_h, int crop, int xres, int yres, int line_length, int offset) {
164 int tmp, pitch, start, src_wc, src_hc, bpp;
166 if (format == 0 || format == 7)
167 bpp = 4;
168 else if (format == 6)
169 bpp = 3;
170 else
171 bpp = 2;
173 src_wc = src_w - crop * 2;
174 src_hc = src_h - crop * 2;
175 pitch = src_w * bpp;
177 // video card memory layout:
178 // 0-n: visible screen memory, n = width * height * bytes per pixel
179 // n-m: scaler source memory, n is aligned to a page boundary
180 // m+: scaler source memory for multiple buffers
182 // offset is the first aligned byte after the screen memory, where the scaler input buffer is
183 tmp = (yres * line_length + 4095) & ~4095;
184 offset += tmp;
186 // start is the top left viewable scaler input pixel
187 start = offset + crop * pitch + crop * bpp;
189 OUTREG(COL_CHROMA_KEY_CONTROL_REG, 0x47000000);
190 OUTREG(CHROMA_KEY_UPPER_BOUND_REG, 0x0);
191 OUTREG(BLEND_CONTROL_REG, 0x00000020);
192 OUTREG(DOUBLE_BUFFER_REG, 0x0); /* Choose fbaddr0 as stream source. */
193 OUTREG(OPAQUE_OVERLAY_CONTROL_REG, 0x0);
195 OUTREG(PSTREAM_CONTROL_REG, 0x06000000);
196 OUTREG(PSTREAM_FBADDR0_REG, 0x0);
197 OUTREG(PSTREAM_FBADDR1_REG, 0x0);
198 OUTREG(PSTREAM_STRIDE_REG, line_length);
199 OUTREG(PSTREAM_START_REG, 0x00010001);
200 OUTREG(PSTREAM_WINDOW_SIZE_REG, 0x00010001);
201 //OUTREG(SSTREAM_WINDOW_SIZE_REG, ( ((xres-1) << 16) | yres) & 0x7ff07ff);
203 if (dst_w == src_w)
204 tmp = 0;
205 else
206 tmp = 2;
207 /* format 1=YCbCr-16 2=YUV-16 3=BGR15 4=YUV-16/32(mixed 2/4byte stride) 5=BGR16 6=BGR24 0,7=BGR32 */
208 /* The YUV format pixel has a range of value from 0 to 255, while the YCbCr format pixel values are in the range of 16 to 240. */
209 OUTREG(SSTREAM_CONTROL_REG, tmp << 28 | (format << 24) |
210 ((((src_wc-1)<<1)-(dst_w-1)) & 0xfff));
211 OUTREG(SSTREAM_STRETCH_REG,
212 ((src_wc - 1) & 0x7ff) | (((src_wc - dst_w-1) & 0x7ff) << 16));
213 OUTREG(SSTREAM_FBADDR0_REG, start & 0x3fffff );
214 OUTREG(SSTREAM_STRIDE_REG, pitch & 0xfff );
215 OUTREG(SSTREAM_START_REG, ((dst_x + 1) << 16) | (dst_y + 1));
216 OUTREG(SSTREAM_WINDOW_SIZE_REG, ( ((dst_w-1) << 16) | (dst_h ) ) & 0x7ff07ff);
217 OUTREG(K1_VSCALE_REG, src_hc - 1 );
218 OUTREG(K2_VSCALE_REG, (src_hc - dst_h) & 0x7ff );
219 /* 0xc000 = bw & vert interp */
220 /* 0x8000 = no bw save */
221 OUTREG(DDA_VERT_REG, (((~dst_h)-1) & 0xfff ) | 0xc000);
222 writecrtc(0x92, (((pitch + 7) / 8) >> 8) | 0x80);
223 writecrtc(0x93, (pitch + 7) / 8);
225 writecrtc(0x67, readcrtc(0x67) | 0x4);
227 return offset;
230 void yuv_off(void) {
231 writecrtc(0x67, readcrtc(0x67) & ~0xc);
232 memset(v->mmio + 0x8180, 0, 0x80);
233 OUTREG(0x81b8, 0x900);
234 OUTREG(0x81bc, 0x900);
235 OUTREG(0x81c8, 0x900);
236 OUTREG(0x81cc, 0x900);
237 OUTREG(0x81d8, 0x1);
238 OUTREG(0x81f8, 0x07ff07ff);
239 OUTREG(0x81fc, 0x00010001);
240 writecrtc(0x92, 0);
241 writecrtc(0x93, 0);
244 static int preinit(const char *arg)
246 char *name;
248 if(arg)
249 name = (char*)arg;
250 else if(!(name = getenv("FRAMEBUFFER")))
251 name = "/dev/fb0";
253 if((fd = open(name, O_RDWR)) == -1) {
254 mp_msg(MSGT_VO, MSGL_FATAL, "s3fb: can't open %s: %s\n", name, strerror(errno));
255 return -1;
258 if(ioctl(fd, FBIOGET_FSCREENINFO, &fb_finfo)) {
259 mp_msg(MSGT_VO, MSGL_FATAL, "s3fb: problem with FBITGET_FSCREENINFO ioctl: %s\n",
260 strerror(errno));
261 close(fd);
262 fd = -1;
263 return -1;
266 if(ioctl(fd, FBIOGET_VSCREENINFO, &fb_vinfo)) {
267 mp_msg(MSGT_VO, MSGL_FATAL, "s3fb: problem with FBITGET_VSCREENINFO ioctl: %s\n",
268 strerror(errno));
269 close(fd);
270 fd = -1;
271 return -1;
274 // Check the depth now as config() musn't fail
275 switch(fb_vinfo.bits_per_pixel) {
276 case 16:
277 case 24:
278 case 32:
279 break; // Ok
280 default:
281 mp_msg(MSGT_VO, MSGL_FATAL, "s3fb: %d bpp output is not supported\n", fb_vinfo.bits_per_pixel);
282 close(fd);
283 fd = -1;
284 return -1;
287 /* Open up a window to the hardware */
288 smem = mmap(0, fb_finfo.smem_len, PROT_READ | PROT_WRITE, MAP_SHARED, fd, 0);
289 sreg = fb_finfo.smem_start;
291 if(smem == (void *)-1) {
292 mp_msg(MSGT_VO, MSGL_FATAL, "s3fb: Couldn't map memory areas: %s\n", strerror(errno));
293 smem = NULL;
294 close(fd);
295 fd = -1;
296 return -1;
299 if (!enable()) {
300 mp_msg(MSGT_VO, MSGL_FATAL, "s3fb: Couldn't map S3 registers: %s\n", strerror(errno));
301 close(fd);
302 fd = -1;
303 return -1;
306 return 0; // Success
309 /* And close our mess */
310 static void uninit(void)
312 if (inpage0) {
313 clear_screen();
314 yuv_off();
315 inpage0 = NULL;
318 if(smem) {
319 munmap(smem, fb_finfo.smem_len);
320 smem = NULL;
323 disable();
325 if(fd != -1) {
326 close(fd);
327 fd = -1;
331 static void clear_screen(void)
333 if (inpage0) {
334 int n;
336 memset(smem, 0, screenheight * screenstride);
338 if (in_format == IMGFMT_YUY2) {
339 unsigned short *ptr;
340 int i;
342 ptr = (unsigned short *)inpage0;
343 n = in_width * in_height;
344 if (vo_doublebuffering)
345 n *= 2;
346 for(i=0; i<n; i++)
347 *ptr++ = 0x8000;
349 } else {
350 n = in_depth * in_width * in_height;
351 if (vo_doublebuffering)
352 n *= 2;
353 memset(inpage0, 0, n);
358 /* Setup output screen dimensions etc */
359 static void setup_screen(uint32_t full)
361 int inpageoffset;
363 aspect(&vidwidth, &vidheight, full ? A_ZOOM : A_NOZOOM);
365 // center picture
366 vidx = (screenwidth - vidwidth) / 2;
367 vidy = (screenheight - vidheight) / 2;
369 geometry(&vidx, &vidy, &vidwidth, &vidheight, screenwidth, screenheight);
370 vo_fs = full;
372 inpageoffset = yuv_on(in_s3_format, in_width, in_height, vidx, vidy, vidwidth, vidheight, 0, screenwidth, screenheight, screenstride, 0);
373 inpage0 = smem + inpageoffset;
374 inpage = inpage0;
375 mp_msg(MSGT_VO, MSGL_INFO, "s3fb: output is at %dx%d +%dx%d\n", vidx, vidy, vidwidth, vidheight);
377 clear_screen();
380 static int config(uint32_t width, uint32_t height, uint32_t d_width, uint32_t d_height,
381 uint32_t flags, char *title, uint32_t format)
383 screenwidth = fb_vinfo.xres;
384 screenheight = fb_vinfo.yres;
385 screenstride = fb_finfo.line_length;
386 aspect_save_screenres(fb_vinfo.xres,fb_vinfo.yres);
388 in_width = width;
389 in_height = height;
390 in_format = format;
391 aspect_save_orig(width,height);
393 aspect_save_prescale(d_width,d_height);
395 /* Setup the screen for rendering to */
396 screendepth = fb_vinfo.bits_per_pixel / 8;
398 switch(in_format) {
400 case IMGFMT_YUY2:
401 in_depth = 2;
402 in_s3_format = 1;
403 alpha_func = vo_draw_alpha_yuy2;
404 break;
406 case IMGFMT_BGR15:
407 in_depth = 2;
408 in_s3_format = 3;
409 alpha_func = vo_draw_alpha_rgb16;
410 break;
412 case IMGFMT_BGR16:
413 in_depth = 2;
414 in_s3_format = 5;
415 alpha_func = vo_draw_alpha_rgb16;
416 break;
418 case IMGFMT_BGR24:
419 in_depth = 3;
420 in_s3_format = 6;
421 alpha_func = vo_draw_alpha_rgb24;
422 break;
424 case IMGFMT_BGR32:
425 in_depth = 4;
426 in_s3_format = 7;
427 alpha_func = vo_draw_alpha_rgb32;
428 break;
430 default:
431 mp_msg(MSGT_VO, MSGL_FATAL, "s3fb: Eik! Something's wrong with control().\n");
432 return -1;
435 offset = in_width * in_depth * in_height;
436 if (vo_doublebuffering)
437 page = offset;
438 else
439 page = 0;
441 if(screenheight * screenstride + page + offset > fb_finfo.smem_len) {
442 mp_msg(MSGT_VO, MSGL_FATAL, "s3fb: Not enough video memory to play this movie. Try at a lower resolution\n");
443 return -1;
446 setup_screen(flags & VOFLAG_FULLSCREEN);
447 if (vo_doublebuffering)
448 inpage = inpage0 + page;
450 mp_msg(MSGT_VO, MSGL_INFO, "s3fb: screen is %dx%d at %d bpp, in is %dx%d at %d bpp, norm is %dx%d\n",
451 screenwidth, screenheight, screendepth * 8,
452 in_width, in_height, in_depth * 8,
453 d_width, d_height);
455 return 0;
458 static void draw_alpha(int x, int y, int w, int h, unsigned char *src,
459 unsigned char *srca, int stride)
461 char *dst = inpage + (y * in_width + x) * in_depth;
462 alpha_func(w, h, src, srca, stride, dst, in_width * in_depth);
465 static void draw_osd(void)
467 if (!vo_doublebuffering)
468 vo_draw_text(in_width, in_height, draw_alpha);
471 /* Render onto the screen */
472 static void flip_page(void)
474 if(vo_doublebuffering) {
475 vo_draw_text(in_width, in_height, draw_alpha);
476 yuv_on(in_s3_format, in_width, in_height, vidx, vidy, vidwidth, vidheight, 0, screenwidth, screenheight, screenstride, page);
477 page ^= offset;
478 inpage = inpage0 + page;
482 static int draw_frame(uint8_t *src[])
484 mem2agpcpy(inpage, src[0], in_width * in_depth * in_height);
485 return 0;
488 static int draw_slice(uint8_t *i[], int s[], int w, int h, int x, int y)
490 return 1;
493 /* Attempt to start doing DR */
494 static uint32_t get_image(mp_image_t *mpi)
497 if(mpi->flags & MP_IMGFLAG_READABLE)
498 return VO_FALSE;
499 if(mpi->type == MP_IMGTYPE_STATIC && vo_doublebuffering)
500 return VO_FALSE;
501 if(mpi->type > MP_IMGTYPE_TEMP)
502 return VO_FALSE; // TODO ??
504 switch(in_format) {
505 case IMGFMT_BGR15:
506 case IMGFMT_BGR16:
507 case IMGFMT_BGR24:
508 case IMGFMT_BGR32:
509 case IMGFMT_YUY2:
510 mpi->planes[0] = inpage;
511 mpi->stride[0] = in_width * in_depth;
512 break;
514 default:
515 return VO_FALSE;
518 mpi->width = in_width;
519 mpi->flags |= MP_IMGFLAG_DIRECT;
521 return VO_TRUE;
524 static int control(uint32_t request, void *data)
526 switch(request) {
527 case VOCTRL_GET_IMAGE:
528 return get_image(data);
530 case VOCTRL_QUERY_FORMAT:
531 switch(*((uint32_t*)data)) {
532 case IMGFMT_BGR15:
533 case IMGFMT_BGR16:
534 case IMGFMT_BGR24:
535 case IMGFMT_BGR32:
536 case IMGFMT_YUY2:
537 return VFCAP_CSP_SUPPORTED | VFCAP_CSP_SUPPORTED_BY_HW |
538 VFCAP_OSD | VFCAP_HWSCALE_UP | VFCAP_HWSCALE_DOWN;
541 return 0; /* Not supported */
543 case VOCTRL_FULLSCREEN:
544 setup_screen(!vo_fs);
545 return 0;
548 return VO_NOTIMPL;
551 /* Dummy funcs */
552 static void check_events(void) {}