Mercurial > mplayer.hg
view libvo/vosub_vidix.c @ 4682:539a995924ba
use mem2agpcpy() instead of fast_memcpy()
author | michael |
---|---|
date | Tue, 12 Feb 2002 23:19:37 +0000 |
parents | 227365bd93c7 |
children | a2df307ed979 |
line wrap: on
line source
/* * vosub_vidix.c * * Copyright (C) Nick Kurshev <nickols_k@mail.ru> - 2002 * Copyright (C) Alex Beregszaszi * * You can redistribute this file under terms and conditions * of GNU General Public licence v2. * * This file contains vidix interface to any mplayer's VO plugin. * (Partly based on vesa_lvo.c from mplayer's package) */ #include <inttypes.h> #include <sys/ioctl.h> #include <unistd.h> #include <fcntl.h> #include <sys/mman.h> #include <stdio.h> #include <stdlib.h> #include <string.h> #include <errno.h> #include "config.h" #include "vosub_vidix.h" #include "../vidix/vidixlib.h" #include "fastmemcpy.h" #include "osd.h" #include "video_out.h" #define NUM_FRAMES 10 /* Temporary: driver will overwrite it */ #define UNUSED(x) ((void)(x)) /* Removes warning about unused arguments */ static VDL_HANDLE vidix_handler = NULL; static uint8_t *vidix_mem = NULL; static uint8_t next_frame; static unsigned image_bpp,image_height,image_width,src_format; extern int verbose; static int video_on=0; static vidix_capability_t vidix_cap; static vidix_playback_t vidix_play; static vidix_fourcc_t vidix_fourcc; static vo_functions_t * vo_server; static int vidix_get_bes_da(bes_da_t *); static int vidix_get_video_eq(vidix_video_eq_t *info); static int vidix_set_video_eq(const vidix_video_eq_t *info); static int vidix_get_num_fx(unsigned *info); static int vidix_get_oem_fx(vidix_oem_fx_t *info); static int vidix_set_oem_fx(const vidix_oem_fx_t *info); static int vidix_set_deint(const vidix_deinterlace_t *info); static void vidix_query_vaa(vo_vaa_t *vaa) { memset(vaa,0,sizeof(vo_vaa_t)); vaa->query_bes_da=vidix_get_bes_da; vaa->get_video_eq=vidix_get_video_eq; vaa->set_video_eq=vidix_set_video_eq; vaa->get_num_fx=vidix_get_num_fx; vaa->get_oem_fx=vidix_get_oem_fx; vaa->set_oem_fx=vidix_set_oem_fx; vaa->set_deint=vidix_set_deint; } extern int vo_gamma_brightness; extern int vo_gamma_saturation; extern int vo_gamma_contrast; extern int vo_gamma_hue; extern int vo_gamma_red_intensity; extern int vo_gamma_green_intensity; extern int vo_gamma_blue_intensity; static vidix_video_eq_t vid_eq; int vidix_start(void) { int err; if((err=vdlPlaybackOn(vidix_handler))!=0) { printf("vosub_vidix: Can't start playback: %s\n",strerror(err)); return -1; } video_on=1; if (vidix_cap.flags & FLAG_EQUALIZER) { if(verbose > 1) { printf("vosub_vidix: vo_gamma_brightness=%i\n" "vosub_vidix: vo_gamma_saturation=%i\n" "vosub_vidix: vo_gamma_contrast=%i\n" "vosub_vidix: vo_gamma_hue=%i\n" "vosub_vidix: vo_gamma_red_intensity=%i\n" "vosub_vidix: vo_gamma_green_intensity=%i\n" "vosub_vidix: vo_gamma_blue_intensity=%i\n" ,vo_gamma_brightness ,vo_gamma_saturation ,vo_gamma_contrast ,vo_gamma_hue ,vo_gamma_red_intensity ,vo_gamma_green_intensity ,vo_gamma_blue_intensity); } /* To use full set of vid_eq.cap */ if(vidix_get_video_eq(&vid_eq) == 0) { vid_eq.brightness = vo_gamma_brightness; vid_eq.saturation = vo_gamma_saturation; vid_eq.contrast = vo_gamma_contrast; vid_eq.hue = vo_gamma_hue; vid_eq.red_intensity = vo_gamma_red_intensity; vid_eq.green_intensity = vo_gamma_green_intensity; vid_eq.blue_intensity = vo_gamma_blue_intensity; vid_eq.flags = VEQ_FLG_ITU_R_BT_601; vidix_set_video_eq(&vid_eq); } } return 0; } int vidix_stop(void) { int err; if((err=vdlPlaybackOff(vidix_handler))!=0) { printf("vosub_vidix: Can't stop playback: %s\n",strerror(err)); return -1; } video_on=0; return 0; } void vidix_term( void ) { if(verbose > 1) printf("vosub_vidix: vidix_term() was called\n"); vidix_stop(); vdlClose(vidix_handler); } static uint32_t vidix_draw_slice_420(uint8_t *image[], int stride[], int w,int h,int x,int y) { uint8_t *src; uint8_t *dest; unsigned bespitch,apitch; int i; /* Plane Y */ apitch = vidix_play.dest.pitch.y-1; bespitch = (w + apitch) & ~apitch; dest = vidix_mem + vidix_play.offsets[next_frame] + vidix_play.offset.y; dest += bespitch*y + x; src = image[0]; for(i=0;i<h;i++){ memcpy(dest,src,w); src+=stride[0]; dest += bespitch; } if (vidix_play.flags & VID_PLAY_INTERLEAVED_UV) { printf("vosub_vidix: interleaving UV planes not supported yet\n"); return 0; } /* Plane V */ apitch = vidix_play.dest.pitch.v-1; bespitch = (w + apitch) & ~apitch; dest = vidix_mem + vidix_play.offsets[next_frame] + vidix_play.offset.v; dest += bespitch*y/4 + x; src = image[1]; for(i=0;i<h/2;i++){ memcpy(dest,src,w/2); src+=stride[1]; dest+=bespitch/2; } /* Plane U */ apitch = vidix_play.dest.pitch.u-1; bespitch = (w + apitch) & ~apitch; dest = vidix_mem + vidix_play.offsets[next_frame] + vidix_play.offset.u; dest += bespitch*y/4 + x; src = image[2]; for(i=0;i<h/2;i++){ memcpy(dest,src,w/2); src+=stride[2]; dest += bespitch/2; } return 0; } static uint32_t vidix_draw_slice_422(uint8_t *image[], int stride[], int w,int h,int x,int y) { uint8_t *src; uint8_t *dest; unsigned bespitch,apitch; int i; apitch = vidix_play.dest.pitch.y-1; bespitch = (w*2 + apitch) & ~apitch; dest = vidix_mem + vidix_play.offsets[next_frame] + vidix_play.offset.y; dest += bespitch*y + x; src = image[0]; for(i=0;i<h;i++){ memcpy(dest,src,w*2); src+=stride[0]; dest += bespitch; } return 0; } static uint32_t vidix_draw_slice_422_fast(uint8_t *image[], int stride[], int w,int h,int x,int y) { uint8_t *src; uint8_t *dest; unsigned bespitch,apitch; int i; apitch = vidix_play.dest.pitch.y-1; bespitch = (w*2 + apitch) & ~apitch; dest = vidix_mem + vidix_play.offsets[next_frame] + vidix_play.offset.y; dest += bespitch*y + x; src = image[0]; memcpy(dest,src,h*bespitch); return 0; } static uint32_t vidix_draw_slice_32(uint8_t *image[], int stride[], int w,int h,int x,int y) { uint8_t *src; uint8_t *dest; unsigned bespitch,apitch; int i; apitch = vidix_play.dest.pitch.y-1; bespitch = (w*4 + apitch) & ~apitch; dest = vidix_mem + vidix_play.offsets[next_frame] + vidix_play.offset.y; dest += bespitch*y + x; src = image[0]; for(i=0;i<h;i++){ memcpy(dest,src,w*4); src+=stride[0]; dest += bespitch; } return 0; } static uint32_t vidix_draw_slice_32_fast(uint8_t *image[], int stride[], int w,int h,int x,int y) { uint8_t *src; uint8_t *dest; unsigned bespitch,apitch; int i; apitch = vidix_play.dest.pitch.y-1; bespitch = (w*4 + apitch) & ~apitch; dest = vidix_mem + vidix_play.offsets[next_frame] + vidix_play.offset.y; dest += bespitch*y + x; src = image[0]; memcpy(dest,src,h*bespitch); return 0; } static uint32_t vidix_draw_slice_24(uint8_t *image[], int stride[], int w,int h,int x,int y) { uint8_t *src; uint8_t *dest; unsigned bespitch,apitch; int i; apitch = vidix_play.dest.pitch.y-1; bespitch = (w*3 + apitch) & ~apitch; dest = vidix_mem + vidix_play.offsets[next_frame] + vidix_play.offset.y; dest += bespitch*y + x; src = image[0]; for(i=0;i<h;i++){ memcpy(dest,src,w*3); src+=stride[0]; dest += bespitch; } return 0; } static uint32_t vidix_draw_slice_24_fast(uint8_t *image[], int stride[], int w,int h,int x,int y) { uint8_t *src; uint8_t *dest; unsigned bespitch,apitch; int i; apitch = vidix_play.dest.pitch.y-1; bespitch = (w*3 + apitch) & ~apitch; dest = vidix_mem + vidix_play.offsets[next_frame] + vidix_play.offset.y; dest += bespitch*y + x; src = image[0]; memcpy(dest,src,h*bespitch); return 0; } uint32_t vidix_draw_slice(uint8_t *image[], int stride[], int w,int h,int x,int y) { printf("vosub_vidix: Error unoptimized draw_slice was called\nExiting..."); vidix_term(); exit( EXIT_FAILURE ); return 0; } uint32_t vidix_draw_frame(uint8_t *image[]) { int stride[1]; if(verbose > 1) printf("vosub_vidix: vidix_draw_frame() was called\n"); /* Note it's very strange but sometime for YUY2 draw_frame is called */ if(src_format == IMGFMT_YV12 || src_format == IMGFMT_I420 || src_format == IMGFMT_IYUV) printf("vosub_vidix: draw_frame for YUV420 called, frame cannot be written\n"); else if(src_format == IMGFMT_RGB32 || src_format == IMGFMT_BGR32) stride[0] = vidix_play.src.w*4; else if(src_format == IMGFMT_RGB24 || src_format == IMGFMT_BGR24) stride[0] = vidix_play.src.w*3; else stride[0] = vidix_play.src.w*2; return vo_server->draw_slice(image,stride,vidix_play.src.w,vidix_play.src.h, vidix_play.src.x,vidix_play.src.y); } void vidix_flip_page(void) { if(verbose > 1) printf("vosub_vidix: vidix_flip_page() was called\n"); if(vo_doublebuffering) { vdlPlaybackFrameSelect(vidix_handler,next_frame); next_frame=(next_frame+1)%vidix_play.num_frames; } } static void draw_alpha_null(int x0,int y0, int w,int h, unsigned char* src, unsigned char *srca, int stride) { UNUSED(x0); UNUSED(y0); UNUSED(w); UNUSED(h); UNUSED(src); UNUSED(srca); UNUSED(stride); } static void draw_alpha(int x0,int y0, int w,int h, unsigned char* src, unsigned char *srca, int stride) { uint32_t apitch,bespitch; void *lvo_mem; lvo_mem = vidix_mem + vidix_play.offsets[next_frame] + vidix_play.offset.y; apitch = vidix_play.dest.pitch.y-1; bespitch = (vidix_play.src.w + apitch) & (~apitch); switch(vidix_play.fourcc){ case IMGFMT_YV12: case IMGFMT_IYUV: case IMGFMT_I420: vo_draw_alpha_yv12(w,h,src,srca,stride,lvo_mem+bespitch*y0+x0,bespitch); break; case IMGFMT_YUY2: vo_draw_alpha_yuy2(w,h,src,srca,stride,lvo_mem+2*(bespitch*y0+x0),2*bespitch); break; case IMGFMT_UYVY: vo_draw_alpha_yuy2(w,h,src,srca,stride,lvo_mem+2*(bespitch*y0+x0)+1,2*bespitch); break; case IMGFMT_RGB32: case IMGFMT_BGR32: vo_draw_alpha_rgb32(w,h,src,srca,stride,lvo_mem+4*(y0*bespitch+x0),4*bespitch); break; case IMGFMT_RGB24: case IMGFMT_BGR24: vo_draw_alpha_rgb24(w,h,src,srca,stride,lvo_mem+3*(y0*bespitch+x0),3*bespitch); break; case IMGFMT_RGB16: case IMGFMT_BGR16: vo_draw_alpha_rgb16(w,h,src,srca,stride,lvo_mem+2*(y0*bespitch+x0),2*bespitch); break; case IMGFMT_RGB15: case IMGFMT_BGR15: vo_draw_alpha_rgb15(w,h,src,srca,stride,lvo_mem+2*(y0*bespitch+x0),2*bespitch); break; default: draw_alpha_null(x0,y0,w,h,src,srca,stride); } } void vidix_draw_osd(void) { if(verbose > 1) printf("vosub_vidix: vidix_draw_osd() was called\n"); /* TODO: hw support */ vo_draw_text(vidix_play.src.w,vidix_play.src.h,draw_alpha); } uint32_t vidix_query_fourcc(uint32_t format) { if(verbose > 1) printf("vosub_vidix: query_format was called: %x (%s)\n",format,vo_format_name(format)); vidix_fourcc.fourcc = format; vdlQueryFourcc(vidix_handler,&vidix_fourcc); if (vidix_fourcc.depth == VID_DEPTH_NONE) return(0); return(0x2); /* hw support without conversion */ } int vidix_grkey_support(void) { return(vidix_fourcc.flags & VID_CAP_COLORKEY); } int vidix_grkey_get(vidix_grkey_t *gr_key) { return(vdlGetGrKeys(vidix_handler, gr_key)); } int vidix_grkey_set(const vidix_grkey_t *gr_key) { return(vdlSetGrKeys(vidix_handler, gr_key)); } static int vidix_get_bes_da(bes_da_t *info) { if(!video_on) return EPERM; info->dest.x = vidix_play.src.x; info->dest.y = vidix_play.src.y; info->dest.w = vidix_play.src.w; info->dest.h = vidix_play.src.h; info->dest.pitch.y = vidix_play.dest.pitch.y; info->dest.pitch.u = vidix_play.dest.pitch.u; info->dest.pitch.v = vidix_play.dest.pitch.v; info->flags = vidix_play.flags; info->frame_size = vidix_play.frame_size; info->num_frames = vidix_play.num_frames; memcpy(info->offsets,vidix_play.offsets,sizeof(unsigned)*vidix_play.num_frames); memcpy(&info->offset,&vidix_play.offset,sizeof(vidix_yuv_t)); info->dga_addr = vidix_play.dga_addr; return 0; } static int vidix_get_video_eq(vidix_video_eq_t *info) { if(!video_on) return EPERM; return vdlPlaybackGetEq(vidix_handler, info); } static int vidix_set_video_eq(const vidix_video_eq_t *info) { if(!video_on) return EPERM; return vdlPlaybackSetEq(vidix_handler, info); } static int vidix_get_num_fx(unsigned *info) { if(!video_on) return EPERM; return vdlQueryNumOemEffects(vidix_handler, info); } static int vidix_get_oem_fx(vidix_oem_fx_t *info) { if(!video_on) return EPERM; return vdlGetOemEffect(vidix_handler, info); } static int vidix_set_oem_fx(const vidix_oem_fx_t *info) { if(!video_on) return EPERM; return vdlSetOemEffect(vidix_handler, info); } static int vidix_set_deint(const vidix_deinterlace_t *info) { if(!video_on) return EPERM; return vdlPlaybackSetDeint(vidix_handler, info); } int vidix_init(unsigned src_width,unsigned src_height, unsigned x_org,unsigned y_org,unsigned dst_width, unsigned dst_height,unsigned format,unsigned dest_bpp, unsigned vid_w,unsigned vid_h,const void *info) { size_t i,awidth; int err; if(verbose > 1) printf("vosub_vidix: vidix_init() was called\n" "src_w=%u src_h=%u dest_x_y_w_h = %u %u %u %u\n" "format=%s dest_bpp=%u vid_w=%u vid_h=%u\n" ,src_width,src_height,x_org,y_org,dst_width,dst_height ,vo_format_name(format),dest_bpp,vid_w,vid_h); if(((vidix_cap.maxwidth != -1) && (vid_w > vidix_cap.maxwidth)) || ((vidix_cap.minwidth != -1) && (vid_w < vidix_cap.minwidth)) || ((vidix_cap.maxheight != -1) && (vid_h > vidix_cap.maxheight)) || ((vidix_cap.minwidth != -1 ) && (vid_h < vidix_cap.minheight))) { printf("vosub_vidix: video server has unsupported resolution (%dx%d), supported: %dx%d-%dx%d\n", vid_w, vid_h, vidix_cap.minwidth, vidix_cap.minheight, vidix_cap.maxwidth, vidix_cap.maxheight); return -1; } err = 0; switch(dest_bpp) { case 1: err = ((vidix_fourcc.depth & VID_DEPTH_1BPP) != VID_DEPTH_1BPP); break; case 2: err = ((vidix_fourcc.depth & VID_DEPTH_2BPP) != VID_DEPTH_2BPP); break; case 4: err = ((vidix_fourcc.depth & VID_DEPTH_4BPP) != VID_DEPTH_4BPP); break; case 8: err = ((vidix_fourcc.depth & VID_DEPTH_8BPP) != VID_DEPTH_8BPP); break; case 12:err = ((vidix_fourcc.depth & VID_DEPTH_12BPP) != VID_DEPTH_12BPP); break; case 15:err = ((vidix_fourcc.depth & VID_DEPTH_15BPP) != VID_DEPTH_15BPP); break; case 16:err = ((vidix_fourcc.depth & VID_DEPTH_16BPP) != VID_DEPTH_16BPP); break; case 24:err = ((vidix_fourcc.depth & VID_DEPTH_24BPP) != VID_DEPTH_24BPP); break; case 32:err = ((vidix_fourcc.depth & VID_DEPTH_32BPP) != VID_DEPTH_32BPP); break; default: err=1; break; } if(err) { printf("vosub_vidix: video server has unsupported color depth by vidix (%d)\n" ,vidix_fourcc.depth); return -1; } if((dst_width > src_width || dst_height > src_height) && (vidix_cap.flags & FLAG_UPSCALER) != FLAG_UPSCALER) { printf("vosub_vidix: vidix driver can't upscale image (%d%d -> %d%d)\n", src_width, src_height, dst_width, dst_height); return -1; } if((dst_width > src_width || dst_height > src_height) && (vidix_cap.flags & FLAG_DOWNSCALER) != FLAG_DOWNSCALER) { printf("vosub_vidix: vidix driver can't downscale image (%d%d -> %d%d)\n", src_width, src_height, dst_width, dst_height); return -1; } image_width = src_width; image_height = src_height; src_format = format; memset(&vidix_play,0,sizeof(vidix_playback_t)); vidix_play.fourcc = format; vidix_play.capability = vidix_cap.flags; /* every ;) */ vidix_play.blend_factor = 0; /* for now */ /* display the full picture. Nick: we could implement here zooming to a specified area -- alex */ vidix_play.src.x = vidix_play.src.y = 0; vidix_play.src.w = src_width; vidix_play.src.h = src_height; vidix_play.dest.x = x_org; vidix_play.dest.y = y_org; vidix_play.dest.w = dst_width; vidix_play.dest.h = dst_height; vidix_play.num_frames=vo_doublebuffering?NUM_FRAMES:1; vidix_play.src.pitch.y = vidix_play.src.pitch.u = vidix_play.src.pitch.v = 0; if(info) { switch(((const vo_tune_info_t *)info)->pitch[0]) { case 2: case 4: case 8: case 16: case 32: case 64: case 128: case 256: vidix_play.src.pitch.y = ((const vo_tune_info_t *)info)->pitch[0]; break; default: break; } switch(((const vo_tune_info_t *)info)->pitch[1]) { case 2: case 4: case 8: case 16: case 32: case 64: case 128: case 256: vidix_play.src.pitch.u = ((const vo_tune_info_t *)info)->pitch[1]; break; default: break; } switch(((const vo_tune_info_t *)info)->pitch[2]) { case 2: case 4: case 8: case 16: case 32: case 64: case 128: case 256: vidix_play.src.pitch.v = ((const vo_tune_info_t *)info)->pitch[2]; break; default: break; } } if((err=vdlConfigPlayback(vidix_handler,&vidix_play))!=0) { printf("vosub_vidix: Can't configure playback: %s\n",strerror(err)); return -1; } vidix_mem = vidix_play.dga_addr; /* select first frame */ next_frame = 0; // vdlPlaybackFrameSelect(vidix_handler,next_frame); /* clear every frame with correct address and frame_size */ for (i = 0; i < vidix_play.num_frames; i++) memset(vidix_mem + vidix_play.offsets[i], 0x80, vidix_play.frame_size); /* tune some info here */ if(src_format == IMGFMT_YV12 || src_format == IMGFMT_I420 || src_format == IMGFMT_IYUV) vo_server->draw_slice = vidix_draw_slice_420; else if(src_format == IMGFMT_RGB32 || src_format == IMGFMT_BGR32) vo_server->draw_slice = vidix_play.src.pitch.y == vidix_play.dest.pitch.y ? vidix_draw_slice_32_fast: vidix_draw_slice_32; else if(src_format == IMGFMT_RGB24 || src_format == IMGFMT_BGR24) vo_server->draw_slice = vidix_play.src.pitch.y == vidix_play.dest.pitch.y ? vidix_draw_slice_24_fast: vidix_draw_slice_24; else vo_server->draw_slice = vidix_play.src.pitch.y == vidix_play.dest.pitch.y ? vidix_draw_slice_422_fast: vidix_draw_slice_422; return 0; } uint32_t vidix_control(uint32_t request, void *data, ...) { switch (request) { case VOCTRL_QUERY_VAA: vidix_query_vaa((vo_vaa_t*)data); return VO_TRUE; case VOCTRL_QUERY_FORMAT: return vidix_query_fourcc(*((uint32_t*)data)); } return VO_NOTIMPL; } int vidix_preinit(const char *drvname,void *server) { int err; if(verbose > 1) printf("vosub_vidix: vidix_preinit(%s) was called\n",drvname); if(vdlGetVersion() != VIDIX_VERSION) { printf("vosub_vidix: You have wrong version of VIDIX library\n"); return -1; } vidix_handler = vdlOpen(LIBDIR"/vidix/", drvname ? drvname[0] == ':' ? &drvname[1] : drvname[0] ? drvname : NULL : NULL, TYPE_OUTPUT, verbose); if(vidix_handler == NULL) { printf("vosub_vidix: Couldn't find working VIDIX driver\n"); return -1; } if((err=vdlGetCapability(vidix_handler,&vidix_cap)) != 0) { printf("vosub_vidix: Couldn't get capability: %s\n",strerror(err)); return -1; } printf("vosub_vidix: Using: %s by %s\n",vidix_cap.name,vidix_cap.author); /* we are able to tune up this stuff depend on fourcc format */ ((vo_functions_t *)server)->draw_slice=vidix_draw_slice; ((vo_functions_t *)server)->draw_frame=vidix_draw_frame; ((vo_functions_t *)server)->flip_page=vidix_flip_page; ((vo_functions_t *)server)->draw_osd=vidix_draw_osd; ((vo_functions_t *)server)->control=vidix_control; vo_server = server; return 0; }