/* * vo_zr.c - playback on zoran cards * Copyright (C) Rik Snel 2001,2002, License GNU GPL v2 */ /* $Id$ */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include "videodev_mjpeg.h" #include "config.h" #include "video_out.h" #include "video_out_internal.h" #include "../mp_msg.h" #include "../cfgparser.h" #include "fastmemcpy.h" #include "jpeg_enc.h" LIBVO_EXTERN (zr) static vo_info_t vo_info = { "Zoran ZR360[56]7/ZR36060 Driver (DC10(+)/buz/lml33/MatroxRR)", "zr", "Rik Snel ", "" }; /* General variables */ static int image_width; static int image_height; static int off_y, off_c, stride; /* for use by 'draw slice/frame' */ static int framenum; static int fields = 1; /* currently no interlacing */ static int zrfd = 0; static int bw = 0; /* if bw == 1, then display in black&white */ static int vdec = 1; static int hdec = 1; static int size; static int quality = 2; static unsigned char *y_data, *u_data, *v_data; static int y_stride, u_stride, v_stride; typedef struct { int width; int height; int xoff; int yoff; int set; } geo; geo g = {0, 0, 0, 0, 0}; static uint8_t *image=NULL; static uint8_t *buf=NULL; static jpeg_enc_t *j; /* Variables needed for Zoran */ int vdes; /* the file descriptor of the video device */ int frame = 0, synco = 0, queue = 0; /* buffer management */ struct mjpeg_params zp; struct mjpeg_requestbuffers zrq; struct mjpeg_sync zs; struct video_capability vc; #define MJPEG_NBUFFERS 2 #define MJPEG_SIZE 1024*256 //should be command line options int norm = VIDEO_MODE_AUTO; #if 0 #ifndef VO_ZR_DEFAULT_DEVICE #define VO_ZR_DEFAULT_DEVICE "/dev/video" #endif #endif char *device = NULL; int zoran_getcap() { char* dev; if (device) dev = device; else { /* code borrowed from mjpegtools lavplay.c // 20020416 too */ struct stat vstat; #undef VIDEV #define VIDEV "/dev/video" if (stat(VIDEV, &vstat) == 0 && S_ISCHR(vstat.st_mode)) dev = VIDEV; #undef VIDEV #define VIDEV "/dev/video0" else if (stat(VIDEV, &vstat) == 0 && S_ISCHR(vstat.st_mode)) dev = VIDEV; #undef VIDEV #define VIDEV "/dev/v4l/video0" else if (stat(VIDEV, &vstat) == 0 && S_ISCHR(vstat.st_mode)) dev = VIDEV; #undef VIDEV #define VIDEV "/dev/v4l0" else if (stat(VIDEV, &vstat) == 0 && S_ISCHR(vstat.st_mode)) dev = VIDEV; #undef VIDEV #define VIDEV "/dev/v4l" else if (stat(VIDEV, &vstat) == 0 && S_ISCHR(vstat.st_mode)) dev = VIDEV; #undef VIDEV else { mp_msg(MSGT_VO, MSGL_ERR, "zr: unable to find video device\n"); return 1; } mp_msg(MSGT_VO, MSGL_V, "zr: found video device %s\n", dev); } vdes = open(dev, O_RDWR); if (vdes < 0) { mp_msg(MSGT_VO, MSGL_ERR, "zr: error opening %s: %s\n", dev, strerror(errno)); return 1; } /* before we can ask for the maximum resolution, we must set * the correct tv norm */ if (ioctl(vdes, MJPIOC_G_PARAMS, &zp) < 0) { mp_msg(MSGT_VO, MSGL_ERR, "zr: device at %s is probably not a DC10(+)/buz/lml33\n", dev); return 1; } if (zp.norm != norm && norm != VIDEO_MODE_AUTO) { /* attempt to set requested norm */ zp.norm = norm; if (ioctl(vdes, MJPIOC_S_PARAMS, &zp) < 0) { mp_msg(MSGT_VO, MSGL_ERR, "zr: unable to change video norm, use another program to change it (XawTV)\n"); return 1; } ioctl(vdes, MJPIOC_G_PARAMS, &zp); if (norm != zp.norm) { mp_msg(MSGT_VO, MSGL_ERR, "zr: unable to change video norm, use another program to change it (XawTV)\n"); return 1; } } if (ioctl(vdes, VIDIOCGCAP, &vc) < 0) { mp_msg(MSGT_VO, MSGL_ERR, "zr: error getting video capabilities from %s\n"); return 1; } mp_msg(MSGT_VO, MSGL_V, "zr: MJPEG card reports maxwidth=%d, maxheight=%d\n", vc.maxwidth, vc.maxheight); return 0; } int init_zoran(int zrhdec, int zrvdec) { /* center the image, and stretch it as far as possible (try to keep * aspect) and check if it fits */ if (image_width > vc.maxwidth) { mp_msg(MSGT_VO, MSGL_ERR, "zr: movie to be played is too wide, max width currenty %d\n", vc.maxwidth); return 1; } if (image_height > vc.maxheight) { mp_msg(MSGT_VO, MSGL_ERR, "zr: movie to be played is too high, max height currenty %d\n", vc.maxheight); return 1; } zp.decimation = 0; zp.HorDcm = zrhdec; zp.VerDcm = zrvdec; zp.TmpDcm = 1; zp.field_per_buff = fields; zp.img_x = (vc.maxwidth - zp.HorDcm*(int)image_width/hdec)/2; zp.img_y = (vc.maxheight - zp.VerDcm*(3-fields)*(int)image_height)/4; zp.img_width = zp.HorDcm*image_width/hdec; zp.img_height = zp.VerDcm*image_height/fields; mp_msg(MSGT_VO, MSGL_V, "zr: geometry (after 'scaling'): %dx%d+%d+%d fields=%d, w=%d, h=%d\n", zp.img_width, (3-fields)*zp.img_height, zp.img_x, zp.img_y, fields, image_width/hdec, image_height); if (ioctl(vdes, MJPIOC_S_PARAMS, &zp) < 0) { mp_msg(MSGT_VO, MSGL_ERR, "zr: error setting display parameters\n"); return 1; } zrq.count = MJPEG_NBUFFERS; zrq.size = MJPEG_SIZE; if (ioctl(vdes, MJPIOC_REQBUFS, &zrq)) { mp_msg(MSGT_VO, MSGL_ERR, "zr: error requesting %d buffers of size %d\n", zrq.count, zrq.size); return 1; } buf = (char*)mmap(0, zrq.count*zrq.size, PROT_READ|PROT_WRITE, MAP_SHARED, vdes, 0); if (buf == MAP_FAILED) { mp_msg(MSGT_VO, MSGL_ERR, "zr: error requesting %d buffers of size %d\n", zrq.count, zrq.size); return 1; } return 0; } void uninit_zoran(void) { if (image) { free(image); image=NULL; } while (queue > synco + 1) { if (ioctl(vdes, MJPIOC_SYNC, &zs) < 0) mp_msg(MSGT_VO, MSGL_ERR, "zr: error waiting for buffers to become free\n"); synco++; } /* stop streaming */ frame = -1; if (ioctl(vdes, MJPIOC_QBUF_PLAY, &frame) < 0) mp_msg(MSGT_VO, MSGL_ERR, "zr: error stopping playback of last frame\n"); close(vdes); } static uint32_t config(uint32_t width, uint32_t height, uint32_t d_width, uint32_t d_height, uint32_t fullscreen, char *title, uint32_t format,const vo_tune_info_t *info) { int i, stretchx, stretchy; /* this allows to crop parts from incoming picture, * for easy 512x240 -> 352x240 */ /* These values must be multples of 2 */ if (format != IMGFMT_YV12 && format != IMGFMT_YUY2) { printf("vo_zr called with wrong format"); exit(1); } stride = 2*width; if (g.set) { if (g.width%2 != 0 || g.height%2 != 0 || g.xoff%2 != 0 || g.yoff%2 != 0) { mp_msg(MSGT_VO, MSGL_ERR, "zr: arguments in -zrcrop must be multiples of 2\n"); return 1; } if (g.width <= 0 || g.height <= 0 || g.xoff < 0 || g.yoff < 0) { mp_msg(MSGT_VO, MSGL_ERR, "zr: width and height must be positive and offset nonnegative\n"); return 1; } if (g.width + g.xoff > width) { mp_msg(MSGT_VO, MSGL_ERR, "zr: width+xoffset (%d+%d>%d) is too big\n", g.width, g.xoff, width); return 1; } if (g.height + g.yoff > height) { mp_msg(MSGT_VO, MSGL_ERR, "zr: height+yoffset (%d+%d>%d) is too big\n", g.height, g.yoff, height); return 1; } } else { g.width = width; g.height = height; g.xoff = 0; g.yoff = 0; g.set = 1; } /* we must know the maximum resolution of the device * it differs for DC10+ and buz for example */ zoran_getcap(); /*must be called before init_zoran */ /* make the scaling decision * we are capable of stretching the image in the horizontal * direction by factors 1, 2 and 4 * we can stretch the image in the vertical direction by a factor * of 1 and 2 AND we must decide about interlacing */ if (g.width > vc.maxwidth/2 || g.height > vc.maxheight/2) { stretchx = 1; stretchy = 1; fields = 2; if (vdec == 2) { fields = 1; } else if (vdec == 4) { fields = 1; stretchy = 2; } stretchx = hdec; } else if (g.width > vc.maxwidth/4 || g.height > vc.maxheight/4) { stretchx = 2; stretchy = 1; fields = 1; if (vdec == 2) { stretchy = 2; } else if (vdec == 4) { if (!zrfd) { mp_msg(MSGT_VO, MSGL_WARN, "zr: vertical decimation too high, changing to 2 (use -zrfd to keep vdec=4)\n"); vdec = 2; } stretchy = 2; } if (hdec == 2) { stretchx = 4; } else if (hdec == 4){ if (!zrfd) { mp_msg(MSGT_VO, MSGL_WARN, "zr: horizontal decimation too high, changing to 2 (use -zrfd to keep hdec=4)\n"); hdec = 2; } stretchx = 4; } } else { /* output image is maximally stretched */ stretchx = 4; stretchy = 2; fields = 1; if (vdec != 1 && !zrfd) { mp_msg(MSGT_VO, MSGL_WARN, "zr: vertical decimation too high, changing to 1 (use -zrfd to keep vdec=%d)\n", vdec); vdec = 1; } if (hdec != 1 && !zrfd) { mp_msg(MSGT_VO, MSGL_WARN, "zr: vertical decimation too high, changing to 1 (use -zrfd to keep hdec=%d)\n", hdec); hdec = 1; } } /* It can be that the original frame was too big for display, * or that the width of the decimated image (for example) after * padding up to a multiple of 16 has become too big. (orig * width 720 (exactly right for the Buz) after decimation 360, * after padding up to a multiple of 16 368, display 736 -> too * large). In these situations we auto(re)crop. */ i = 16*((g.width - 1)/(hdec*16) + 1); if (stretchx*i > vc.maxwidth) { g.xoff += 2*((g.width - hdec*(i-16))/4); /* g.off must be a multiple of 2 */ g.width = hdec*(i - 16); g.set = 0; /* we abuse this field to report that g has changed*/ } i = 8*fields*((g.height - 1)/(vdec*fields*8) + 1); if (stretchy*i > vc.maxheight) { g.yoff += 2*((g.height - vdec*(i - 8*fields))/4); g.height = vdec*(i - 8*fields); g.set = 0; } if (!g.set) mp_msg(MSGT_VO, MSGL_V, "zr: auto(re)cropping %dx%d+%d+%d to make the image fit on the screen\n", g.width, g.height, g.xoff, g.yoff); /* the height must be a multiple of fields*8 and the width * must be a multiple of 16 */ /* add some black borders to make it so, and center the image*/ image_height = fields*8*((g.height/vdec - 1)/(fields*8) + 1); image_width = (hdec*16)*((g.width - 1)/(hdec*16) + 1); off_y = (image_height - g.height/vdec)/2; if (off_y%2 != 0) off_y++; off_y *= image_width; off_c = off_y/4; off_y += (image_width - g.width)/2; if (off_y%2 != 0) off_y--; off_c += (image_width - g.width)/4; framenum = 0; size = image_width*image_height; mp_msg(MSGT_VO, MSGL_V, "zr: input: %dx%d, cropped: %dx%d, output: %dx%d, off_y=%d, off_c=%d\n", width, height, g.width, g.height, image_width, image_height, off_y, off_c); image = malloc(2*size); /* this buffer allows for YUV422 data, * so it is a bit too big for YUV420 */ if (!image) { mp_msg(MSGT_VO, MSGL_ERR, "zr: Memory exhausted\n"); return 1; } /* and make sure that the borders are _really_ black */ switch (format) { case IMGFMT_YV12: memset(image, 0, image_width*image_height); memset(image + size, 0x80, image_width*image_height/4); memset(image + 3*size/2, 0x80, image_width*image_height/4); y_data = image; u_data = image + image_width*image_height; v_data = image + 3*image_width*image_height/2; y_stride = image_width; u_stride = image_width/2; v_stride = image_width/2; j = jpeg_enc_init(image_width/hdec, image_height/fields, hdec, y_stride*fields, hdec, u_stride*fields, hdec, v_stride*fields, 1, quality, bw); break; case IMGFMT_YUY2: for (i = 0; i < 2*size; i+=4) { image[i] = 0; image[i+1] = 0x80; image[i+2] = 0; image[i+3] = 0x80; } y_data = image; u_data = image + 1; v_data = image + 3; y_stride = 2*image_width; u_stride = 2*image_width; v_stride = 2*image_width; j = jpeg_enc_init(image_width/hdec, image_height/fields, hdec*2, y_stride*fields, hdec*4, u_stride*fields, hdec*4, v_stride*fields, 0, quality, bw); break; default: mp_msg(MSGT_VO, MSGL_FATAL, "zr: internal inconsistency in vo_zr\n"); } if (j == NULL) { mp_msg(MSGT_VO, MSGL_ERR, "zr: error initializing the jpeg encoder\n"); return 1; } if (init_zoran(stretchx, stretchy)) { return 1; } return 0; } static const vo_info_t* get_info(void) { return &vo_info; } static void draw_osd(void) { } static void flip_page (void) { int i, k; //FILE *fp; //char filename[100]; /* do we have a free buffer? */ if (queue-synco < zrq.count) { frame = queue; } else { if (ioctl(vdes, MJPIOC_SYNC, &zs) < 0) mp_msg(MSGT_VO, MSGL_ERR, "zr: error waiting for buffers to become free\n"); frame = zs.frame; synco++; } k=0; for (i = 0; i < fields; i++) k+=jpeg_enc_frame(j, y_data + i*y_stride, u_data + i*u_stride, v_data + i*v_stride, buf+frame*zrq.size+k); /* Warning: Only the first jpeg image contains huffman- and * quantisation tables, so don't expect files other than * test0001.jpg to be readable */ /*sprintf(filename, "test%04d.jpg", framenum); fp = fopen(filename, "w"); if (!fp) exit(1); fwrite(buf+frame*zrq.size, 1, k, fp); fclose(fp);*/ /*fp = fopen("test1.jpg", "r"); fread(buf+frame*zrq.size, 1, 2126, fp); fclose(fp);*/ if (ioctl(vdes, MJPIOC_QBUF_PLAY, &frame) < 0) mp_msg(MSGT_VO, MSGL_ERR, "zr: error queueing buffer for playback\n"); queue++; framenum++; return; } static uint32_t draw_frame(uint8_t * src[]) { int i; char *source, *dest; //printf("draw frame called\n"); source = src[0] + 2*g.yoff*vdec*stride + 2*g.xoff; dest = image + 2*off_y; for (i = 0; i < g.height/vdec; i++) { memcpy(dest, source, image_width*2); dest += 2*image_width; source += vdec*stride; } return 0; } static uint32_t query_format(uint32_t format) { if(format==IMGFMT_YV12) return 1; if(format==IMGFMT_YUY2) return 1; return 0; } static void uninit(void) { jpeg_enc_uninit(j); uninit_zoran(); } static void check_events(void) { } static uint32_t draw_slice(uint8_t *srcimg[], int stride[], int w, int h, int x, int y) { int i; /* Apply 'geometry', crop unwanted parts */ uint8_t *dst; uint8_t *src; //printf("before: w=%d, h=%d, x=%d, y=%d, src0=%p, src1=%p, src2=%p\n", w, h, x, y, srcimg[0], srcimg[1], srcimg[2]); if (x < g.xoff) { srcimg[0] += g.xoff - x; srcimg[1] += (g.xoff - x)/2; srcimg[2] += (g.xoff - x)/2; w -= g.xoff - x; if (w < 0) return 0; x = 0 /*g.xoff*/; } else { x -= g.xoff; } if (x + w > g.width) { w = g.width - x; if (w < 0) return 0; } if (y < g.yoff) { srcimg[0] += (g.yoff - y)*stride[0]; srcimg[1] += ((g.yoff - y)/2)*stride[1]; srcimg[2] += ((g.yoff - y)/2)*stride[2]; h -= g.yoff - y; if (h < 0) return 0; y = 0; } else { y -= g.yoff; } if (y + h > g.height) { h = g.height - y; if (h < 0) return 0; } //printf("after: w=%d, h=%d, x=%d, y=%d, src0=%p, src1=%p, src2=%p\n", w, h, x, y, srcimg[0], srcimg[1], srcimg[2]); dst=image + off_y + image_width*(y/vdec)+x; src=srcimg[0]; // copy Y: for (i = 0; i < h; i++) { if ((i + x)%vdec == 0) { memcpy(dst,src,w); dst+=image_width; } src+=stride[0]; } if (!bw) { // copy U+V: uint8_t *src1=srcimg[1]; uint8_t *src2=srcimg[2]; uint8_t *dst1=image + size + off_c+ (y/(vdec*2))*image_width/2+(x/2); uint8_t *dst2=image + 3*size/2 + off_c + (y/(vdec*2))*image_width/2+(x/2); for (i = 0; i< h/2; i++) { if ((i+x/2)%vdec == 0) { memcpy(dst1,src1,w/2); memcpy(dst2,src2,w/2); dst1+=image_width/2; dst2+=image_width/2; } src1+=stride[1]; src2+=stride[2]; } } return 0; } /* copied and adapted from vo_aa_parseoption */ int vo_zr_parseoption(struct config * conf, char *opt, char *param){ /* got an option starting with zr */ char *x, *help; int i; /* do WE need it ?, always */ if (!strcasecmp(opt, "zrdev")) { if (param == NULL) return ERR_MISSING_PARAM; //if ((i=getcolor(param))==-1) return ERR_OUT_OF_RANGE; //aaopt_osdcolor=i; device = malloc(strlen(param)+1); strcpy(device, param); mp_msg(MSGT_VO, MSGL_V, "zr: using device %s\n", device); return 1; } else if (!strcasecmp(opt, "zrbw")) { if (param != NULL) { return ERR_OUT_OF_RANGE; } bw = 1; return 1; } else if (!strcasecmp(opt, "zrfd")) { if (param != NULL) { return ERR_OUT_OF_RANGE; } zrfd = 1; return 1; } else if (!strcasecmp(opt, "zrcrop")){ if (param == NULL) return ERR_MISSING_PARAM; if (sscanf(param, "%dx%d+%d+%d", &g.width, &g.height, &g.xoff, &g.yoff) != 4) { g.xoff = 0; g.yoff = 0; if (sscanf(param, "%dx%d", &g.width, &g.height) != 2) { mp_msg(MSGT_VO, MSGL_ERR, "zr: argument to -zrcrop must be of the form 352x288+16+0\n"); return ERR_OUT_OF_RANGE; } } g.set = 1; mp_msg(MSGT_VO, MSGL_V, "zr: cropping %s\n", param); return 1; }else if (!strcasecmp(opt, "zrhdec")) { i = atoi(param); if (i != 1 && i != 2 && i != 4) return ERR_OUT_OF_RANGE; hdec = i; return 1; }else if (!strcasecmp(opt, "zrvdec")) { i = atoi(param); if (i != 1 && i != 2 && i != 4) return ERR_OUT_OF_RANGE; vdec = i; return 1; }else if (!strcasecmp(opt, "zrquality")) { i = atoi(param); if (i < 1 || i > 20) return ERR_OUT_OF_RANGE; quality = i; return 1; }else if (!strcasecmp(opt, "zrnorm")) { if (param == NULL) return ERR_MISSING_PARAM; if (!strcasecmp(param, "NTSC")) { mp_msg(MSGT_VO, MSGL_V, "zr: Norm set to NTSC\n"); norm = VIDEO_MODE_NTSC; return 1; } else if (!strcasecmp(param, "PAL")) { mp_msg(MSGT_VO, MSGL_V, "zr: Norm set to PAL\n"); norm = VIDEO_MODE_PAL; return 1; } else { return ERR_OUT_OF_RANGE; } }else if (!strcasecmp(opt, "zrhelp")){ printf("Help for -vo zr: Zoran ZR360[56]7/ZR36060 based MJPEG capture/playback cards\n"); printf("\n"); printf("Here are the zr options:\n"); printf( "\n" " -zrcrop specify part of the input image that\n" " you want to see as an x-style geometry string\n" " example: -zrcrop 352x288+16+0\n" " -zrvdec vertical decimation 1, 2 or 4\n" " -zrhdec horizontal decimation 1, 2 or 4\n" " -zrfd decimation is only done if the primitive\n" " hardware upscaler can correct for the decimation,\n" " this switch allows you to see the effects\n" " of too much decimation\n" " -zrbw display in black&white (speed increase)\n" " -zrquality jpeg compression quality [BEST] 1 - 20 [VERY BAD]\n" " -zrdev playback device (example -zrdev /dev/video1\n" " -zrnorm specify norm PAL/NTSC [dev: leave at current setting]\n" "\n" ); exit(0); } return ERR_NOT_AN_OPTION; } void vo_zr_revertoption(config_t* opt,char* param) { if (!strcasecmp(param, "zrdev")) { if(device) free(device); device=NULL; } else if (!strcasecmp(param, "zrbw")) bw=0; else if (!strcasecmp(param, "zrfd")) zrfd=0; else if (!strcasecmp(param, "zrcrop")) g.set = g.xoff = g.yoff = 0; else if (!strcasecmp(param, "zrhdec")) hdec = 1; else if (!strcasecmp(param, "zrvdec")) vdec = 1; else if (!strcasecmp(param, "zrquality")) quality = 2; else if (!strcasecmp(param, "zrnorm")) norm = VIDEO_MODE_AUTO; } static uint32_t preinit(const char *arg) { if(arg) { printf("vo_zr: Unknown subdevice: %s\n",arg); return ENOSYS; } return 0; } static uint32_t control(uint32_t request, void *data, ...) { switch (request) { case VOCTRL_QUERY_FORMAT: return query_format(*((uint32_t*)data)); } return VO_NOTIMPL; }