synced with r25539
[mplayer/greg.git] / libvo / mga_common.c
blobdce62abeaceea6ddfbaedf15718c9cfa8da79f91
2 #include "fastmemcpy.h"
3 #include "cpudetect.h"
4 #include "libswscale/swscale.h"
5 #include "libswscale/rgb2rgb.h"
6 #include "libmpcodecs/vf_scale.h"
7 #include "mp_msg.h"
8 #include "help_mp.h"
10 // mga_vid drawing functions
11 static void set_window( void ); /* forward declaration to kill warnings */
12 #ifdef VO_XMGA
13 static void mDrawColorKey( void ); /* forward declaration to kill warnings */
14 #endif
16 static int mga_next_frame=0;
18 static mga_vid_config_t mga_vid_config;
19 static uint8_t *vid_data, *frames[4];
20 static int f = -1;
22 static uint32_t drwX,drwY,drwWidth,drwHeight;
23 #ifdef VO_XMGA
24 static uint32_t drwBorderWidth,drwDepth;
25 #endif
26 static uint32_t drwcX,drwcY,dwidth,dheight;
28 static void draw_alpha(int x0,int y0, int w,int h, unsigned char* src, unsigned char *srca, int stride){
29 uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
30 x0+=mga_vid_config.src_width*(vo_panscan_x>>1)/(vo_dwidth+vo_panscan_x);
31 switch(mga_vid_config.format){
32 case MGA_VID_FORMAT_YV12:
33 case MGA_VID_FORMAT_IYUV:
34 case MGA_VID_FORMAT_I420:
35 vo_draw_alpha_yv12(w,h,src,srca,stride,vid_data+bespitch*y0+x0,bespitch);
36 break;
37 case MGA_VID_FORMAT_YUY2:
38 vo_draw_alpha_yuy2(w,h,src,srca,stride,vid_data+2*(bespitch*y0+x0),2*bespitch);
39 break;
40 case MGA_VID_FORMAT_UYVY:
41 vo_draw_alpha_yuy2(w,h,src,srca,stride,vid_data+2*(bespitch*y0+x0)+1,2*bespitch);
42 break;
46 static void draw_osd(void)
48 // vo_draw_text(mga_vid_config.src_width,mga_vid_config.src_height,draw_alpha);
49 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);
53 //static void
54 //write_slice_g200(uint8_t *y,uint8_t *cr, uint8_t *cb,uint32_t slice_num)
56 static void
57 draw_slice_g200(uint8_t *image[], int stride[], int width,int height,int x,int y)
59 uint8_t *dest;
60 uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
62 dest = vid_data + bespitch*y + x;
63 mem2agpcpy_pic(dest, image[0], width, height, bespitch, stride[0]);
65 width/=2;height/=2;x/=2;y/=2;
67 dest = vid_data + bespitch*mga_vid_config.src_height + bespitch*y + 2*x;
69 interleaveBytes(image[1],image[2],dest,
70 width, height,
71 stride[1], stride[2], bespitch);
74 static void
75 draw_slice_g400(uint8_t *image[], int stride[], int w,int h,int x,int y)
77 uint8_t *dest;
78 uint8_t *dest2;
79 uint32_t bespitch,bespitch2;
81 bespitch = (mga_vid_config.src_width + 31) & ~31;
82 bespitch2 = bespitch/2;
84 dest = vid_data + bespitch * y + x;
85 mem2agpcpy_pic(dest, image[0], w, h, bespitch, stride[0]);
87 w/=2;h/=2;x/=2;y/=2;
89 dest = vid_data + bespitch*mga_vid_config.src_height + bespitch2 * y + x;
90 dest2= dest + bespitch2*mga_vid_config.src_height / 2;
92 if(mga_vid_config.format==MGA_VID_FORMAT_YV12){
93 // mga_vid's YV12 assumes Y,U,V order (insteda of Y,V,U) :(
94 mem2agpcpy_pic(dest, image[1], w, h, bespitch2, stride[1]);
95 mem2agpcpy_pic(dest2,image[2], w, h, bespitch2, stride[2]);
96 } else {
97 mem2agpcpy_pic(dest, image[2], w, h, bespitch2, stride[2]);
98 mem2agpcpy_pic(dest2,image[1], w, h, bespitch2, stride[1]);
103 static int
104 draw_slice(uint8_t *src[], int stride[], int w,int h,int x,int y)
107 #if 0
108 printf("vo: %p/%d %p/%d %p/%d %dx%d/%d;%d \n",
109 src[0],stride[0],
110 src[1],stride[1],
111 src[2],stride[2],
112 w,h,x,y);
113 #endif
115 if (mga_vid_config.card_type == MGA_G200)
116 draw_slice_g200(src,stride,w,h,x,y);
117 else
118 draw_slice_g400(src,stride,w,h,x,y);
119 return 0;
122 static void
123 vo_mga_flip_page(void)
126 // printf("-- flip to %d --\n",mga_next_frame);
128 #if 1
129 ioctl(f,MGA_VID_FSEL,&mga_next_frame);
130 mga_next_frame=(mga_next_frame+1)%mga_vid_config.num_frames;
131 vid_data=frames[mga_next_frame];
132 #endif
136 static int
137 draw_frame(uint8_t *src[])
139 mp_msg(MSGT_VO,MSGL_WARN,"!!! mga::draw_frame() called !!!\n");
140 return 0;
143 static uint32_t get_image(mp_image_t *mpi){
144 uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
145 uint32_t bespitch2 = bespitch/2;
146 // printf("mga: get_image() called\n");
147 if(mpi->type==MP_IMGTYPE_STATIC && mga_vid_config.num_frames>1) return VO_FALSE; // it is not static
148 if(mpi->flags&MP_IMGFLAG_READABLE) return VO_FALSE; // slow video ram
149 if(mga_vid_config.card_type == MGA_G200 && mpi->flags&MP_IMGFLAG_PLANAR) return VO_FALSE;
150 // printf("width=%d vs. bespitch=%d, flags=0x%X \n",mpi->width,bespitch,mpi->flags);
151 if((mpi->width==bespitch) ||
152 (mpi->flags&(MP_IMGFLAG_ACCEPT_STRIDE|MP_IMGFLAG_ACCEPT_WIDTH))){
153 // we're lucky or codec accepts stride => ok, let's go!
154 if(mpi->flags&MP_IMGFLAG_PLANAR){
155 mpi->planes[0]=vid_data;
156 if(mpi->flags&MP_IMGFLAG_SWAPPED){
157 mpi->planes[1]=vid_data + bespitch*mga_vid_config.src_height;
158 mpi->planes[2]=mpi->planes[1] + bespitch2*mga_vid_config.src_height/2;
159 } else {
160 mpi->planes[2]=vid_data + bespitch*mga_vid_config.src_height;
161 mpi->planes[1]=mpi->planes[2] + bespitch2*mga_vid_config.src_height/2;
163 mpi->width=mpi->stride[0]=bespitch;
164 mpi->stride[1]=mpi->stride[2]=bespitch2;
165 } else {
166 mpi->planes[0]=vid_data;
167 mpi->width=bespitch;
168 mpi->stride[0]=mpi->width*(mpi->bpp/8);
170 mpi->flags|=MP_IMGFLAG_DIRECT;
171 // printf("mga: get_image() SUCCESS -> Direct Rendering ENABLED\n");
172 return VO_TRUE;
174 return VO_FALSE;
177 static uint32_t
178 draw_image(mp_image_t *mpi){
179 uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
181 // if -dr or -slices then do nothing:
182 if(mpi->flags&(MP_IMGFLAG_DIRECT|MP_IMGFLAG_DRAW_CALLBACK)) return VO_TRUE;
184 if(mpi->flags&MP_IMGFLAG_PLANAR){
185 // copy planar:
186 draw_slice(mpi->planes,mpi->stride,mpi->w,mpi->h,mpi->x,mpi->y);
187 } else {
188 // copy packed:
189 mem2agpcpy_pic(vid_data, mpi->planes[0], // dst,src
190 mpi->w*(mpi->bpp/8), mpi->h, // w,h
191 bespitch*2, mpi->stride[0]); // dstride,sstride
193 return VO_TRUE;
196 static int
197 query_format(uint32_t format)
199 switch(format){
200 case IMGFMT_YV12:
201 case IMGFMT_I420:
202 case IMGFMT_IYUV:
203 case IMGFMT_YUY2:
204 case IMGFMT_UYVY:
205 return VFCAP_CSP_SUPPORTED | VFCAP_CSP_SUPPORTED_BY_HW | VFCAP_OSD|VFCAP_HWSCALE_UP|VFCAP_HWSCALE_DOWN|VFCAP_ACCEPT_STRIDE;
207 return 0;
210 #ifndef VO_XMGA
211 static void mga_fullscreen()
213 uint32_t w,h;
214 if ( !vo_fs ) {
215 vo_fs=VO_TRUE;
216 w=vo_screenwidth; h=vo_screenheight;
217 aspect(&w,&h,A_ZOOM);
218 } else {
219 vo_fs=VO_FALSE;
220 w=vo_dwidth; h=vo_dheight;
221 aspect(&w,&h,A_NOZOOM);
223 mga_vid_config.dest_width = w;
224 mga_vid_config.dest_height= h;
225 mga_vid_config.x_org=(vo_screenwidth-w)/2;
226 mga_vid_config.y_org=(vo_screenheight-h)/2;
227 if ( ioctl( f,MGA_VID_CONFIG,&mga_vid_config ) )
228 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_ErrorInConfigIoctl );
230 #endif
232 static int control(uint32_t request, void *data, ...)
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:
243 va_list ap;
244 short value;
245 uint32_t luma,prev;
247 if ( strcmp( data,"brightness" ) && strcmp( data,"contrast" ) ) return VO_FALSE;
249 if (ioctl(f,MGA_VID_GET_LUMA,&prev)) {
250 perror("Error in mga_vid_config ioctl()");
251 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_CouldNotGetLumaValuesFromTheKernelModule);
252 return VO_FALSE;
255 // printf("GET: 0x%4X 0x%4X \n",(prev>>16),(prev&0xffff));
257 va_start(ap, data);
258 value = va_arg(ap, int);
259 va_end(ap);
261 // printf("value: %d -> ",value);
262 value=((value+100)*255)/200-128; // maps -100=>-128 and +100=>127
263 // printf("%d \n",value);
265 if(!strcmp(data,"contrast"))
266 luma = (prev&0xFFFF0000)|(value&0xFFFF);
267 else
268 luma = (prev&0xFFFF)|(value<<16);
270 if (ioctl(f,MGA_VID_SET_LUMA,luma)) {
271 perror("Error in mga_vid_config ioctl()");
272 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_CouldNotSetLumaValuesFromTheKernelModule);
273 return VO_FALSE;
276 return VO_TRUE;
279 case VOCTRL_GET_EQUALIZER:
281 va_list ap;
282 int * value;
283 short val;
284 uint32_t luma;
286 if ( strcmp( data,"brightness" ) && strcmp( data,"contrast" ) ) return VO_FALSE;
288 if (ioctl(f,MGA_VID_GET_LUMA,&luma)) {
289 perror("Error in mga_vid_config ioctl()");
290 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_CouldNotGetLumaValuesFromTheKernelModule);
291 return VO_FALSE;
294 if ( !strcmp( data,"contrast" ) )
295 val=(luma & 0xFFFF);
296 else
297 val=(luma >> 16);
299 va_start(ap, data);
300 value = va_arg(ap, int*);
301 va_end(ap);
303 *value = (val*200)/255;
305 return VO_TRUE;
308 #ifndef VO_XMGA
309 case VOCTRL_FULLSCREEN:
310 if (vo_screenwidth && vo_screenheight)
311 mga_fullscreen();
312 else
313 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_ScreenWidthHeightUnknown);
314 return VO_TRUE;
315 case VOCTRL_GET_PANSCAN:
316 if ( !vo_fs ) return VO_FALSE;
317 return VO_TRUE;
318 #endif
320 #if defined( VO_XMGA ) && defined( HAVE_NEW_GUI )
321 case VOCTRL_GUISUPPORT:
322 return VO_TRUE;
323 #endif
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 ) )
340 // int old_y = vo_panscan_y;
341 panscan_calc();
342 // if ( old_y != vo_panscan_y )
343 set_window();
345 return VO_TRUE;
347 return VO_NOTIMPL;
351 static int mga_init(int width,int height,unsigned int format){
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 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_InvalidOutputFormat,format);
371 return (-1);
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;
381 mga_vid_config.colkey_on=0;
383 mga_vid_config.num_frames=(vo_directrendering && !vo_doublebuffering)?1:3;
384 mga_vid_config.version=MGA_VID_VERSION;
386 if(width > 1024 && height > 1024)
388 mp_msg(MSGT_VO,MSGL_ERR, MGSTR_LIBVO_MGA_ResolutionTooHigh);
389 return (-1);
390 } else if(height <= 1024)
392 // try whether we have a G550
393 int ret;
394 if ((ret = ioctl(f,MGA_VID_CONFIG,&mga_vid_config)))
396 if(mga_vid_config.card_type != MGA_G550)
398 // we don't have a G550, so our resolution is too high
399 mp_msg(MSGT_VO,MSGL_ERR, MGSTR_LIBVO_MGA_ResolutionTooHigh);
400 return (-1);
401 } else {
402 // there is a deeper problem
403 // we have a G550, but still couldn't configure mga_vid
404 perror("Error in mga_vid_config ioctl()");
405 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_IncompatibleDriverVersion);
406 return -1;
408 // if we arrived here, then we could successfully configure mga_vid
409 // at this high resolution
411 } else {
412 // configure mga_vid in case resolution is < 1024x1024 too
413 if (ioctl(f,MGA_VID_CONFIG,&mga_vid_config))
415 perror("Error in mga_vid_config ioctl()");
416 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_IncompatibleDriverVersion);
417 return -1;
421 mp_msg(MSGT_VO,MSGL_V,"[MGA] Using %d buffers.\n",mga_vid_config.num_frames);
423 frames[0] = (char*)mmap(0,mga_vid_config.frame_size*mga_vid_config.num_frames,PROT_WRITE,MAP_SHARED,f,0);
424 frames[1] = frames[0] + 1*mga_vid_config.frame_size;
425 frames[2] = frames[0] + 2*mga_vid_config.frame_size;
426 frames[3] = frames[0] + 3*mga_vid_config.frame_size;
427 mga_next_frame = 0;
428 vid_data = frames[mga_next_frame];
430 //clear the buffer
431 memset(frames[0],0x80,mga_vid_config.frame_size*mga_vid_config.num_frames);
433 #ifndef VO_XMGA
434 ioctl(f,MGA_VID_ON,0);
435 #endif
437 return 0;
440 static int mga_uninit(){
441 if(f>=0){
442 ioctl( f,MGA_VID_OFF,0 );
443 munmap(frames[0],mga_vid_config.frame_size*mga_vid_config.num_frames);
444 close(f);
445 f = -1;
447 return 0;
450 static int preinit(const char *vo_subdevice)
452 const char *devname=vo_subdevice?vo_subdevice:"/dev/mga_vid";
453 sws_rgb2rgb_init(get_sws_cpuflags());
455 f = open(devname,O_RDWR);
456 if(f == -1)
458 perror("open");
459 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_CouldntOpen,devname);
460 return(-1);
463 #ifdef VO_XMGA
464 if (!vo_init()) {
465 close(f);
466 return -1;
468 #endif
470 return 0;
473 static void set_window( void ){
475 #ifdef VO_XMGA
476 if ( WinID )
478 XGetGeometry( mDisplay,vo_window,&mRoot,&drwX,&drwY,&drwWidth,&drwHeight,&drwBorderWidth,&drwDepth );
479 mp_msg(MSGT_VO,MSGL_V,"[xmga] x: %d y: %d w: %d h: %d\n",drwX,drwY,drwWidth,drwHeight );
480 drwX=0; drwY=0;
481 XTranslateCoordinates( mDisplay,vo_window,mRoot,0,0,&drwcX,&drwcY,&mRoot );
482 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 );
485 else
486 #endif
487 { drwX=drwcX=vo_dx; drwY=drwcY=vo_dy; drwWidth=vo_dwidth; drwHeight=vo_dheight; }
489 aspect(&dwidth,&dheight,A_NOZOOM);
490 if ( vo_fs )
492 aspect(&dwidth,&dheight,A_ZOOM);
493 drwX=( vo_screenwidth - (dwidth > vo_screenwidth?vo_screenwidth:dwidth) ) / 2;
494 drwcX+=drwX;
495 drwY=( vo_screenheight - (dheight > vo_screenheight?vo_screenheight:dheight) ) / 2;
496 drwcY+=drwY;
497 drwWidth=(dwidth > vo_screenwidth?vo_screenwidth:dwidth);
498 drwHeight=(dheight > vo_screenheight?vo_screenheight:dheight);
499 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 );
501 vo_dwidth=drwWidth; vo_dheight=drwHeight;
503 #ifdef VO_XMGA
504 #ifdef HAVE_XINERAMA
505 if(XineramaIsActive(mDisplay))
507 XineramaScreenInfo *screens;
508 int num_screens;
509 int i;
511 screens = XineramaQueryScreens(mDisplay,&num_screens);
513 /* find the screen we are on */
514 i = 0;
515 while(i<num_screens &&
516 ((screens[i].x_org < drwcX) ||
517 (screens[i].y_org < drwcY) ||
518 (screens[i].x_org + screens[i].width >= drwcX) ||
519 (screens[i].y_org + screens[i].height >= drwcY)))
521 i++;
524 if(i<num_screens)
526 /* save the screen we are on */
527 xinerama_screen = i;
528 } else {
529 /* oops.. couldnt find the screen we are on
530 * because the upper left corner left the
531 * visual range. assume we are still on the
532 * same screen
534 i = xinerama_screen;
537 if(xinerama_screen == -1)
539 // The default value of the xinerama_screen is
540 // still there. Which means we could never
541 // figure out on which screen we are.
542 // Choose the first screen as default
543 xinerama_screen = i = 0;
546 /* set drwcX and drwcY to the right values */
547 drwcX = drwcX - screens[i].x_org;
548 drwcY = drwcY - screens[i].y_org;
549 XFree(screens);
552 #endif
554 mDrawColorKey();
555 #endif
557 mga_vid_config.x_org=drwcX;
558 mga_vid_config.y_org=drwcY;
559 mga_vid_config.dest_width=drwWidth;
560 mga_vid_config.dest_height=drwHeight;
561 if ( vo_panscan > 0.0f && vo_fs )
563 drwX-=vo_panscan_x>>1;
564 drwY-=vo_panscan_y>>1;
565 drwWidth+=vo_panscan_x;
566 drwHeight+=vo_panscan_y;
568 mga_vid_config.x_org-=vo_panscan_x>>1;
569 mga_vid_config.y_org-=vo_panscan_y>>1;
570 mga_vid_config.dest_width=drwWidth;
571 mga_vid_config.dest_height=drwHeight;
572 #ifdef VO_XMGA
573 mDrawColorKey();
574 #endif
576 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?)" );