Replace informal GPL license header by standard GPL header.
[mplayer/glamo.git] / libvo / mga_common.c
blob6981123eb8a4feb71c0cfc1892b58db7d9951ace
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"
27 // mga_vid drawing functions
28 static void set_window( void ); /* forward declaration to kill warnings */
29 #ifdef VO_XMGA
30 static void mDrawColorKey( void ); /* forward declaration to kill warnings */
31 #endif
33 static int mga_next_frame=0;
35 static mga_vid_config_t mga_vid_config;
36 static uint8_t *vid_data, *frames[4];
37 static int f = -1;
39 static uint32_t drwX,drwY,drwWidth,drwHeight;
40 #ifdef VO_XMGA
41 static uint32_t drwBorderWidth,drwDepth;
42 #endif
43 static uint32_t drwcX,drwcY,dwidth,dheight;
45 static void draw_alpha(int x0,int y0, int w,int h, unsigned char* src, unsigned char *srca, int stride){
46 uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
47 x0+=mga_vid_config.src_width*(vo_panscan_x>>1)/(vo_dwidth+vo_panscan_x);
48 switch(mga_vid_config.format){
49 case MGA_VID_FORMAT_YV12:
50 case MGA_VID_FORMAT_IYUV:
51 case MGA_VID_FORMAT_I420:
52 vo_draw_alpha_yv12(w,h,src,srca,stride,vid_data+bespitch*y0+x0,bespitch);
53 break;
54 case MGA_VID_FORMAT_YUY2:
55 vo_draw_alpha_yuy2(w,h,src,srca,stride,vid_data+2*(bespitch*y0+x0),2*bespitch);
56 break;
57 case MGA_VID_FORMAT_UYVY:
58 vo_draw_alpha_yuy2(w,h,src,srca,stride,vid_data+2*(bespitch*y0+x0)+1,2*bespitch);
59 break;
63 static void draw_osd(void)
65 // vo_draw_text(mga_vid_config.src_width,mga_vid_config.src_height,draw_alpha);
66 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);
70 //static void
71 //write_slice_g200(uint8_t *y,uint8_t *cr, uint8_t *cb,uint32_t slice_num)
73 static void
74 draw_slice_g200(uint8_t *image[], int stride[], int width,int height,int x,int y)
76 uint8_t *dest;
77 uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
79 dest = vid_data + bespitch*y + x;
80 mem2agpcpy_pic(dest, image[0], width, height, bespitch, stride[0]);
82 width/=2;height/=2;x/=2;y/=2;
84 dest = vid_data + bespitch*mga_vid_config.src_height + bespitch*y + 2*x;
86 interleaveBytes(image[1],image[2],dest,
87 width, height,
88 stride[1], stride[2], bespitch);
91 static void
92 draw_slice_g400(uint8_t *image[], int stride[], int w,int h,int x,int y)
94 uint8_t *dest;
95 uint8_t *dest2;
96 uint32_t bespitch,bespitch2;
98 bespitch = (mga_vid_config.src_width + 31) & ~31;
99 bespitch2 = bespitch/2;
101 dest = vid_data + bespitch * y + x;
102 mem2agpcpy_pic(dest, image[0], w, h, bespitch, stride[0]);
104 w/=2;h/=2;x/=2;y/=2;
106 dest = vid_data + bespitch*mga_vid_config.src_height + bespitch2 * y + x;
107 dest2= dest + bespitch2*mga_vid_config.src_height / 2;
109 if(mga_vid_config.format==MGA_VID_FORMAT_YV12){
110 // mga_vid's YV12 assumes Y,U,V order (insteda of Y,V,U) :(
111 mem2agpcpy_pic(dest, image[1], w, h, bespitch2, stride[1]);
112 mem2agpcpy_pic(dest2,image[2], w, h, bespitch2, stride[2]);
113 } else {
114 mem2agpcpy_pic(dest, image[2], w, h, bespitch2, stride[2]);
115 mem2agpcpy_pic(dest2,image[1], w, h, bespitch2, stride[1]);
120 static int
121 draw_slice(uint8_t *src[], int stride[], int w,int h,int x,int y)
124 #if 0
125 printf("vo: %p/%d %p/%d %p/%d %dx%d/%d;%d \n",
126 src[0],stride[0],
127 src[1],stride[1],
128 src[2],stride[2],
129 w,h,x,y);
130 #endif
132 if (mga_vid_config.card_type == MGA_G200)
133 draw_slice_g200(src,stride,w,h,x,y);
134 else
135 draw_slice_g400(src,stride,w,h,x,y);
136 return 0;
139 static void
140 vo_mga_flip_page(void)
143 // printf("-- flip to %d --\n",mga_next_frame);
145 #if 1
146 ioctl(f,MGA_VID_FSEL,&mga_next_frame);
147 mga_next_frame=(mga_next_frame+1)%mga_vid_config.num_frames;
148 vid_data=frames[mga_next_frame];
149 #endif
153 static int
154 draw_frame(uint8_t *src[])
156 mp_msg(MSGT_VO,MSGL_WARN,"!!! mga::draw_frame() called !!!\n");
157 return 0;
160 static uint32_t get_image(mp_image_t *mpi){
161 uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
162 uint32_t bespitch2 = bespitch/2;
163 // printf("mga: get_image() called\n");
164 if(mpi->type==MP_IMGTYPE_STATIC && mga_vid_config.num_frames>1) return VO_FALSE; // it is not static
165 if(mpi->flags&MP_IMGFLAG_READABLE) return VO_FALSE; // slow video ram
166 if(mga_vid_config.card_type == MGA_G200 && mpi->flags&MP_IMGFLAG_PLANAR) return VO_FALSE;
167 // printf("width=%d vs. bespitch=%d, flags=0x%X \n",mpi->width,bespitch,mpi->flags);
168 if((mpi->width==bespitch) ||
169 (mpi->flags&(MP_IMGFLAG_ACCEPT_STRIDE|MP_IMGFLAG_ACCEPT_WIDTH))){
170 // we're lucky or codec accepts stride => ok, let's go!
171 if(mpi->flags&MP_IMGFLAG_PLANAR){
172 mpi->planes[0]=vid_data;
173 if(mpi->flags&MP_IMGFLAG_SWAPPED){
174 mpi->planes[1]=vid_data + bespitch*mga_vid_config.src_height;
175 mpi->planes[2]=mpi->planes[1] + bespitch2*mga_vid_config.src_height/2;
176 } else {
177 mpi->planes[2]=vid_data + bespitch*mga_vid_config.src_height;
178 mpi->planes[1]=mpi->planes[2] + bespitch2*mga_vid_config.src_height/2;
180 mpi->width=mpi->stride[0]=bespitch;
181 mpi->stride[1]=mpi->stride[2]=bespitch2;
182 } else {
183 mpi->planes[0]=vid_data;
184 mpi->width=bespitch;
185 mpi->stride[0]=mpi->width*(mpi->bpp/8);
187 mpi->flags|=MP_IMGFLAG_DIRECT;
188 // printf("mga: get_image() SUCCESS -> Direct Rendering ENABLED\n");
189 return VO_TRUE;
191 return VO_FALSE;
194 static uint32_t
195 draw_image(mp_image_t *mpi){
196 uint32_t bespitch = (mga_vid_config.src_width + 31) & ~31;
198 // if -dr or -slices then do nothing:
199 if(mpi->flags&(MP_IMGFLAG_DIRECT|MP_IMGFLAG_DRAW_CALLBACK)) return VO_TRUE;
201 if(mpi->flags&MP_IMGFLAG_PLANAR){
202 // copy planar:
203 draw_slice(mpi->planes,mpi->stride,mpi->w,mpi->h,mpi->x,mpi->y);
204 } else {
205 // copy packed:
206 mem2agpcpy_pic(vid_data, mpi->planes[0], // dst,src
207 mpi->w*(mpi->bpp/8), mpi->h, // w,h
208 bespitch*2, mpi->stride[0]); // dstride,sstride
210 return VO_TRUE;
213 static int
214 query_format(uint32_t format)
216 switch(format){
217 case IMGFMT_YV12:
218 case IMGFMT_I420:
219 case IMGFMT_IYUV:
220 case IMGFMT_YUY2:
221 case IMGFMT_UYVY:
222 return VFCAP_CSP_SUPPORTED | VFCAP_CSP_SUPPORTED_BY_HW | VFCAP_OSD|VFCAP_HWSCALE_UP|VFCAP_HWSCALE_DOWN|VFCAP_ACCEPT_STRIDE;
224 return 0;
227 #ifndef VO_XMGA
228 static void mga_fullscreen(void)
230 uint32_t w,h;
231 if ( !vo_fs ) {
232 vo_fs=VO_TRUE;
233 w=vo_screenwidth; h=vo_screenheight;
234 aspect(&w,&h,A_ZOOM);
235 } else {
236 vo_fs=VO_FALSE;
237 w=vo_dwidth; h=vo_dheight;
238 aspect(&w,&h,A_NOZOOM);
240 mga_vid_config.dest_width = w;
241 mga_vid_config.dest_height= h;
242 mga_vid_config.x_org=(vo_screenwidth-w)/2;
243 mga_vid_config.y_org=(vo_screenheight-h)/2;
244 if ( ioctl( f,MGA_VID_CONFIG,&mga_vid_config ) )
245 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_ErrorInConfigIoctl );
247 #endif
249 static int control(uint32_t request, void *data, ...)
251 switch (request) {
252 case VOCTRL_QUERY_FORMAT:
253 return query_format(*((uint32_t*)data));
254 case VOCTRL_GET_IMAGE:
255 return get_image(data);
256 case VOCTRL_DRAW_IMAGE:
257 return draw_image(data);
258 case VOCTRL_SET_EQUALIZER:
260 va_list ap;
261 short value;
262 uint32_t luma,prev;
264 if ( strcmp( data,"brightness" ) && strcmp( data,"contrast" ) ) return VO_FALSE;
266 if (ioctl(f,MGA_VID_GET_LUMA,&prev)) {
267 perror("Error in mga_vid_config ioctl()");
268 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_CouldNotGetLumaValuesFromTheKernelModule);
269 return VO_FALSE;
272 // printf("GET: 0x%4X 0x%4X \n",(prev>>16),(prev&0xffff));
274 va_start(ap, data);
275 value = va_arg(ap, int);
276 va_end(ap);
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(data,"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_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_CouldNotSetLumaValuesFromTheKernelModule);
290 return VO_FALSE;
293 return VO_TRUE;
296 case VOCTRL_GET_EQUALIZER:
298 va_list ap;
299 int * value;
300 short val;
301 uint32_t luma;
303 if ( strcmp( data,"brightness" ) && strcmp( data,"contrast" ) ) return VO_FALSE;
305 if (ioctl(f,MGA_VID_GET_LUMA,&luma)) {
306 perror("Error in mga_vid_config ioctl()");
307 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_CouldNotGetLumaValuesFromTheKernelModule);
308 return VO_FALSE;
311 if ( !strcmp( data,"contrast" ) )
312 val=(luma & 0xFFFF);
313 else
314 val=(luma >> 16);
316 va_start(ap, data);
317 value = va_arg(ap, int*);
318 va_end(ap);
320 *value = (val*200)/255;
322 return VO_TRUE;
325 #ifndef VO_XMGA
326 case VOCTRL_FULLSCREEN:
327 if (vo_screenwidth && vo_screenheight)
328 mga_fullscreen();
329 else
330 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_ScreenWidthHeightUnknown);
331 return VO_TRUE;
332 case VOCTRL_GET_PANSCAN:
333 if ( !vo_fs ) return VO_FALSE;
334 return VO_TRUE;
335 #endif
337 #if defined(VO_XMGA) && defined(CONFIG_GUI)
338 case VOCTRL_GUISUPPORT:
339 return VO_TRUE;
340 #endif
342 #ifdef VO_XMGA
343 case VOCTRL_ONTOP:
344 vo_x11_ontop();
345 return VO_TRUE;
346 case VOCTRL_GET_PANSCAN:
347 if ( !initialized || !vo_fs ) return VO_FALSE;
348 return VO_TRUE;
349 case VOCTRL_FULLSCREEN:
350 vo_x11_fullscreen();
351 vo_panscan_amount=0;
352 /* indended, fallthrough to update panscan on fullscreen/windowed switch */
353 #endif
354 case VOCTRL_SET_PANSCAN:
355 if ( vo_fs && ( vo_panscan != vo_panscan_amount ) ) // || ( !vo_fs && vo_panscan_amount ) )
357 // int old_y = vo_panscan_y;
358 panscan_calc();
359 // if ( old_y != vo_panscan_y )
360 set_window();
362 return VO_TRUE;
364 return VO_NOTIMPL;
368 static int mga_init(int width,int height,unsigned int format){
370 switch(format){
371 case IMGFMT_YV12:
372 width+=width&1;height+=height&1;
373 mga_vid_config.frame_size = ((width + 31) & ~31) * height + (((width + 31) & ~31) * height) / 2;
374 mga_vid_config.format=MGA_VID_FORMAT_I420; break;
375 case IMGFMT_I420:
376 case IMGFMT_IYUV:
377 width+=width&1;height+=height&1;
378 mga_vid_config.frame_size = ((width + 31) & ~31) * height + (((width + 31) & ~31) * height) / 2;
379 mga_vid_config.format=MGA_VID_FORMAT_YV12; break;
380 case IMGFMT_YUY2:
381 mga_vid_config.frame_size = ((width + 31) & ~31) * height * 2;
382 mga_vid_config.format=MGA_VID_FORMAT_YUY2; break;
383 case IMGFMT_UYVY:
384 mga_vid_config.frame_size = ((width + 31) & ~31) * height * 2;
385 mga_vid_config.format=MGA_VID_FORMAT_UYVY; break;
386 default:
387 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_InvalidOutputFormat,format);
388 return -1;
391 mga_vid_config.src_width = width;
392 mga_vid_config.src_height= height;
393 if(!mga_vid_config.dest_width)
394 mga_vid_config.dest_width = width;
395 if(!mga_vid_config.dest_height)
396 mga_vid_config.dest_height= height;
398 mga_vid_config.colkey_on=0;
400 mga_vid_config.num_frames=(vo_directrendering && !vo_doublebuffering)?1:3;
401 mga_vid_config.version=MGA_VID_VERSION;
403 if(width > 1024 && height > 1024)
405 mp_msg(MSGT_VO,MSGL_ERR, MSGTR_LIBVO_MGA_ResolutionTooHigh);
406 return -1;
407 } else if(height <= 1024)
409 // try whether we have a G550
410 int ret;
411 if ((ret = ioctl(f,MGA_VID_CONFIG,&mga_vid_config)))
413 if(mga_vid_config.card_type != MGA_G550)
415 // we don't have a G550, so our resolution is too high
416 mp_msg(MSGT_VO,MSGL_ERR, MSGTR_LIBVO_MGA_ResolutionTooHigh);
417 return -1;
418 } else {
419 // there is a deeper problem
420 // we have a G550, but still couldn't configure mga_vid
421 perror("Error in mga_vid_config ioctl()");
422 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_IncompatibleDriverVersion);
423 return -1;
425 // if we arrived here, then we could successfully configure mga_vid
426 // at this high resolution
428 } else {
429 // configure mga_vid in case resolution is < 1024x1024 too
430 if (ioctl(f,MGA_VID_CONFIG,&mga_vid_config))
432 perror("Error in mga_vid_config ioctl()");
433 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_IncompatibleDriverVersion);
434 return -1;
438 mp_msg(MSGT_VO,MSGL_V,"[MGA] Using %d buffers.\n",mga_vid_config.num_frames);
440 frames[0] = (char*)mmap(0,mga_vid_config.frame_size*mga_vid_config.num_frames,PROT_WRITE,MAP_SHARED,f,0);
441 frames[1] = frames[0] + 1*mga_vid_config.frame_size;
442 frames[2] = frames[0] + 2*mga_vid_config.frame_size;
443 frames[3] = frames[0] + 3*mga_vid_config.frame_size;
444 mga_next_frame = 0;
445 vid_data = frames[mga_next_frame];
447 //clear the buffer
448 memset(frames[0],0x80,mga_vid_config.frame_size*mga_vid_config.num_frames);
450 #ifndef VO_XMGA
451 ioctl(f,MGA_VID_ON,0);
452 #endif
454 return 0;
457 static int mga_uninit(void){
458 if(f>=0){
459 ioctl( f,MGA_VID_OFF,0 );
460 munmap(frames[0],mga_vid_config.frame_size*mga_vid_config.num_frames);
461 close(f);
462 f = -1;
464 return 0;
467 static int preinit(const char *vo_subdevice)
469 uint32_t ver;
470 const char *devname=vo_subdevice?vo_subdevice:"/dev/mga_vid";
471 sws_rgb2rgb_init(get_sws_cpuflags());
473 f = open(devname,O_RDWR);
474 if(f == -1)
476 perror("open");
477 mp_msg(MSGT_VO,MSGL_WARN, MSGTR_LIBVO_MGA_CouldntOpen,devname);
478 return -1;
481 // check whether the mga_vid driver has the same
482 // version as we expect
484 ioctl(f,MGA_VID_GET_VERSION,&ver);
485 if(MGA_VID_VERSION != ver)
487 mp_msg(MSGT_VO, MSGL_ERR, MSGTR_LIBVO_MGA_mgavidVersionMismatch, ver, MGA_VID_VERSION);
488 return -1;
491 #ifdef VO_XMGA
492 if (!vo_init()) {
493 close(f);
494 return -1;
496 #endif
498 return 0;
501 static void set_window( void ){
503 #ifdef VO_XMGA
504 if ( WinID )
506 XGetGeometry( mDisplay,vo_window,&mRoot,&drwX,&drwY,&drwWidth,&drwHeight,&drwBorderWidth,&drwDepth );
507 mp_msg(MSGT_VO,MSGL_V,"[xmga] x: %d y: %d w: %d h: %d\n",drwX,drwY,drwWidth,drwHeight );
508 drwX=0; drwY=0;
509 XTranslateCoordinates( mDisplay,vo_window,mRoot,0,0,&drwcX,&drwcY,&mRoot );
510 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 );
513 else
514 #endif
515 { drwX=drwcX=vo_dx; drwY=drwcY=vo_dy; drwWidth=vo_dwidth; drwHeight=vo_dheight; }
517 aspect(&dwidth,&dheight,A_NOZOOM);
518 if ( vo_fs )
520 aspect(&dwidth,&dheight,A_ZOOM);
521 drwX=( vo_screenwidth - (dwidth > vo_screenwidth?vo_screenwidth:dwidth) ) / 2;
522 drwcX+=drwX;
523 drwY=( vo_screenheight - (dheight > vo_screenheight?vo_screenheight:dheight) ) / 2;
524 drwcY+=drwY;
525 drwWidth=(dwidth > vo_screenwidth?vo_screenwidth:dwidth);
526 drwHeight=(dheight > vo_screenheight?vo_screenheight:dheight);
527 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 );
529 vo_dwidth=drwWidth; vo_dheight=drwHeight;
531 #ifdef VO_XMGA
532 #ifdef CONFIG_XINERAMA
533 if(XineramaIsActive(mDisplay))
535 XineramaScreenInfo *screens;
536 int num_screens;
537 int i;
539 screens = XineramaQueryScreens(mDisplay,&num_screens);
541 /* find the screen we are on */
542 i = 0;
543 while(i<num_screens &&
544 ((screens[i].x_org < drwcX) ||
545 (screens[i].y_org < drwcY) ||
546 (screens[i].x_org + screens[i].width >= drwcX) ||
547 (screens[i].y_org + screens[i].height >= drwcY)))
549 i++;
552 if(i<num_screens)
554 /* save the screen we are on */
555 xinerama_screen = i;
556 } else {
557 /* oops.. couldnt find the screen we are on
558 * because the upper left corner left the
559 * visual range. assume we are still on the
560 * same screen
562 i = xinerama_screen;
565 if(xinerama_screen == -1)
567 // The default value of the xinerama_screen is
568 // still there. Which means we could never
569 // figure out on which screen we are.
570 // Choose the first screen as default
571 xinerama_screen = i = 0;
574 /* set drwcX and drwcY to the right values */
575 drwcX = drwcX - screens[i].x_org;
576 drwcY = drwcY - screens[i].y_org;
577 XFree(screens);
580 #endif
582 mDrawColorKey();
583 #endif
585 mga_vid_config.x_org=drwcX;
586 mga_vid_config.y_org=drwcY;
587 mga_vid_config.dest_width=drwWidth;
588 mga_vid_config.dest_height=drwHeight;
589 if ( vo_panscan > 0.0f && vo_fs )
591 drwX-=vo_panscan_x>>1;
592 drwY-=vo_panscan_y>>1;
593 drwWidth+=vo_panscan_x;
594 drwHeight+=vo_panscan_y;
596 mga_vid_config.x_org-=vo_panscan_x>>1;
597 mga_vid_config.y_org-=vo_panscan_y>>1;
598 mga_vid_config.dest_width=drwWidth;
599 mga_vid_config.dest_height=drwHeight;
600 #ifdef VO_XMGA
601 mDrawColorKey();
602 #endif
604 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?)" );