libvo/mga_common.c

   1
   2 #include "fastmemcpy.h"
   3 #include "cpudetect.h"
   4 #include "postproc/swscale.h"
   5 #include "postproc/rgb2rgb.h"
   6 #include "libmpcodecs/vf_scale.h"
   7 #include "mp_msg.h"
   8
   9 // mga_vid drawing functions
  10 static void set_window( void );         /* forward declaration to kill warnings */
  11 #ifdef VO_XMGA
  12 static void mDrawColorKey( void );      /* forward declaration to kill warnings */
  13 #ifdef HAVE_XINERAMA
  14 extern int xinerama_screen;
  15 #endif
  16 #endif
  17
  18 static int mga_next_frame=0;
  19
  20 static mga_vid_config_t mga_vid_config;
  21 static uint8_t *vid_data, *frames[4];
  22 static int f = -1;
  23
  24 static uint32_t               drwX,drwY,drwWidth,drwHeight;
  25 #ifdef VO_XMGA
  26 static uint32_t               drwBorderWidth,drwDepth;
  27 #endif
  28 static uint32_t               drwcX,drwcY,dwidth,dheight;
  29
  30 static void draw_alpha(int x0,int y0, int w,int h, unsigned char* src, unsigned char *srca, int stride){
  31     uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
  32     x0+=mga_vid_config.src_width*(vo_panscan_x>>1)/(vo_dwidth+vo_panscan_x);
  33     switch(mga_vid_config.format){
  34     case MGA_VID_FORMAT_YV12:
  35     case MGA_VID_FORMAT_IYUV:
  36     case MGA_VID_FORMAT_I420:
  37         vo_draw_alpha_yv12(w,h,src,srca,stride,vid_data+bespitch*y0+x0,bespitch);
  38         break;
  39     case MGA_VID_FORMAT_YUY2:
  40         vo_draw_alpha_yuy2(w,h,src,srca,stride,vid_data+2*(bespitch*y0+x0),2*bespitch);
  41         break;
  42     case MGA_VID_FORMAT_UYVY:
  43         vo_draw_alpha_yuy2(w,h,src,srca,stride,vid_data+2*(bespitch*y0+x0)+1,2*bespitch);
  44         break;
  45     }
  46 }
  47
  48 static void draw_osd(void)
  49 {
  50 //    vo_draw_text(mga_vid_config.src_width,mga_vid_config.src_height,draw_alpha);
  51     vo_draw_text(mga_vid_config.src_width-mga_vid_config.src_width*vo_panscan_x/(vo_dwidth+vo_panscan_x),mga_vid_config.src_height,draw_alpha);
  52 }
  53
  54
  55 //static void
  56 //write_slice_g200(uint8_t *y,uint8_t *cr, uint8_t *cb,uint32_t slice_num)
  57
  58 static void
  59 draw_slice_g200(uint8_t *image[], int stride[], int width,int height,int x,int y)
  60 {
  61         uint8_t *dest;
  62         uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
  63
  64         dest = vid_data + bespitch*y + x;
  65         mem2agpcpy_pic(dest, image[0], width, height, bespitch, stride[0]);
  66
  67         width/=2;height/=2;x/=2;y/=2;
  68
  69         dest = vid_data + bespitch*mga_vid_config.src_height + bespitch*y + 2*x;
  70
  71         interleaveBytes(image[1],image[2],dest,
  72                 width, height,
  73                 stride[1], stride[2], bespitch);
  74 }
  75
  76 static void
  77 draw_slice_g400(uint8_t *image[], int stride[], int w,int h,int x,int y)
  78 {
  79     uint8_t *dest;
  80     uint8_t *dest2;
  81     uint32_t bespitch,bespitch2;
  82
  83     bespitch = (mga_vid_config.src_width + 31) & ~31;
  84     bespitch2 = bespitch/2;
  85
  86     dest = vid_data + bespitch * y + x;
  87     mem2agpcpy_pic(dest, image[0], w, h, bespitch, stride[0]);
  88
  89     w/=2;h/=2;x/=2;y/=2;
  90
  91     dest = vid_data + bespitch*mga_vid_config.src_height + bespitch2 * y + x;
  92     dest2= dest + bespitch2*mga_vid_config.src_height / 2;
  93
  94   if(mga_vid_config.format==MGA_VID_FORMAT_YV12){
  95     // mga_vid's YV12 assumes Y,U,V order (insteda of Y,V,U) :(
  96     mem2agpcpy_pic(dest, image[1], w, h, bespitch2, stride[1]);
  97     mem2agpcpy_pic(dest2,image[2], w, h, bespitch2, stride[2]);
  98   } else {
  99     mem2agpcpy_pic(dest, image[2], w, h, bespitch2, stride[2]);
 100     mem2agpcpy_pic(dest2,image[1], w, h, bespitch2, stride[1]);
 101   }
 102
 103 }
 104
 105 static uint32_t
 106 draw_slice(uint8_t *src[], int stride[], int w,int h,int x,int y)
 107 {
 108
 109 #if 0
 110         printf("vo: %p/%d %p/%d %p/%d  %dx%d/%d;%d  \n",
 111             src[0],stride[0],
 112             src[1],stride[1],
 113             src[2],stride[2],
 114             w,h,x,y);
 115 #endif
 116
 117         if (mga_vid_config.card_type == MGA_G200)
 118             draw_slice_g200(src,stride,w,h,x,y);
 119         else
 120             draw_slice_g400(src,stride,w,h,x,y);
 121         return 0;
 122 }
 123
 124 static void
 125 vo_mga_flip_page(void)
 126 {
 127
 128 //    printf("-- flip to %d --\n",mga_next_frame);
 129
 130 #if 1
 131         ioctl(f,MGA_VID_FSEL,&mga_next_frame);
 132         mga_next_frame=(mga_next_frame+1)%mga_vid_config.num_frames;
 133         vid_data=frames[mga_next_frame];
 134 #endif
 135
 136 }
 137
 138 static uint32_t
 139 draw_frame(uint8_t *src[])
 140 {
 141     printf("!!! mga::draw_frame() called !!!\n");
 142     return 0;
 143 }
 144
 145 static uint32_t get_image(mp_image_t *mpi){
 146     uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
 147     uint32_t bespitch2 = bespitch/2;
 148 //    printf("mga: get_image() called\n");
 149     if(mpi->type==MP_IMGTYPE_STATIC && mga_vid_config.num_frames>1) return VO_FALSE; // it is not static
 150     if(mpi->flags&MP_IMGFLAG_READABLE) return VO_FALSE; // slow video ram
 151     if(mga_vid_config.card_type == MGA_G200 && mpi->flags&MP_IMGFLAG_PLANAR) return VO_FALSE;
 152 //    printf("width=%d vs. bespitch=%d, flags=0x%X  \n",mpi->width,bespitch,mpi->flags);
 153     if((mpi->width==bespitch) ||
 154        (mpi->flags&(MP_IMGFLAG_ACCEPT_STRIDE|MP_IMGFLAG_ACCEPT_WIDTH))){
 155        // we're lucky or codec accepts stride => ok, let's go!
 156        if(mpi->flags&MP_IMGFLAG_PLANAR){
 157            mpi->planes[0]=vid_data;
 158            if(mpi->flags&MP_IMGFLAG_SWAPPED){
 159                mpi->planes[1]=vid_data + bespitch*mga_vid_config.src_height;
 160                mpi->planes[2]=mpi->planes[1] + bespitch2*mga_vid_config.src_height/2;
 161            } else {
 162                mpi->planes[2]=vid_data + bespitch*mga_vid_config.src_height;
 163                mpi->planes[1]=mpi->planes[2] + bespitch2*mga_vid_config.src_height/2;
 164            }
 165            mpi->width=mpi->stride[0]=bespitch;
 166            mpi->stride[1]=mpi->stride[2]=bespitch2;
 167        } else {
 168            mpi->planes[0]=vid_data;
 169            mpi->width=bespitch;
 170            mpi->stride[0]=mpi->width*(mpi->bpp/8);
 171        }
 172        mpi->flags|=MP_IMGFLAG_DIRECT;
 173 //      printf("mga: get_image() SUCCESS -> Direct Rendering ENABLED\n");
 174        return VO_TRUE;
 175     }
 176     return VO_FALSE;
 177 }
 178
 179 static uint32_t
 180 draw_image(mp_image_t *mpi){
 181     uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
 182
 183     // if -dr or -slices then do nothing:
 184     if(mpi->flags&(MP_IMGFLAG_DIRECT|MP_IMGFLAG_DRAW_CALLBACK)) return VO_TRUE;
 185
 186     if(mpi->flags&MP_IMGFLAG_PLANAR){
 187         // copy planar:
 188         draw_slice(mpi->planes,mpi->stride,mpi->w,mpi->h,mpi->x,mpi->y);
 189     } else {
 190         // copy packed:
 191         mem2agpcpy_pic(vid_data, mpi->planes[0],        // dst,src
 192                     mpi->w*(mpi->bpp/8), mpi->h,        // w,h
 193                     bespitch*2, mpi->stride[0]);        // dstride,sstride
 194     }
 195     return VO_TRUE;
 196 }
 197
 198 static uint32_t
 199 query_format(uint32_t format)
 200 {
 201     switch(format){
 202     case IMGFMT_YV12:
 203     case IMGFMT_I420:
 204     case IMGFMT_IYUV:
 205     case IMGFMT_YUY2:
 206     case IMGFMT_UYVY:
 207         return 3 | VFCAP_OSD|VFCAP_HWSCALE_UP|VFCAP_HWSCALE_DOWN|VFCAP_ACCEPT_STRIDE;
 208     }
 209     return 0;
 210 }
 211
 212 static void mga_fullscreen()
 213 {
 214         uint32_t w,h;
 215         if ( !vo_fs ) {
 216                 vo_fs=VO_TRUE;
 217                 w=vo_screenwidth; h=vo_screenheight;
 218                 aspect(&w,&h,A_ZOOM);
 219         } else {
 220                 vo_fs=VO_FALSE;
 221                 w=vo_dwidth; h=vo_dheight;
 222                 aspect(&w,&h,A_NOZOOM);
 223         }
 224         mga_vid_config.dest_width = w;
 225         mga_vid_config.dest_height= h;
 226         mga_vid_config.x_org=(vo_screenwidth-w)/2;
 227         mga_vid_config.y_org=(vo_screenheight-h)/2;
 228         if ( ioctl( f,MGA_VID_CONFIG,&mga_vid_config ) )
 229                 printf( "Error in mga_vid_config ioctl (wrong mga_vid.o version?)" );
 230 }
 231
 232 static uint32_t control(uint32_t request, void *data, ...)
 233 {
 234   switch (request) {
 235   case VOCTRL_QUERY_FORMAT:
 236     return query_format(*((uint32_t*)data));
 237   case VOCTRL_GET_IMAGE:
 238     return get_image(data);
 239   case VOCTRL_DRAW_IMAGE:
 240     return draw_image(data);
 241   case VOCTRL_SET_EQUALIZER:
 242     {
 243      va_list ap;
 244      short value;
 245      uint32_t luma,prev;
 246
 247      if ( strcmp( data,"brightness" ) && strcmp( data,"contrast" ) ) return VO_FALSE;
 248
 249      if (ioctl(f,MGA_VID_GET_LUMA,&prev)) {
 250         perror("Error in mga_vid_config ioctl()");
 251         printf("Could not get luma values from the kernel module!\n");
 252         return VO_FALSE;
 253      }
 254
 255 //     printf("GET: 0x%4X 0x%4X  \n",(prev>>16),(prev&0xffff));
 256
 257      va_start(ap, data);
 258      value = va_arg(ap, int);
 259      va_end(ap);
 260
 261 //     printf("value: %d -> ",value);
 262      value=((value+100)*255)/200-128; // maps -100=>-128 and +100=>127
 263 //     printf("%d  \n",value);
 264
 265      if(!strcmp(data,"contrast"))
 266          luma = (prev&0xFFFF0000)|(value&0xFFFF);
 267      else
 268          luma = (prev&0xFFFF)|(value<<16);
 269
 270      if (ioctl(f,MGA_VID_SET_LUMA,luma)) {
 271         perror("Error in mga_vid_config ioctl()");
 272         printf("Could not set luma values in the kernel module!\n");
 273         return VO_FALSE;
 274      }
 275
 276      return VO_TRUE;
 277     }
 278
 279   case VOCTRL_GET_EQUALIZER:
 280     {
 281      va_list ap;
 282      int * value;
 283      short val;
 284      uint32_t luma;
 285
 286      if ( strcmp( data,"brightness" ) && strcmp( data,"contrast" ) ) return VO_FALSE;
 287
 288      if (ioctl(f,MGA_VID_GET_LUMA,&luma)) {
 289         perror("Error in mga_vid_config ioctl()");
 290         printf("Could not get luma values from the kernel module!\n");
 291         return VO_FALSE;
 292      }
 293
 294      if ( !strcmp( data,"contrast" ) )
 295          val=(luma & 0xFFFF);
 296      else
 297          val=(luma >> 16);
 298
 299      va_start(ap, data);
 300      value = va_arg(ap, int*);
 301      va_end(ap);
 302
 303      *value = (val*200)/255;
 304
 305      return VO_TRUE;
 306     }
 307
 308 #ifndef VO_XMGA
 309   case VOCTRL_FULLSCREEN:
 310     if (vo_screenwidth && vo_screenheight)
 311         mga_fullscreen();
 312     else
 313         printf("Screen width/height unknown!\n");
 314     return VO_TRUE;
 315   case VOCTRL_GET_PANSCAN:
 316       if ( !vo_fs ) return VO_FALSE;
 317       return VO_TRUE;
 318 #endif
 319
 320 #if defined( VO_XMGA ) && defined( HAVE_NEW_GUI )
 321   case VOCTRL_GUISUPPORT:
 322     return VO_TRUE;
 323 #endif
 324
 325 #ifdef VO_XMGA
 326   case VOCTRL_ONTOP:
 327       vo_x11_ontop();
 328       return VO_TRUE;
 329   case VOCTRL_GET_PANSCAN:
 330       if ( !inited || !vo_fs ) return VO_FALSE;
 331       return VO_TRUE;
 332   case VOCTRL_FULLSCREEN:
 333       vo_x11_fullscreen();
 334       vo_panscan_amount=0;
 335     /* indended, fallthrough to update panscan on fullscreen/windowed switch */
 336 #endif
 337   case VOCTRL_SET_PANSCAN:
 338       if ( vo_fs && ( vo_panscan != vo_panscan_amount ) ) // || ( !vo_fs && vo_panscan_amount ) )
 339        {
 340 //        int old_y = vo_panscan_y;
 341         panscan_calc();
 342 //        if ( old_y != vo_panscan_y )
 343         set_window();
 344        }
 345       return VO_TRUE;
 346   }
 347   return VO_NOTIMPL;
 348 }
 349
 350
 351 static int mga_init(int width,int height,unsigned int format){
 352
 353         switch(format){
 354         case IMGFMT_YV12:
 355             width+=width&1;height+=height&1;
 356             mga_vid_config.frame_size = ((width + 31) & ~31) * height + (((width + 31) & ~31) * height) / 2;
 357             mga_vid_config.format=MGA_VID_FORMAT_I420; break;
 358         case IMGFMT_I420:
 359         case IMGFMT_IYUV:
 360             width+=width&1;height+=height&1;
 361             mga_vid_config.frame_size = ((width + 31) & ~31) * height + (((width + 31) & ~31) * height) / 2;
 362             mga_vid_config.format=MGA_VID_FORMAT_YV12; break;
 363         case IMGFMT_YUY2:
 364             mga_vid_config.frame_size = ((width + 31) & ~31) * height * 2;
 365             mga_vid_config.format=MGA_VID_FORMAT_YUY2; break;
 366         case IMGFMT_UYVY:
 367             mga_vid_config.frame_size = ((width + 31) & ~31) * height * 2;
 368             mga_vid_config.format=MGA_VID_FORMAT_UYVY; break;
 369         default:
 370             printf("mga: invalid output format %0X\n",format);
 371             return (-1);
 372         }
 373
 374         mga_vid_config.src_width = width;
 375         mga_vid_config.src_height= height;
 376         if(!mga_vid_config.dest_width)
 377             mga_vid_config.dest_width = width;
 378         if(!mga_vid_config.dest_height)
 379             mga_vid_config.dest_height= height;
 380
 381         mga_vid_config.colkey_on=0;
 382
 383         mga_vid_config.num_frames=(vo_directrendering && !vo_doublebuffering)?1:3;
 384         mga_vid_config.version=MGA_VID_VERSION;
 385         if (ioctl(f,MGA_VID_CONFIG,&mga_vid_config))
 386         {
 387                 perror("Error in mga_vid_config ioctl()");
 388                 printf("Your mga_vid driver version is incompatible with this MPlayer version!\n");
 389                 return -1;
 390         }
 391
 392         printf("[mga] Using %d buffers.\n",mga_vid_config.num_frames);
 393
 394         frames[0] = (char*)mmap(0,mga_vid_config.frame_size*mga_vid_config.num_frames,PROT_WRITE,MAP_SHARED,f,0);
 395         frames[1] = frames[0] + 1*mga_vid_config.frame_size;
 396         frames[2] = frames[0] + 2*mga_vid_config.frame_size;
 397         frames[3] = frames[0] + 3*mga_vid_config.frame_size;
 398         mga_next_frame = 0;
 399         vid_data = frames[mga_next_frame];
 400
 401         //clear the buffer
 402         memset(frames[0],0x80,mga_vid_config.frame_size*mga_vid_config.num_frames);
 403
 404 #ifndef VO_XMGA
 405         ioctl(f,MGA_VID_ON,0);
 406 #endif
 407
 408   return 0;
 409 }
 410
 411 static int mga_uninit(){
 412   if(f>=0){
 413         ioctl( f,MGA_VID_OFF,0 );
 414         munmap(frames[0],mga_vid_config.frame_size*mga_vid_config.num_frames);
 415         close(f);
 416         f = -1;
 417   }
 418   return 0;
 419 }
 420
 421 static uint32_t preinit(const char *vo_subdevice)
 422 {
 423   const char *devname=vo_subdevice?vo_subdevice:"/dev/mga_vid";
 424         sws_rgb2rgb_init(get_sws_cpuflags());
 425
 426         f = open(devname,O_RDWR);
 427         if(f == -1)
 428         {
 429                 perror("open");
 430                 printf("vo_mga: Couldn't open %s\n",devname);
 431                 return(-1);
 432         }
 433
 434 #ifdef VO_XMGA
 435   if (!vo_init()) {
 436     close(f);
 437     return -1;
 438   }
 439 #endif
 440
 441   return 0;
 442 }
 443
 444 static void set_window( void ){
 445
 446 #ifdef VO_XMGA
 447          if ( WinID )
 448           {
 449            XGetGeometry( mDisplay,vo_window,&mRoot,&drwX,&drwY,&drwWidth,&drwHeight,&drwBorderWidth,&drwDepth );
 450            mp_msg(MSGT_VO,MSGL_V,"[xmga] x: %d y: %d w: %d h: %d\n",drwX,drwY,drwWidth,drwHeight );
 451            drwX=0; drwY=0;
 452            XTranslateCoordinates( mDisplay,vo_window,mRoot,0,0,&drwcX,&drwcY,&mRoot );
 453            mp_msg(MSGT_VO,MSGL_V,"[xmga] dcx: %d dcy: %d dx: %d dy: %d dw: %d dh: %d\n",drwcX,drwcY,drwX,drwY,drwWidth,drwHeight );
 454
 455           }
 456           else
 457 #endif
 458           { drwX=drwcX=vo_dx; drwY=drwcY=vo_dy; drwWidth=vo_dwidth; drwHeight=vo_dheight; }
 459
 460          aspect(&dwidth,&dheight,A_NOZOOM);
 461          if ( vo_fs )
 462           {
 463            aspect(&dwidth,&dheight,A_ZOOM);
 464            drwX=( vo_screenwidth - (dwidth > vo_screenwidth?vo_screenwidth:dwidth) ) / 2;
 465            drwcX+=drwX;
 466            drwY=( vo_screenheight - (dheight > vo_screenheight?vo_screenheight:dheight) ) / 2;
 467            drwcY+=drwY;
 468            drwWidth=(dwidth > vo_screenwidth?vo_screenwidth:dwidth);
 469            drwHeight=(dheight > vo_screenheight?vo_screenheight:dheight);
 470            mp_msg(MSGT_VO,MSGL_V,"[xmga-fs] dcx: %d dcy: %d dx: %d dy: %d dw: %d dh: %d\n",drwcX,drwcY,drwX,drwY,drwWidth,drwHeight );
 471           }
 472          vo_dwidth=drwWidth; vo_dheight=drwHeight;
 473
 474 #ifdef VO_XMGA
 475 #ifdef HAVE_XINERAMA
 476                  if(XineramaIsActive(mDisplay))
 477                  {
 478                         XineramaScreenInfo *screens;
 479                         int num_screens;
 480                         int i;
 481
 482                         screens = XineramaQueryScreens(mDisplay,&num_screens);
 483
 484                         /* find the screen we are on */
 485                         i = 0;
 486                         while(i<num_screens &&
 487                             ((screens[i].x_org < drwcX) ||
 488                              (screens[i].y_org < drwcY) ||
 489                              (screens[i].x_org + screens[i].width >= drwcX) ||
 490                              (screens[i].y_org + screens[i].height >= drwcY)))
 491                         {
 492                                 i++;
 493                         }
 494
 495                         if(i<num_screens)
 496                         {
 497                                 /* save the screen we are on */
 498                                 xinerama_screen = i;
 499                         } else {
 500                                 /* oops.. couldnt find the screen we are on
 501                                  * because the upper left corner left the
 502                                  * visual range. assume we are still on the
 503                                  * same screen
 504                                  */
 505                                 i = xinerama_screen;
 506                         }
 507
 508                         /* set drwcX and drwcY to the right values */
 509                         drwcX = drwcX - screens[i].x_org;
 510                         drwcY = drwcY - screens[i].y_org;
 511                         XFree(screens);
 512                  }
 513
 514 #endif
 515
 516          mDrawColorKey();
 517 #endif
 518
 519          mga_vid_config.x_org=drwcX;
 520          mga_vid_config.y_org=drwcY;
 521          mga_vid_config.dest_width=drwWidth;
 522          mga_vid_config.dest_height=drwHeight;
 523          if ( vo_panscan > 0.0f && vo_fs )
 524           {
 525            drwX-=vo_panscan_x>>1;
 526            drwY-=vo_panscan_y>>1;
 527            drwWidth+=vo_panscan_x;
 528            drwHeight+=vo_panscan_y;
 529
 530            mga_vid_config.x_org-=vo_panscan_x>>1;
 531            mga_vid_config.y_org-=vo_panscan_y>>1;
 532            mga_vid_config.dest_width=drwWidth;
 533            mga_vid_config.dest_height=drwHeight;
 534 #ifdef VO_XMGA
 535            mDrawColorKey();
 536 #endif
 537           }
 538          if ( ioctl( f,MGA_VID_CONFIG,&mga_vid_config ) ) mp_msg(MSGT_VO,MSGL_WARN,"Error in mga_vid_config ioctl (wrong mga_vid.o version?)" );
 539 }