libvo/vo_3dfx.c

   1 /*
   2  *    video_out_3dfx.c
   3  *
   4  *      Copyright (C) Colin Cross Apr 2000
   5  *
   6  *  This file heavily based off of video_out_mga.c of Aaron Holtzman's
   7  *  mpeg2dec
   8  *
   9  *  mpeg2dec is free software; you can redistribute it and/or modify
  10  *  it under the terms of the GNU General Public License as published by
  11  *  the Free Software Foundation; either version 2, or (at your option)
  12  *  any later version.
  13  *
  14  *  mpeg2dec is distributed in the hope that it will be useful,
  15  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  *  GNU General Public License for more details.
  18  *
  19  *  You should have received a copy of the GNU General Public License
  20  *  along with mpeg2dec; if not, write to the Free Software
  21  *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  22  */
  23
  24 #include <stdio.h>
  25 #include <stdlib.h>
  26 #include <string.h>
  27
  28 #include "config.h"
  29 #include "mp_msg.h"
  30 #include "help_mp.h"
  31 #include "video_out.h"
  32 #include "video_out_internal.h"
  33 #include "x11_common.h"
  34
  35 #include <sys/ioctl.h>
  36 #include <unistd.h>
  37 #include <fcntl.h>
  38 #include <sys/mman.h>
  39 #include <errno.h>
  40 #include <wchar.h>
  41 #include <signal.h>
  42
  43 #include <X11/Xlib.h>
  44 #include <X11/extensions/xf86dga.h>
  45 #include <X11/Xutil.h>
  46
  47 //#define LOG(x) syslog(LOG_USER | LOG_DEBUG,x)
  48 #define LOG(x)
  49
  50 #include "drivers/3dfx.h"
  51
  52 #include "fastmemcpy.h"
  53
  54 static const vo_info_t info =
  55 {
  56         "3dfx (/dev/3dfx)",
  57         "3dfx",
  58         "Colin Cross <colin@MIT.EDU>",
  59         ""
  60 };
  61
  62 const LIBVO_EXTERN(3dfx)
  63
  64 static uint32_t is_fullscreen = 1;
  65
  66 static uint32_t vidwidth;
  67 static uint32_t vidheight;
  68
  69 static uint32_t screenwidth;
  70 static uint32_t screenheight;
  71 static uint32_t screendepth = 2; //Only 16bpp supported right now
  72
  73 static uint32_t dispwidth = 1280; // You can change these to whatever you want
  74 static uint32_t dispheight = 720; // 16:9 screen ratio??
  75 static uint32_t dispx;
  76 static uint32_t dispy;
  77
  78 static uint32_t *vidpage0;
  79 static uint32_t *vidpage1;
  80 static uint32_t *vidpage2;
  81
  82 static uint32_t vidpage0offset;
  83 static uint32_t vidpage1offset;
  84 static uint32_t vidpage2offset;
  85
  86 // Current pointer into framebuffer where display is located
  87 static uint32_t targetoffset;
  88
  89 static uint32_t page_space;
  90
  91 static voodoo_io_reg *reg_IO;
  92 static voodoo_2d_reg *reg_2d;
  93 static voodoo_yuv_reg *reg_YUV;
  94 static voodoo_yuv_fb *fb_YUV;
  95
  96 static uint32_t *memBase0, *memBase1;
  97 static uint32_t baseAddr0, baseAddr1;
  98
  99
 100 /* X11 related variables */
 101 static Display *display;
 102 static Window mywindow;
 103 static int bpp;
 104 static XWindowAttributes attribs;
 105
 106 static int fd=-1;
 107
 108
 109 static void
 110 restore(void)
 111 {
 112         //reg_IO->vidDesktopStartAddr = vidpage0offset;
 113         XF86DGADirectVideo(display,0,0);
 114 }
 115
 116 static void
 117 sighup(int foo)
 118 {
 119         //reg_IO->vidDesktopStartAddr = vidpage0offset;
 120         XF86DGADirectVideo(display,0,0);
 121         exit(0);
 122 }
 123
 124 static void
 125 restore_regs(voodoo_2d_reg *regs)
 126 {
 127         reg_2d->commandExtra = regs->commandExtra;
 128         reg_2d->clip0Min = regs->clip0Min;
 129         reg_2d->clip0Max = regs->clip0Max;
 130
 131         reg_2d->srcBaseAddr = regs->srcBaseAddr;
 132         reg_2d->srcXY = regs->srcXY;
 133         reg_2d->srcFormat = regs->srcFormat;
 134         reg_2d->srcSize = regs->srcSize;
 135
 136         reg_2d->dstBaseAddr = regs->dstBaseAddr;
 137         reg_2d->dstXY = regs->dstXY;
 138         reg_2d->dstFormat = regs->dstFormat;
 139
 140         reg_2d->dstSize = regs->dstSize;
 141         reg_2d->command = 0;
 142 }
 143
 144 static uint32_t
 145 create_window(Display *display, char *title)
 146 {
 147         int screen;
 148         unsigned int fg, bg;
 149         XSizeHints hint;
 150         XVisualInfo vinfo;
 151         XEvent xev;
 152
 153         Colormap theCmap;
 154         XSetWindowAttributes xswa;
 155         unsigned long xswamask;
 156
 157         screen = DefaultScreen(display);
 158
 159         hint.x = 0;
 160         hint.y = 10;
 161         hint.width = dispwidth;
 162         hint.height = dispheight;
 163         hint.flags = PPosition | PSize;
 164
 165         bg = WhitePixel(display, screen);
 166         fg = BlackPixel(display, screen);
 167
 168         XGetWindowAttributes(display, DefaultRootWindow(display), &attribs);
 169         bpp = attribs.depth;
 170         if (bpp != 16)
 171         {
 172                 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_3DFX_Only16BppSupported);
 173                 exit(-1);
 174         }
 175
 176         XMatchVisualInfo(display,screen,bpp,TrueColor,&vinfo);
 177         mp_msg(MSGT_VO,MSGL_INFO, MSGTR_LIBVO_3DFX_VisualIdIs,vinfo.visualid);
 178
 179         theCmap = XCreateColormap(display, RootWindow(display,screen),
 180                         vinfo.visual, AllocNone);
 181
 182         xswa.background_pixel = 0;
 183         xswa.border_pixel     = 1;
 184         xswa.colormap         = theCmap;
 185         xswamask = CWBackPixel | CWBorderPixel |CWColormap;
 186
 187
 188         mywindow = XCreateWindow(display, RootWindow(display,screen),
 189                                  hint.x, hint.y, hint.width, hint.height, 4, bpp,CopyFromParent,vinfo.visual,xswamask,&xswa);
 190         vo_x11_classhint( display,mywindow,"3dfx" );
 191
 192         XSelectInput(display, mywindow, StructureNotifyMask);
 193
 194         /* Tell other applications about this window */
 195
 196         XSetStandardProperties(display, mywindow, title, title, None, NULL, 0, &hint);
 197
 198         /* Map window. */
 199
 200         XMapWindow(display, mywindow);
 201
 202         /* Wait for map. */
 203         do
 204         {
 205                 XNextEvent(display, &xev);
 206         }
 207         while (xev.type != MapNotify || xev.xmap.event != mywindow);
 208
 209         XSelectInput(display, mywindow, NoEventMask);
 210
 211         XSync(display, False);
 212
 213         return 0;
 214 }
 215
 216 static void
 217 dump_yuv_planar(uint32_t *y, uint32_t *u, uint32_t *v, uint32_t to, uint32_t width, uint32_t height)
 218 {
 219         // YUV conversion works like this:
 220         //
 221         //               We write the Y, U, and V planes separately into 3dfx YUV Planar memory
 222         //               region.  The nice chip then takes these and packs them into the YUYV
 223         //               format in the regular frame buffer, starting at yuvBaseAddr, page 2 here.
 224         //               Then we tell the 3dfx to do a Screen to Screen Stretch BLT to copy all
 225         //               of the data on page 2 onto page 1, converting it to 16 bpp RGB as it goes.
 226         //               The result is a nice image on page 1 ready for display.
 227
 228         uint32_t j;
 229         uint32_t y_imax, uv_imax, jmax;
 230
 231         reg_YUV->yuvBaseAddr = to;
 232         reg_YUV->yuvStride = screenwidth*2;
 233
 234         LOG("video_out_3dfx: starting planar dump\n");
 235         jmax = height>>1; // vidheight/2, height of U and V planes
 236         y_imax = width; // Y plane is twice as wide as U and V planes
 237         uv_imax = width>>1;  // vidwidth/2/4, width of U and V planes in 32-bit words
 238
 239         for (j=0;j<jmax;j++)
 240         {
 241                 //XXX this should be hand-rolled 32 bit memcpy for safeness.
 242                 fast_memcpy(fb_YUV->U + (uint32_t) VOODOO_YUV_STRIDE*  j       ,((uint8_t*) u) + uv_imax*  j       , uv_imax);
 243                 fast_memcpy(fb_YUV->V + (uint32_t) VOODOO_YUV_STRIDE*  j       ,((uint8_t*) v) + uv_imax*  j       , uv_imax);
 244                 fast_memcpy(fb_YUV->Y + (uint32_t) VOODOO_YUV_STRIDE* (j<<1)   ,((uint8_t*) y) + y_imax * (j<<1)   , y_imax);
 245                 fast_memcpy(fb_YUV->Y + (uint32_t) VOODOO_YUV_STRIDE*((j<<1)+1),((uint8_t*) y) + y_imax *((j<<1)+1), y_imax);
 246         }
 247   LOG("video_out_3dfx: done planar dump\n");
 248 }
 249
 250 static void
 251 screen_to_screen_stretch_blt(uint32_t to, uint32_t from, uint32_t width, uint32_t height)
 252 {
 253         //FIXME - this function should be called by a show_frame function that
 254         //        uses a series of blts to show only those areas not covered
 255         //        by another window
 256         voodoo_2d_reg saved_regs;
 257
 258         LOG("video_out_3dfx: saving registers\n");
 259         // Save VGA regs (so X kinda works when we're done)
 260         saved_regs = *reg_2d;
 261
 262         /* The following lines set up the screen to screen stretch blt from page2 to
 263                  page 1
 264         */
 265
 266         LOG("video_out_3dfx: setting blt registers\n");
 267         reg_2d->commandExtra = 4; //disable colorkeying, enable wait for v-refresh (0100b)
 268         reg_2d->clip0Min = 0;
 269         reg_2d->clip0Max = 0xFFFFFFFF; //no clipping
 270
 271         reg_2d->srcBaseAddr = from;
 272         reg_2d->srcXY = 0;
 273         reg_2d->srcFormat = screenwidth*2 | VOODOO_BLT_FORMAT_YUYV; // | 1<<21;
 274         reg_2d->srcSize = vidwidth | (vidheight << 16);
 275
 276         reg_2d->dstBaseAddr = to;
 277         reg_2d->dstXY = 0;
 278         reg_2d->dstFormat = screenwidth*2 | VOODOO_BLT_FORMAT_16;
 279
 280         reg_2d->dstSize = width | (height << 16);
 281
 282         LOG("video_out_3dfx: starting blt\n");
 283         // Executes screen to screen stretch blt
 284         reg_2d->command = 2 | 1<<8 | 0xCC<<24;
 285
 286         LOG("video_out_3dfx: restoring regs\n");
 287         restore_regs(&saved_regs);
 288
 289         LOG("video_out_3dfx: done blt\n");
 290 }
 291
 292 static void
 293 update_target(void)
 294 {
 295         uint32_t xp, yp, w, h, b, d;
 296         Window root;
 297
 298         XGetGeometry(display,mywindow,&root,&xp,&yp,&w,&h,&b,&d);
 299         XTranslateCoordinates(display,mywindow,root,0,0,&xp,&yp,&root);
 300         dispx = (uint32_t) xp;
 301         dispy = (uint32_t) yp;
 302         dispwidth = (uint32_t) w;
 303         dispheight = (uint32_t) h;
 304
 305         if (is_fullscreen)
 306                 targetoffset = vidpage0offset + (screenheight - dispheight)/2*screenwidth*screendepth + (screenwidth-dispwidth)/2*screendepth;
 307         else
 308                 targetoffset = vidpage0offset + (dispy*screenwidth + dispx)*screendepth;
 309 }
 310
 311 static int
 312 config(uint32_t width, uint32_t height, uint32_t d_width, uint32_t d_height, uint32_t fullscreen, char *title, uint32_t format)
 313 {
 314         char *name = ":0.0";
 315         pioData data;
 316         uint32_t retval;
 317
 318 //TODO use x11_common for X and window handling
 319
 320         if(getenv("DISPLAY"))
 321                 name = getenv("DISPLAY");
 322         display = XOpenDisplay(name);
 323
 324         screenwidth = XDisplayWidth(display,0);
 325         screenheight = XDisplayHeight(display,0);
 326
 327         page_space = screenwidth*screenheight*screendepth;
 328         vidpage0offset = 0;
 329         vidpage1offset = page_space;  // Use third and fourth pages
 330         vidpage2offset = page_space*2;
 331
 332         signal(SIGALRM,sighup);
 333         //alarm(120);
 334
 335         // Open driver device
 336         if ( fd == -1 )
 337         {
 338                 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_3DFX_UnableToOpenDevice);
 339                 return -1;
 340         }
 341
 342         // Store sizes for later
 343         vidwidth = width;
 344         vidheight = height;
 345
 346         is_fullscreen = fullscreen = 0;
 347         if (!is_fullscreen)
 348                 create_window(display, title);
 349
 350         // Ask 3dfx driver for base memory address 0
 351         data.port = 0x10; // PCI_BASE_ADDRESS_0_LINUX;
 352         data.size = 4;
 353         data.value = &baseAddr0;
 354         data.device = 0;
 355         if ((retval = ioctl(fd,_IOC(_IOC_READ,'3',3,0),&data)) < 0)
 356         {
 357                 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_3DFX_Error,retval);
 358                 return -1;
 359         }
 360
 361         // Ask 3dfx driver for base memory address 1
 362         data.port = 0x14; // PCI_BASE_ADDRESS_1_LINUX;
 363         data.size = 4;
 364         data.value = &baseAddr1;
 365         data.device = 0;
 366         if ((retval = ioctl(fd,_IOC(_IOC_READ,'3',3,0),&data)) < 0)
 367         {
 368                 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_3DFX_Error,retval);
 369                 return -1;
 370         }
 371
 372         // Map all 3dfx memory areas
 373         memBase0 = mmap(0,0x1000000,PROT_READ | PROT_WRITE,MAP_SHARED,fd,baseAddr0);
 374         memBase1 = mmap(0,3*page_space,PROT_READ | PROT_WRITE,MAP_SHARED,fd,baseAddr1);
 375         if (memBase0 == (uint32_t *) 0xFFFFFFFF || memBase1 == (uint32_t *) 0xFFFFFFFF)
 376         {
 377                 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_3DFX_CouldntMapMemoryArea,
 378                  memBase0,memBase1,errno);
 379         }
 380
 381         // Set up global pointers
 382         reg_IO  = (void *)memBase0 + VOODOO_IO_REG_OFFSET;
 383         reg_2d  = (void *)memBase0 + VOODOO_2D_REG_OFFSET;
 384         reg_YUV = (void *)memBase0 + VOODOO_YUV_REG_OFFSET;
 385         fb_YUV  = (void *)memBase0 + VOODOO_YUV_PLANE_OFFSET;
 386
 387         vidpage0 = (void *)memBase1 + (unsigned long int)vidpage0offset;
 388         vidpage1 = (void *)memBase1 + (unsigned long int)vidpage1offset;
 389         vidpage2 = (void *)memBase1 + (unsigned long int)vidpage2offset;
 390
 391         // Clear pages 1,2,3
 392         // leave page 0, that belongs to X.
 393         // So does part of 1.  Oops.
 394         memset(vidpage1,0x00,page_space);
 395         memset(vidpage2,0x00,page_space);
 396
 397         if (is_fullscreen)
 398                 memset(vidpage0,0x00,page_space);
 399
 400
 401 #ifndef VOODOO_DEBUG
 402         // Show page 0 (unblanked)
 403         reg_IO->vidDesktopStartAddr = vidpage0offset;
 404
 405         /* Stop X from messing with my video registers!
 406                  Find a better way to do this?
 407                  Currently I use DGA to tell XF86 to not screw with registers, but I can't really use it
 408                  to do FB stuff because I need to know the absolute FB position and offset FB position
 409                  to feed to BLT command
 410         */
 411         //XF86DGADirectVideo(display,0,XF86DGADirectGraphics); //| XF86DGADirectMouse | XF86DGADirectKeyb);
 412 #endif
 413
 414         atexit(restore);
 415
 416         mp_msg(MSGT_VO,MSGL_INFO, MSGTR_LIBVO_3DFX_DisplayInitialized,memBase1);
 417         return 0;
 418 }
 419
 420 static int
 421 draw_frame(uint8_t *src[])
 422 {
 423         LOG("video_out_3dfx: starting display_frame\n");
 424
 425         // Put packed data onto page 2
 426         dump_yuv_planar((uint32_t *)src[0],(uint32_t *)src[1],(uint32_t *)src[2],
 427                         vidpage2offset,vidwidth,vidheight);
 428
 429         LOG("video_out_3dfx: done display_frame\n");
 430         return 0;
 431 }
 432
 433 static int
 434 //draw_slice(uint8_t *src[], uint32_t slice_num)
 435 draw_slice(uint8_t *src[], int stride[], int w,int h,int x,int y)
 436 {
 437         uint32_t target;
 438
 439         target = vidpage2offset + (screenwidth*2 * y);
 440         dump_yuv_planar((uint32_t *)src[0],(uint32_t *)src[1],(uint32_t *)src[2],target,vidwidth,h);
 441         return 0;
 442 }
 443
 444 static void draw_osd(void)
 445 {
 446 }
 447
 448 static void
 449 flip_page(void)
 450 {
 451         //FIXME - update_target() should be called by event handler when window
 452         //        is resized or moved
 453         update_target();
 454         LOG("video_out_3dfx: calling blt function\n");
 455         screen_to_screen_stretch_blt(targetoffset, vidpage2offset, dispwidth, dispheight);
 456 }
 457
 458 static int
 459 query_format(uint32_t format)
 460 {
 461     /* does this supports scaling? up & down? */
 462     switch(format){
 463     case IMGFMT_YV12:
 464 //    case IMGFMT_YUY2:
 465 //    case IMGFMT_RGB|24:
 466 //    case IMGFMT_BGR|24:
 467         return VFCAP_CSP_SUPPORTED|VFCAP_CSP_SUPPORTED_BY_HW;
 468     }
 469     return 0;
 470 }
 471
 472 static void
 473 uninit(void)
 474 {
 475     if( fd != -1 )
 476         close(fd);
 477 }
 478
 479
 480 static void check_events(void)
 481 {
 482 }
 483
 484 static int preinit(const char *arg)
 485 {
 486     if ( (fd = open("/dev/3dfx",O_RDWR) ) == -1)
 487     {
 488         mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_3DFX_UnableToOpenDevice);
 489         return -1;
 490     }
 491
 492     if(arg)
 493     {
 494         mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_3DFX_UnknownSubdevice,arg);
 495         return ENOSYS;
 496     }
 497     return 0;
 498 }
 499
 500 static int control(uint32_t request, void *data, ...)
 501 {
 502   switch (request) {
 503   case VOCTRL_QUERY_FORMAT:
 504     return query_format(*((uint32_t*)data));
 505   }
 506   return VO_NOTIMPL;
 507 }