Merge svn changes up to r30529
[mplayer/kovensky.git] / libvo / mga_common.c
blob9a173b3ded5f4eb2999600f7c66233207e4c1be6
1 /*
2 * This file is part of MPlayer.
4 * MPlayer is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
9 * MPlayer is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
14 * You should have received a copy of the GNU General Public License along
15 * with MPlayer; if not, write to the Free Software Foundation, Inc.,
16 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
19 #include "fastmemcpy.h"
20 #include "cpudetect.h"
21 #include "libswscale/swscale.h"
22 #include "libswscale/rgb2rgb.h"
23 #include "libmpcodecs/vf_scale.h"
24 #include "mp_msg.h"
25 #include "help_mp.h"
26 #include "old_vo_wrapper.h"
28 // mga_vid drawing functions
29 static void set_window( void ); /* forward declaration to kill warnings */
30 #ifdef VO_XMGA
31 static void mDrawColorKey( void ); /* forward declaration to kill warnings */
32 #endif
34 static int mga_next_frame=0;
36 static mga_vid_config_t mga_vid_config;
37 static uint8_t *vid_data, *frames[4];
38 static int f = -1;
40 static uint32_t drwX,drwY,drwWidth,drwHeight;
41 #ifdef VO_XMGA
42 static uint32_t drwBorderWidth,drwDepth;
43 #endif
44 static uint32_t drwcX,drwcY,dwidth,dheight;
46 static void draw_alpha(int x0,int y0, int w,int h, unsigned char* src, unsigned char *srca, int stride){
47 uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
48 x0+=mga_vid_config.src_width*(vo_panscan_x>>1)/(vo_dwidth+vo_panscan_x);
49 switch(mga_vid_config.format){
50 case MGA_VID_FORMAT_YV12:
51 case MGA_VID_FORMAT_IYUV:
52 case MGA_VID_FORMAT_I420:
53 vo_draw_alpha_yv12(w,h,src,srca,stride,vid_data+bespitch*y0+x0,bespitch);
54 break;
55 case MGA_VID_FORMAT_YUY2:
56 vo_draw_alpha_yuy2(w,h,src,srca,stride,vid_data+2*(bespitch*y0+x0),2*bespitch);
57 break;
58 case MGA_VID_FORMAT_UYVY:
59 vo_draw_alpha_yuy2(w,h,src,srca,stride,vid_data+2*(bespitch*y0+x0)+1,2*bespitch);
60 break;
64 static void draw_osd(void)
66 // vo_draw_text(mga_vid_config.src_width,mga_vid_config.src_height,draw_alpha);
67 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);
71 //static void
72 //write_slice_g200(uint8_t *y,uint8_t *cr, uint8_t *cb,uint32_t slice_num)
74 static void
75 draw_slice_g200(uint8_t *image[], int stride[], int width,int height,int x,int y)
77 uint8_t *dest;
78 uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
80 dest = vid_data + bespitch*y + x;
81 mem2agpcpy_pic(dest, image[0], width, height, bespitch, stride[0]);
83 width/=2;height/=2;x/=2;y/=2;
85 dest = vid_data + bespitch*mga_vid_config.src_height + bespitch*y + 2*x;
87 interleaveBytes(image[1],image[2],dest,
88 width, height,
89 stride[1], stride[2], bespitch);
92 static void
93 draw_slice_g400(uint8_t *image[], int stride[], int w,int h,int x,int y)
95 uint8_t *dest;
96 uint8_t *dest2;
97 uint32_t bespitch,bespitch2;
99 bespitch = (mga_vid_config.src_width + 31) & ~31;
100 bespitch2 = bespitch/2;
102 dest = vid_data + bespitch * y + x;
103 mem2agpcpy_pic(dest, image[0], w, h, bespitch, stride[0]);
105 w/=2;h/=2;x/=2;y/=2;
107 dest = vid_data + bespitch*mga_vid_config.src_height + bespitch2 * y + x;
108 dest2= dest + bespitch2*mga_vid_config.src_height / 2;
110 if(mga_vid_config.format==MGA_VID_FORMAT_YV12){
111 // mga_vid's YV12 assumes Y,U,V order (insteda of Y,V,U) :(
112 mem2agpcpy_pic(dest, image[1], w, h, bespitch2, stride[1]);
113 mem2agpcpy_pic(dest2,image[2], w, h, bespitch2, stride[2]);
114 } else {
115 mem2agpcpy_pic(dest, image[2], w, h, bespitch2, stride[2]);
116 mem2agpcpy_pic(dest2,image[1], w, h, bespitch2, stride[1]);
121 static int
122 draw_slice(uint8_t *src[], int stride[], int w,int h,int x,int y)
125 #if 0
126 printf("vo: %p/%d %p/%d %p/%d %dx%d/%d;%d \n",
127 src[0],stride[0],
128 src[1],stride[1],
129 src[2],stride[2],
130 w,h,x,y);
131 #endif
133 if (mga_vid_config.card_type == MGA_G200)
134 draw_slice_g200(src,stride,w,h,x,y);
135 else
136 draw_slice_g400(src,stride,w,h,x,y);
137 return 0;
140 static void
141 vo_mga_flip_page(void)
144 // printf("-- flip to %d --\n",mga_next_frame);
146 #if 1
147 ioctl(f,MGA_VID_FSEL,&mga_next_frame);
148 mga_next_frame=(mga_next_frame+1)%mga_vid_config.num_frames;
149 vid_data=frames[mga_next_frame];
150 #endif
154 static int
155 draw_frame(uint8_t *src[])
157 mp_msg(MSGT_VO,MSGL_WARN,"!!! mga::draw_frame() called !!!\n");
158 return 0;
161 static uint32_t get_image(mp_image_t *mpi){
162 uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
163 uint32_t bespitch2 = bespitch/2;
164 // printf("mga: get_image() called\n");
165 if(mpi->type==MP_IMGTYPE_STATIC && mga_vid_config.num_frames>1) return VO_FALSE; // it is not static
166 if(mpi->flags&MP_IMGFLAG_READABLE) return VO_FALSE; // slow video ram
167 if(mga_vid_config.card_type == MGA_G200 && mpi->flags&MP_IMGFLAG_PLANAR) return VO_FALSE;
168 // printf("width=%d vs. bespitch=%d, flags=0x%X \n",mpi->width,bespitch,mpi->flags);
169 if((mpi->width==bespitch) ||
170 (mpi->flags&(MP_IMGFLAG_ACCEPT_STRIDE|MP_IMGFLAG_ACCEPT_WIDTH))){
171 // we're lucky or codec accepts stride => ok, let's go!
172 if(mpi->flags&MP_IMGFLAG_PLANAR){
173 mpi->planes[0]=vid_data;
174 if(mpi->flags&MP_IMGFLAG_SWAPPED){
175 mpi->planes[1]=vid_data + bespitch*mga_vid_config.src_height;
176 mpi->planes[2]=mpi->planes[1] + bespitch2*mga_vid_config.src_height/2;
177 } else {
178 mpi->planes[2]=vid_data + bespitch*mga_vid_config.src_height;
179 mpi->planes[1]=mpi->planes[2] + bespitch2*mga_vid_config.src_height/2;
181 mpi->width=mpi->stride[0]=bespitch;
182 mpi->stride[1]=mpi->stride[2]=bespitch2;
183 } else {
184 mpi->planes[0]=vid_data;
185 mpi->width=bespitch;
186 mpi->stride[0]=mpi->width*(mpi->bpp/8);
188 mpi->flags|=MP_IMGFLAG_DIRECT;
189 // printf("mga: get_image() SUCCESS -> Direct Rendering ENABLED\n");
190 return VO_TRUE;
192 return VO_FALSE;
195 static uint32_t
196 draw_image(mp_image_t *mpi){
197 uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
199 // if -dr or -slices then do nothing:
200 if(mpi->flags&(MP_IMGFLAG_DIRECT|MP_IMGFLAG_DRAW_CALLBACK)) return VO_TRUE;
202 if(mpi->flags&MP_IMGFLAG_PLANAR){
203 // copy planar:
204 draw_slice(mpi->planes,mpi->stride,mpi->w,mpi->h,mpi->x,mpi->y);
205 } else {
206 // copy packed:
207 mem2agpcpy_pic(vid_data, mpi->planes[0], // dst,src
208 mpi->w*(mpi->bpp/8), mpi->h, // w,h
209 bespitch*2, mpi->stride[0]); // dstride,sstride
211 return VO_TRUE;
214 static int
215 query_format(uint32_t format)
217 switch(format){
218 case IMGFMT_YV12:
219 case IMGFMT_I420:
220 case IMGFMT_IYUV:
221 case IMGFMT_YUY2:
222 case IMGFMT_UYVY:
223 return VFCAP_CSP_SUPPORTED | VFCAP_CSP_SUPPORTED_BY_HW | VFCAP_OSD|VFCAP_HWSCALE_UP|VFCAP_HWSCALE_DOWN|VFCAP_ACCEPT_STRIDE;
225 return 0;
228 #ifndef VO_XMGA
229 static void mga_fullscreen(void)
231 uint32_t w,h;
232 if ( !vo_fs ) {
233 vo_fs=VO_TRUE;
234 w=vo_screenwidth; h=vo_screenheight;
235 aspect(&w,&h,A_ZOOM);
236 } else {
237 vo_fs=VO_FALSE;
238 w=vo_dwidth; h=vo_dheight;
239 aspect(&w,&h,A_NOZOOM);
241 mga_vid_config.dest_width = w;
242 mga_vid_config.dest_height= h;
243 mga_vid_config.x_org=(vo_screenwidth-w)/2;
244 mga_vid_config.y_org=(vo_screenheight-h)/2;
245 if ( ioctl( f,MGA_VID_CONFIG,&mga_vid_config ) )
246 mp_tmsg(MSGT_VO,MSGL_WARN, "[MGA] error in mga_vid_config ioctl (wrong mga_vid.o version?)" );
248 #endif
250 static int control(uint32_t request, void *data)
252 switch (request) {
253 case VOCTRL_QUERY_FORMAT:
254 return query_format(*((uint32_t*)data));
255 case VOCTRL_GET_IMAGE:
256 return get_image(data);
257 case VOCTRL_DRAW_IMAGE:
258 return draw_image(data);
259 case VOCTRL_SET_EQUALIZER:
261 short value;
262 uint32_t luma,prev;
263 struct voctrl_set_equalizer_args *args = data;
265 if (strcmp(args->name, "brightness") && strcmp(args->name, "contrast"))
266 return VO_FALSE;
268 if (ioctl(f,MGA_VID_GET_LUMA,&prev)) {
269 perror("Error in mga_vid_config ioctl()");
270 mp_tmsg(MSGT_VO,MSGL_WARN, "[MGA] Could not get luma values from the kernel module!\n");
271 return VO_FALSE;
274 // printf("GET: 0x%4X 0x%4X \n",(prev>>16),(prev&0xffff));
276 value = args->value;
278 // printf("value: %d -> ",value);
279 value=((value+100)*255)/200-128; // maps -100=>-128 and +100=>127
280 // printf("%d \n",value);
282 if (!strcmp(args->name, "contrast"))
283 luma = (prev&0xFFFF0000)|(value&0xFFFF);
284 else
285 luma = (prev&0xFFFF)|(value<<16);
287 if (ioctl(f,MGA_VID_SET_LUMA,luma)) {
288 perror("Error in mga_vid_config ioctl()");
289 mp_tmsg(MSGT_VO,MSGL_WARN, "[MGA] Could not set luma values from the kernel module!\n");
290 return VO_FALSE;
293 return VO_TRUE;
296 case VOCTRL_GET_EQUALIZER:
298 short val;
299 uint32_t luma;
300 struct voctrl_get_equalizer_args *args = data;
302 if (strcmp(args->name, "brightness") && strcmp(args->name, "contrast"))
303 return VO_FALSE;
305 if (ioctl(f,MGA_VID_GET_LUMA,&luma)) {
306 perror("Error in mga_vid_config ioctl()");
307 mp_tmsg(MSGT_VO,MSGL_WARN, "[MGA] Could not get luma values from the kernel module!\n");
308 return VO_FALSE;
311 if (!strcmp(args->name, "contrast"))
312 val=(luma & 0xFFFF);
313 else
314 val=(luma >> 16);
316 *args->valueptr = (val*200)/255;
318 return VO_TRUE;
321 #ifndef VO_XMGA
322 case VOCTRL_FULLSCREEN:
323 if (vo_screenwidth && vo_screenheight)
324 mga_fullscreen();
325 else
326 mp_tmsg(MSGT_VO,MSGL_WARN, "[MGA] Screen width/height unknown!\n");
327 return VO_TRUE;
328 case VOCTRL_GET_PANSCAN:
329 if ( !vo_fs ) return VO_FALSE;
330 return VO_TRUE;
331 #endif
333 #ifdef VO_XMGA
334 case VOCTRL_ONTOP:
335 vo_x11_ontop();
336 return VO_TRUE;
337 case VOCTRL_GET_PANSCAN:
338 if ( !initialized || !vo_fs ) return VO_FALSE;
339 return VO_TRUE;
340 case VOCTRL_FULLSCREEN:
341 vo_x11_fullscreen();
342 vo_panscan_amount=0;
343 /* indended, fallthrough to update panscan on fullscreen/windowed switch */
344 #endif
345 case VOCTRL_SET_PANSCAN:
346 if ( vo_fs && ( vo_panscan != vo_panscan_amount ) ) // || ( !vo_fs && vo_panscan_amount ) )
348 // int old_y = vo_panscan_y;
349 panscan_calc();
350 // if ( old_y != vo_panscan_y )
351 set_window();
353 return VO_TRUE;
355 return VO_NOTIMPL;
359 static int mga_init(int width,int height,unsigned int format){
361 switch(format){
362 case IMGFMT_YV12:
363 width+=width&1;height+=height&1;
364 mga_vid_config.frame_size = ((width + 31) & ~31) * height + (((width + 31) & ~31) * height) / 2;
365 mga_vid_config.format=MGA_VID_FORMAT_I420; break;
366 case IMGFMT_I420:
367 case IMGFMT_IYUV:
368 width+=width&1;height+=height&1;
369 mga_vid_config.frame_size = ((width + 31) & ~31) * height + (((width + 31) & ~31) * height) / 2;
370 mga_vid_config.format=MGA_VID_FORMAT_YV12; break;
371 case IMGFMT_YUY2:
372 mga_vid_config.frame_size = ((width + 31) & ~31) * height * 2;
373 mga_vid_config.format=MGA_VID_FORMAT_YUY2; break;
374 case IMGFMT_UYVY:
375 mga_vid_config.frame_size = ((width + 31) & ~31) * height * 2;
376 mga_vid_config.format=MGA_VID_FORMAT_UYVY; break;
377 default:
378 mp_tmsg(MSGT_VO,MSGL_WARN, "[MGA] invalid output format %0X\n",format);
379 return -1;
382 mga_vid_config.src_width = width;
383 mga_vid_config.src_height= height;
384 if(!mga_vid_config.dest_width)
385 mga_vid_config.dest_width = width;
386 if(!mga_vid_config.dest_height)
387 mga_vid_config.dest_height= height;
389 mga_vid_config.colkey_on=0;
391 mga_vid_config.num_frames=(vo_directrendering && !vo_doublebuffering)?1:3;
392 mga_vid_config.version=MGA_VID_VERSION;
394 if(width > 1024 && height > 1024)
396 mp_tmsg(MSGT_VO,MSGL_ERR, "[MGA] Source resolution exceeds 1023x1023 in at least one dimension.\n[MGA] Rescale in software or use -lavdopts lowres=1.\n");
397 return -1;
398 } else if(height <= 1024)
400 // try whether we have a G550
401 int ret;
402 if ((ret = ioctl(f,MGA_VID_CONFIG,&mga_vid_config)))
404 if(mga_vid_config.card_type != MGA_G550)
406 // we don't have a G550, so our resolution is too high
407 mp_tmsg(MSGT_VO,MSGL_ERR, "[MGA] Source resolution exceeds 1023x1023 in at least one dimension.\n[MGA] Rescale in software or use -lavdopts lowres=1.\n");
408 return -1;
409 } else {
410 // there is a deeper problem
411 // we have a G550, but still couldn't configure mga_vid
412 perror("Error in mga_vid_config ioctl()");
413 mp_tmsg(MSGT_VO,MSGL_WARN, "[MGA] Your mga_vid driver version is incompatible with this MPlayer version!\n");
414 return -1;
416 // if we arrived here, then we could successfully configure mga_vid
417 // at this high resolution
419 } else {
420 // configure mga_vid in case resolution is < 1024x1024 too
421 if (ioctl(f,MGA_VID_CONFIG,&mga_vid_config))
423 perror("Error in mga_vid_config ioctl()");
424 mp_tmsg(MSGT_VO,MSGL_WARN, "[MGA] Your mga_vid driver version is incompatible with this MPlayer version!\n");
425 return -1;
429 mp_msg(MSGT_VO,MSGL_V,"[MGA] Using %d buffers.\n",mga_vid_config.num_frames);
431 frames[0] = (char*)mmap(0,mga_vid_config.frame_size*mga_vid_config.num_frames,PROT_WRITE,MAP_SHARED,f,0);
432 frames[1] = frames[0] + 1*mga_vid_config.frame_size;
433 frames[2] = frames[0] + 2*mga_vid_config.frame_size;
434 frames[3] = frames[0] + 3*mga_vid_config.frame_size;
435 mga_next_frame = 0;
436 vid_data = frames[mga_next_frame];
438 //clear the buffer
439 memset(frames[0],0x80,mga_vid_config.frame_size*mga_vid_config.num_frames);
441 #ifndef VO_XMGA
442 ioctl(f,MGA_VID_ON,0);
443 #endif
445 return 0;
448 static int mga_uninit(void){
449 if(f>=0){
450 ioctl( f,MGA_VID_OFF,0 );
451 munmap(frames[0],mga_vid_config.frame_size*mga_vid_config.num_frames);
452 close(f);
453 f = -1;
455 return 0;
458 static int preinit(const char *vo_subdevice)
460 uint32_t ver;
461 const char *devname=vo_subdevice?vo_subdevice:"/dev/mga_vid";
462 sws_rgb2rgb_init(get_sws_cpuflags());
464 f = open(devname,O_RDWR);
465 if(f == -1)
467 perror("open");
468 mp_tmsg(MSGT_VO,MSGL_WARN, "[MGA] Couldn't open: %s\n",devname);
469 return -1;
472 // check whether the mga_vid driver has the same
473 // version as we expect
475 ioctl(f,MGA_VID_GET_VERSION,&ver);
476 if(MGA_VID_VERSION != ver)
478 mp_tmsg(MSGT_VO, MSGL_ERR, "[MGA] mismatch between kernel (%u) and MPlayer (%u) mga_vid driver versions\n", ver, MGA_VID_VERSION);
479 return -1;
482 #ifdef VO_XMGA
483 if (!vo_init()) {
484 close(f);
485 return -1;
487 #endif
489 return 0;
492 static void set_window( void ){
494 #ifdef VO_XMGA
495 if ( WinID )
497 XGetGeometry( mDisplay,vo_window,&mRoot,&drwX,&drwY,&drwWidth,&drwHeight,&drwBorderWidth,&drwDepth );
498 mp_msg(MSGT_VO,MSGL_V,"[xmga] x: %d y: %d w: %d h: %d\n",drwX,drwY,drwWidth,drwHeight );
499 drwX=0; drwY=0;
500 XTranslateCoordinates( mDisplay,vo_window,mRoot,0,0,&drwcX,&drwcY,&mRoot );
501 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 );
504 else
505 #endif
506 { drwX=drwcX=vo_dx; drwY=drwcY=vo_dy; drwWidth=vo_dwidth; drwHeight=vo_dheight; }
508 aspect(&dwidth,&dheight,A_NOZOOM);
509 if ( vo_fs )
511 aspect(&dwidth,&dheight,A_ZOOM);
512 drwX=( vo_screenwidth - (dwidth > vo_screenwidth?vo_screenwidth:dwidth) ) / 2;
513 drwcX+=drwX;
514 drwY=( vo_screenheight - (dheight > vo_screenheight?vo_screenheight:dheight) ) / 2;
515 drwcY+=drwY;
516 drwWidth=(dwidth > vo_screenwidth?vo_screenwidth:dwidth);
517 drwHeight=(dheight > vo_screenheight?vo_screenheight:dheight);
518 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 );
520 vo_dwidth=drwWidth; vo_dheight=drwHeight;
522 #ifdef VO_XMGA
523 #ifdef CONFIG_XINERAMA
524 if(XineramaIsActive(mDisplay))
526 XineramaScreenInfo *screens;
527 int num_screens;
528 int i;
530 screens = XineramaQueryScreens(mDisplay,&num_screens);
532 /* find the screen we are on */
533 i = 0;
534 while(i<num_screens &&
535 ((screens[i].x_org < drwcX) ||
536 (screens[i].y_org < drwcY) ||
537 (screens[i].x_org + screens[i].width >= drwcX) ||
538 (screens[i].y_org + screens[i].height >= drwcY)))
540 i++;
543 if(i<num_screens)
545 /* save the screen we are on */
546 xinerama_screen = i;
547 } else {
548 /* oops.. couldnt find the screen we are on
549 * because the upper left corner left the
550 * visual range. assume we are still on the
551 * same screen
553 i = xinerama_screen;
556 if(xinerama_screen == -1)
558 // The default value of the xinerama_screen is
559 // still there. Which means we could never
560 // figure out on which screen we are.
561 // Choose the first screen as default
562 xinerama_screen = i = 0;
565 /* set drwcX and drwcY to the right values */
566 drwcX = drwcX - screens[i].x_org;
567 drwcY = drwcY - screens[i].y_org;
568 XFree(screens);
571 #endif
573 mDrawColorKey();
574 #endif
576 mga_vid_config.x_org=drwcX;
577 mga_vid_config.y_org=drwcY;
578 mga_vid_config.dest_width=drwWidth;
579 mga_vid_config.dest_height=drwHeight;
580 if ( vo_panscan > 0.0f && vo_fs )
582 drwX-=vo_panscan_x>>1;
583 drwY-=vo_panscan_y>>1;
584 drwWidth+=vo_panscan_x;
585 drwHeight+=vo_panscan_y;
587 mga_vid_config.x_org-=vo_panscan_x>>1;
588 mga_vid_config.y_org-=vo_panscan_y>>1;
589 mga_vid_config.dest_width=drwWidth;
590 mga_vid_config.dest_height=drwHeight;
591 #ifdef VO_XMGA
592 mDrawColorKey();
593 #endif
595 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?)" );