libvo/vo_s3fb.c

   1 /*
   2  * copyright (C) 2006 Mark Sanderson <mmp@kiora.ath.cx>
   3  *
   4  * 30-Mar-2006 Modified from tdfxfb.c by Mark Zealey
   5  *
   6  * This file is part of MPlayer.
   7  *
   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.
  12  *
  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.
  17  *
  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.
  21  */
  22
  23 /* Hints and tricks:
  24  * - Use -dr to get direct rendering
  25  * - Use -vf yuy2 to get yuy2 rendering, *MUCH* faster than yv12
  26  */
  27
  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>
  37
  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/sub.h"
  48
  49 static const vo_info_t info =
  50   {
  51     "S3 Virge over fbdev",
  52     "s3fb",
  53     "Mark Sanderson <mmp@kiora.ath.cx>",
  54     ""
  55   };
  56
  57 const LIBVO_EXTERN(s3fb)
  58
  59 typedef struct vga_type {
  60   int cr38, cr39, cr53;
  61   unsigned char *mmio;
  62 } vga_t;
  63
  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)();
  73
  74 static void clear_screen(void);
  75
  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
  99
 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)
 105
 106 #define OUTREG(mmreg, value) *(unsigned int *)(&v->mmio[mmreg]) = value
 107
 108 int readcrtc(int reg) {
 109   outb(reg, 0x3d4);
 110   return inb(0x3d5);
 111 }
 112
 113 void writecrtc(int reg, int value) {
 114   outb(reg, 0x3d4);
 115   outb(value, 0x3d5);
 116 }
 117
 118 // enable S3 registers
 119 int enable(void) {
 120   int fd;
 121
 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;
 141         }
 142       }
 143       iopl(0);
 144     }
 145     free(v);
 146     v = NULL;
 147   }
 148   return 0;
 149 }
 150
 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;
 160   }
 161 }
 162
 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;
 165
 166   if (format == 0 || format == 7)
 167     bpp = 4;
 168   else if (format == 6)
 169     bpp = 3;
 170   else
 171     bpp = 2;
 172
 173   src_wc = src_w - crop * 2;
 174   src_hc = src_h - crop * 2;
 175   pitch = src_w * bpp;
 176
 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
 181
 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;
 185
 186   // start is the top left viewable scaler input pixel
 187   start = offset + crop * pitch + crop * bpp;
 188
 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);
 194
 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);
 202
 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);
 224
 225   writecrtc(0x67, readcrtc(0x67) | 0x4);
 226
 227   return offset;
 228 }
 229
 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);
 242 }
 243
 244 static int preinit(const char *arg)
 245 {
 246   char *name;
 247
 248   if(arg)
 249     name = (char*)arg;
 250   else if(!(name = getenv("FRAMEBUFFER")))
 251     name = "/dev/fb0";
 252
 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;
 256   }
 257
 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;
 264   }
 265
 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;
 272   }
 273
 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;
 285   }
 286
 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;
 290
 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;
 297   }
 298
 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;
 304   }
 305
 306   return 0; // Success
 307 }
 308
 309 /* And close our mess */
 310 static void uninit(void)
 311 {
 312   if (inpage0) {
 313     clear_screen();
 314     yuv_off();
 315     inpage0 = NULL;
 316   }
 317
 318   if(smem) {
 319     munmap(smem, fb_finfo.smem_len);
 320     smem = NULL;
 321   }
 322
 323   disable();
 324
 325   if(fd != -1) {
 326     close(fd);
 327     fd = -1;
 328   }
 329 }
 330
 331 static void clear_screen(void)
 332 {
 333   if (inpage0) {
 334     int n;
 335
 336     memset(smem, 0, screenheight * screenstride);
 337
 338     if (in_format == IMGFMT_YUY2) {
 339       unsigned short *ptr;
 340       int i;
 341
 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;
 348
 349     } else {
 350       n = in_depth * in_width * in_height;
 351       if (vo_doublebuffering)
 352         n *= 2;
 353       memset(inpage0, 0, n);
 354     }
 355   }
 356 }
 357
 358 /* Setup output screen dimensions etc */
 359 static void setup_screen(uint32_t full)
 360 {
 361   int inpageoffset;
 362
 363   aspect(&vidwidth, &vidheight, full ? A_ZOOM : A_NOZOOM);
 364
 365   // center picture
 366   vidx = (screenwidth - vidwidth) / 2;
 367   vidy = (screenheight - vidheight) / 2;
 368
 369   geometry(&vidx, &vidy, &vidwidth, &vidheight, screenwidth, screenheight);
 370   vo_fs = full;
 371
 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);
 376
 377   clear_screen();
 378 }
 379
 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)
 382 {
 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);
 387
 388   in_width = width;
 389   in_height = height;
 390   in_format = format;
 391   aspect_save_orig(width,height);
 392
 393   aspect_save_prescale(d_width,d_height);
 394
 395   /* Setup the screen for rendering to */
 396   screendepth = fb_vinfo.bits_per_pixel / 8;
 397
 398   switch(in_format) {
 399
 400   case IMGFMT_YUY2:
 401     in_depth = 2;
 402     in_s3_format = 1;
 403     alpha_func = vo_draw_alpha_yuy2;
 404     break;
 405
 406   case IMGFMT_BGR15:
 407     in_depth = 2;
 408     in_s3_format = 3;
 409     alpha_func = vo_draw_alpha_rgb16;
 410     break;
 411
 412   case IMGFMT_BGR16:
 413     in_depth = 2;
 414     in_s3_format = 5;
 415     alpha_func = vo_draw_alpha_rgb16;
 416     break;
 417
 418   case IMGFMT_BGR24:
 419     in_depth = 3;
 420     in_s3_format = 6;
 421     alpha_func = vo_draw_alpha_rgb24;
 422     break;
 423
 424   case IMGFMT_BGR32:
 425     in_depth = 4;
 426     in_s3_format = 7;
 427     alpha_func = vo_draw_alpha_rgb32;
 428     break;
 429
 430   default:
 431     mp_msg(MSGT_VO, MSGL_FATAL, "s3fb: Eik! Something's wrong with control().\n");
 432     return -1;
 433   }
 434
 435   offset = in_width * in_depth * in_height;
 436   if (vo_doublebuffering)
 437     page = offset;
 438   else
 439     page = 0;
 440
 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;
 444   }
 445
 446   setup_screen(flags & VOFLAG_FULLSCREEN);
 447   if (vo_doublebuffering)
 448     inpage = inpage0 + page;
 449
 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);
 454
 455   return 0;
 456 }
 457
 458 static void draw_alpha(int x, int y, int w, int h, unsigned char *src,
 459                        unsigned char *srca, int stride)
 460 {
 461   char *dst = inpage + (y * in_width + x) * in_depth;
 462   alpha_func(w, h, src, srca, stride, dst, in_width * in_depth);
 463 }
 464
 465 static void draw_osd(void)
 466 {
 467   if (!vo_doublebuffering)
 468     vo_draw_text(in_width, in_height, draw_alpha);
 469 }
 470
 471 /* Render onto the screen */
 472 static void flip_page(void)
 473 {
 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;
 479   }
 480 }
 481
 482 static int draw_frame(uint8_t *src[])
 483 {
 484   mem2agpcpy(inpage, src[0], in_width * in_depth * in_height);
 485   return 0;
 486 }
 487
 488 static int draw_slice(uint8_t *i[], int s[], int w, int h, int x, int y)
 489 {
 490   return 1;
 491 }
 492
 493 /* Attempt to start doing DR */
 494 static uint32_t get_image(mp_image_t *mpi)
 495 {
 496
 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 ??
 503
 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;
 513
 514   default:
 515     return VO_FALSE;
 516   }
 517
 518   mpi->width = in_width;
 519   mpi->flags |= MP_IMGFLAG_DIRECT;
 520
 521   return VO_TRUE;
 522 }
 523
 524 static int control(uint32_t request, void *data)
 525 {
 526   switch(request) {
 527   case VOCTRL_GET_IMAGE:
 528     return get_image(data);
 529
 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;
 539     }
 540
 541     return 0;           /* Not supported */
 542
 543   case VOCTRL_FULLSCREEN:
 544     setup_screen(!vo_fs);
 545     return 0;
 546   }
 547
 548   return VO_NOTIMPL;
 549 }
 550
 551 /* Dummy funcs */
 552 static void check_events(void) {}