libvo/vesa_lvo.c

   1 /*
   2  * vo_vesa interface to Linux Video Overlay
   3  * (partly based on vo_mga.c)
   4  *
   5  * copyright (C) 2001 Nick Kurshev <nickols_k@mail.ru>
   6  *
   7  * This file is part of MPlayer.
   8  *
   9  * MPlayer 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 of the License, or
  12  * (at your option) any later version.
  13  *
  14  * MPlayer 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 along
  20  * with MPlayer; if not, write to the Free Software Foundation, Inc.,
  21  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  22  */
  23
  24 #include <inttypes.h>
  25 #include <sys/ioctl.h>
  26 #include <unistd.h>
  27 #include <fcntl.h>
  28 #include <sys/mman.h>
  29 #include <stdio.h>
  30 #include <stdlib.h>
  31 #include <string.h>
  32
  33 #include "config.h"
  34 #include "mp_msg.h"
  35
  36 #include "vesa_lvo.h"
  37 #include "libmpcodecs/img_format.h"
  38 #include "drivers/mga_vid.h" /* <- should be changed to "linux/'something'.h" */
  39 #include "fastmemcpy.h"
  40 #include "osd.h"
  41 #include "video_out.h"
  42 #include "sub.h"
  43 #include "libmpcodecs/vfcap.h"
  44
  45 #define WIDTH_ALIGN 32 /* should be 16 for rage:422 and 32 for rage:420 */
  46 #define NUM_FRAMES 10
  47 #define UNUSED(x) ((void)(x)) /**< Removes warning about unused arguments */
  48
  49 static uint8_t *frames[NUM_FRAMES];
  50
  51 static int lvo_handler = -1;
  52 static uint8_t *lvo_mem = NULL;
  53 static uint8_t next_frame;
  54 static mga_vid_config_t mga_vid_config;
  55 static unsigned image_bpp,image_height,image_width,src_format;
  56 int vlvo_control(uint32_t request, void *data);
  57
  58 #define PIXEL_SIZE() ((video_mode_info.BitsPerPixel+7)/8)
  59 #define SCREEN_LINE_SIZE(pixel_size) (video_mode_info.XResolution*(pixel_size) )
  60 #define IMAGE_LINE_SIZE(pixel_size) (image_width*(pixel_size))
  61
  62 int      vlvo_init(unsigned src_width,unsigned src_height,
  63                    unsigned x_org,unsigned y_org,unsigned dst_width,
  64                    unsigned dst_height,unsigned format,unsigned dest_bpp)
  65 {
  66   size_t i,awidth;
  67   mp_tmsg(MSGT_VO,MSGL_WARN, "[VESA_LVO] This branch is no longer supported.\n[VESA_LVO] Please use -vo vesa:vidix instead.\n");
  68   return -1;
  69   if( mp_msg_test(MSGT_VO,MSGL_DBG2) ) {
  70     mp_msg(MSGT_VO,MSGL_DBG2, "vesa_lvo: vlvo_init() was called\n");}
  71         image_width = src_width;
  72         image_height = src_height;
  73         mga_vid_config.version=MGA_VID_VERSION;
  74         src_format = mga_vid_config.format=format;
  75         awidth = (src_width + (WIDTH_ALIGN-1)) & ~(WIDTH_ALIGN-1);
  76         switch(format){
  77         case IMGFMT_YV12:
  78         case IMGFMT_I420:
  79         case IMGFMT_IYUV:
  80             image_bpp=16;
  81             mga_vid_config.frame_size = awidth*src_height+(awidth*src_height)/2;
  82             break;
  83         case IMGFMT_YUY2:
  84         case IMGFMT_UYVY:
  85             image_bpp=16;
  86             mga_vid_config.frame_size = awidth*src_height*2;
  87             break;
  88         case IMGFMT_RGB15:
  89         case IMGFMT_BGR15:
  90         case IMGFMT_RGB16:
  91         case IMGFMT_BGR16:
  92             image_bpp=16;
  93             mga_vid_config.frame_size = awidth*src_height*2;
  94             break;
  95         case IMGFMT_RGB24:
  96         case IMGFMT_BGR24:
  97             image_bpp=24;
  98             mga_vid_config.frame_size = awidth*src_height*3;
  99             break;
 100         case IMGFMT_RGB32:
 101         case IMGFMT_BGR32:
 102             image_bpp=32;
 103             mga_vid_config.frame_size = awidth*src_height*4;
 104             break;
 105         default:
 106             mp_tmsg(MSGT_VO,MSGL_WARN, "[VESA_LVI] Invalid output format: %s(%0X)\n",vo_format_name(format),format);
 107             return -1;
 108         }
 109         mga_vid_config.colkey_on=0;
 110         mga_vid_config.src_width = src_width;
 111         mga_vid_config.src_height= src_height;
 112         mga_vid_config.dest_width = dst_width;
 113         mga_vid_config.dest_height= dst_height;
 114         mga_vid_config.x_org=x_org;
 115         mga_vid_config.y_org=y_org;
 116         mga_vid_config.num_frames=NUM_FRAMES;
 117         if (ioctl(lvo_handler,MGA_VID_CONFIG,&mga_vid_config))
 118         {
 119                 perror("vesa_lvo: Error in mga_vid_config ioctl()");
 120                 mp_tmsg(MSGT_VO,MSGL_WARN, "[VESA_LVO] Your fb_vid driver version is incompatible with this MPlayer version!\n");
 121                 return -1;
 122         }
 123         ioctl(lvo_handler,MGA_VID_ON,0);
 124
 125         frames[0] = (char*)mmap(0,mga_vid_config.frame_size*mga_vid_config.num_frames,PROT_WRITE,MAP_SHARED,lvo_handler,0);
 126         for(i=1;i<NUM_FRAMES;i++)
 127                 frames[i] = frames[i-1] + mga_vid_config.frame_size;
 128         next_frame = 0;
 129         lvo_mem = frames[next_frame];
 130
 131         /*clear the buffer*/
 132         memset(frames[0],0x80,mga_vid_config.frame_size*mga_vid_config.num_frames);
 133         return 0;
 134 }
 135
 136 void vlvo_term( void )
 137 {
 138   if( mp_msg_test(MSGT_VO,MSGL_DBG2) ) {
 139     mp_msg(MSGT_VO,MSGL_DBG2, "vesa_lvo: vlvo_term() was called\n");}
 140         ioctl( lvo_handler,MGA_VID_OFF,0 );
 141         munmap(frames[0],mga_vid_config.frame_size*mga_vid_config.num_frames);
 142         if(lvo_handler != -1) close(lvo_handler);
 143 }
 144
 145 static int vlvo_draw_slice_420(uint8_t *image[], int stride[],
 146                                     int w, int h, int x, int y)
 147 {
 148     uint8_t *src;
 149     uint8_t *dest;
 150     uint32_t bespitch,bespitch2;
 151     int i;
 152
 153     bespitch = (mga_vid_config.src_width + (WIDTH_ALIGN-1)) & ~(WIDTH_ALIGN-1);
 154     bespitch2 = bespitch/2;
 155
 156     dest = lvo_mem + bespitch * y + x;
 157     src = image[0];
 158     for(i=0;i<h;i++){
 159         fast_memcpy(dest,src,w);
 160         src+=stride[0];
 161         dest += bespitch;
 162     }
 163
 164     w/=2;h/=2;x/=2;y/=2;
 165
 166     dest = lvo_mem + bespitch*mga_vid_config.src_height + bespitch2 * y + x;
 167     src = image[1];
 168     for(i=0;i<h;i++){
 169         fast_memcpy(dest,src,w);
 170         src+=stride[1];
 171         dest += bespitch2;
 172     }
 173
 174     dest = lvo_mem + bespitch*mga_vid_config.src_height
 175                    + bespitch*mga_vid_config.src_height / 4
 176                    + bespitch2 * y + x;
 177     src = image[2];
 178     for(i=0;i<h;i++){
 179         fast_memcpy(dest,src,w);
 180         src+=stride[2];
 181         dest += bespitch2;
 182     }
 183     return 0;
 184 }
 185
 186 static int vlvo_draw_slice(uint8_t *image[], int stride[],
 187                            int w,int h,int x,int y)
 188 {
 189  if( mp_msg_test(MSGT_VO,MSGL_DBG2) ) {
 190    mp_msg(MSGT_VO,MSGL_DBG2, "vesa_lvo: vlvo_draw_slice() was called\n");}
 191     if(src_format == IMGFMT_YV12 || src_format == IMGFMT_I420 || src_format == IMGFMT_IYUV)
 192         vlvo_draw_slice_420(image,stride,w,h,x,y);
 193     else
 194     {
 195         uint8_t *dst;
 196         uint8_t bytpp;
 197         bytpp = (image_bpp+7)/8;
 198         dst = lvo_mem + (image_width * y + x)*bytpp;
 199         /* vlvo_draw_slice_422(image,stride,w,h,x,y); just for speed */
 200         fast_memcpy(dst,image[0],mga_vid_config.frame_size);
 201     }
 202  return 0;
 203 }
 204
 205 static int vlvo_draw_frame(uint8_t *image[])
 206 {
 207 /* Note it's very strange but sometime for YUY2 draw_frame is called */
 208   fast_memcpy(lvo_mem,image[0],mga_vid_config.frame_size);
 209   if( mp_msg_test(MSGT_VO,MSGL_DBG2) ) {
 210     mp_msg(MSGT_VO,MSGL_DBG2, "vesa_lvo: vlvo_flip_page() was called\n");}
 211   return 0;
 212 }
 213
 214 static void vlvo_flip_page(void)
 215 {
 216   if( mp_msg_test(MSGT_VO,MSGL_DBG2) ) {
 217     mp_msg(MSGT_VO,MSGL_DBG2, "vesa_lvo: vlvo_draw_osd() was called\n");}
 218   if(vo_doublebuffering)
 219   {
 220         ioctl(lvo_handler,MGA_VID_FSEL,&next_frame);
 221         next_frame=(next_frame+1)%mga_vid_config.num_frames;
 222         lvo_mem=frames[next_frame];
 223   }
 224 }
 225
 226 #if 0
 227 static void draw_alpha_null(int x0,int y0, int w,int h, unsigned char* src, unsigned char *srca, int stride)
 228 {
 229   UNUSED(x0);
 230   UNUSED(y0);
 231   UNUSED(w);
 232   UNUSED(h);
 233   UNUSED(src);
 234   UNUSED(srca);
 235   UNUSED(stride);
 236 }
 237
 238 static void draw_alpha(int x0,int y0, int w,int h, unsigned char* src, unsigned char *srca, int stride)
 239 {
 240     uint32_t bespitch = /*(*/mga_vid_config.src_width;// + 15) & ~15;
 241     switch(mga_vid_config.format){
 242     case IMGFMT_BGR15:
 243     case IMGFMT_RGB15:
 244         vo_draw_alpha_rgb15(w,h,src,srca,stride,lvo_mem+2*(y0*bespitch+x0),2*bespitch);
 245         break;
 246     case IMGFMT_BGR16:
 247     case IMGFMT_RGB16:
 248         vo_draw_alpha_rgb16(w,h,src,srca,stride,lvo_mem+2*(y0*bespitch+x0),2*bespitch);
 249         break;
 250     case IMGFMT_BGR24:
 251     case IMGFMT_RGB24:
 252         vo_draw_alpha_rgb24(w,h,src,srca,stride,lvo_mem+3*(y0*bespitch+x0),3*bespitch);
 253         break;
 254     case IMGFMT_BGR32:
 255     case IMGFMT_RGB32:
 256         vo_draw_alpha_rgb32(w,h,src,srca,stride,lvo_mem+4*(y0*bespitch+x0),4*bespitch);
 257         break;
 258     case IMGFMT_YV12:
 259     case IMGFMT_IYUV:
 260     case IMGFMT_I420:
 261         vo_draw_alpha_yv12(w,h,src,srca,stride,lvo_mem+bespitch*y0+x0,bespitch);
 262         break;
 263     case IMGFMT_YUY2:
 264         vo_draw_alpha_yuy2(w,h,src,srca,stride,lvo_mem+2*(bespitch*y0+x0),bespitch);
 265         break;
 266     case IMGFMT_UYVY:
 267         vo_draw_alpha_yuy2(w,h,src,srca,stride,lvo_mem+2*(bespitch*y0+x0)+1,bespitch);
 268         break;
 269     default:
 270         draw_alpha_null(x0,y0,w,h,src,srca,stride);
 271     }
 272 }
 273 #endif
 274
 275 static void vlvo_draw_osd(void)
 276 {
 277   if( mp_msg_test(MSGT_VO,MSGL_DBG2) ) {
 278     mp_msg(MSGT_VO,MSGL_DBG2,"vesa_lvo: vlvo_draw_osd() was called\n"); }
 279   /* TODO: hw support */
 280 #if 0
 281 /* disable this stuff until new fbvid.h interface will be implemented
 282   because in different fourcc radeon_vid and rage128_vid have different
 283   width alignment */
 284   vo_draw_text(mga_vid_config.src_width,mga_vid_config.src_height,draw_alpha);
 285 #endif
 286 }
 287
 288 extern struct vo_old_functions video_out_vesa;
 289
 290 int vlvo_preinit(const char *drvname)
 291 {
 292   mp_tmsg(MSGT_VO,MSGL_WARN, "[VESA_LVO] This branch is no longer supported.\n[VESA_LVO] Please use -vo vesa:vidix instead.\n");
 293   return -1;
 294   if( mp_msg_test(MSGT_VO,MSGL_DBG2) ) {
 295     mp_msg(MSGT_VO,MSGL_DBG2, "vesa_lvo: vlvo_preinit(%s) was called\n",drvname);}
 296         lvo_handler = open(drvname,O_RDWR);
 297         if(lvo_handler == -1)
 298         {
 299                 mp_tmsg(MSGT_VO,MSGL_WARN, "[VESA_LVO] Couldn't open: '%s'\n",drvname);
 300                 return -1;
 301         }
 302         /* we are able to tune up this stuff depend on fourcc format */
 303         video_out_vesa.draw_slice=vlvo_draw_slice;
 304         video_out_vesa.draw_frame=vlvo_draw_frame;
 305         video_out_vesa.flip_page=vlvo_flip_page;
 306         video_out_vesa.draw_osd=vlvo_draw_osd;
 307   video_out_vesa.control=vlvo_control;
 308         return 0;
 309 }
 310
 311 static uint32_t vlvo_query_info(uint32_t format)
 312 {
 313   if( mp_msg_test(MSGT_VO,MSGL_DBG2) ) {
 314     mp_msg(MSGT_VO,MSGL_DBG2, "vesa_lvo: query_format was called: %x (%s)\n",format,vo_format_name(format)); }
 315   return VFCAP_CSP_SUPPORTED;
 316 }
 317
 318 int vlvo_control(uint32_t request, void *data)
 319 {
 320   switch (request) {
 321   case VOCTRL_QUERY_FORMAT:
 322     return vlvo_query_info(*((uint32_t*)data));
 323   }
 324   return VO_NOTIMPL;
 325 }