libvo/vo_dxr3.c

   1 /*
   2  * DXR3/H+ video output
   3  *
   4  * Copyright (C) 2002-2003 David Holm <david@realityrift.com>
   5  *
   6  * This file is part of MPlayer.
   7  *
   8  * MPlayer is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License as published by
  10  * the Free Software Foundation; either version 2 of the License, or
  11  * (at your option) any later version.
  12  *
  13  * MPlayer is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License along
  19  * with MPlayer; if not, write to the Free Software Foundation, Inc.,
  20  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  21  */
  22
  23 #include <linux/em8300.h>
  24 #include <sys/ioctl.h>
  25 #include <sys/stat.h>
  26 #include <sys/types.h>
  27 #include <sys/select.h>
  28 #include <unistd.h>
  29 #include <stdio.h>
  30 #include <stdlib.h>
  31 #include <string.h>
  32 #include <fcntl.h>
  33 #include <stdio.h>
  34 #include <time.h>
  35 #include <math.h>
  36
  37 #include "config.h"
  38 #include "mp_msg.h"
  39 #include "fastmemcpy.h"
  40
  41 #include "video_out.h"
  42 #include "video_out_internal.h"
  43 #include "aspect.h"
  44 #include "spuenc.h"
  45 #include "sub/sub.h"
  46 #ifdef CONFIG_X11
  47 #include "x11_common.h"
  48 #endif
  49 #include "libavutil/avstring.h"
  50
  51 #define SPU_SUPPORT
  52
  53 static const vo_info_t info =
  54 {
  55         "DXR3/H+ video out",
  56         "dxr3",
  57         "David Holm <dholm@iname.com>",
  58         ""
  59 };
  60 const LIBVO_EXTERN (dxr3)
  61
  62 /* Resolutions and positions */
  63 static int v_width, v_height;
  64 static int s_width, s_height;
  65 static int osd_w, osd_h;
  66 static int img_format;
  67
  68 /* Configuration values
  69  * Don't declare these static, they
  70  * should be accessible from the gui.
  71  */
  72 int dxr3_prebuf = 0;
  73 int dxr3_newsync = 0;
  74 int dxr3_overlay = 0;
  75 int dxr3_device_num = 0;
  76 int dxr3_norm = 0;
  77
  78 #define MAX_STR_SIZE 80 /* length for the static strings  */
  79
  80 /* File descriptors */
  81 static int fd_control = -1;
  82 static int fd_video = -1;
  83 static int fd_spu = -1;
  84 static char fdv_name[MAX_STR_SIZE];
  85 static char fds_name[MAX_STR_SIZE];
  86
  87 #ifdef SPU_SUPPORT
  88 /* on screen display/subpics */
  89 static char *osdpicbuf;
  90 static int osdpicbuf_w;
  91 static int osdpicbuf_h;
  92 static int disposd;
  93 static encodedata *spued;
  94 static encodedata *spubuf;
  95 #endif
  96
  97
  98 /* Static variable used in ioctl's */
  99 static int ioval;
 100 static int prev_pts;
 101 static int pts_offset;
 102 static int old_vmode = -1;
 103
 104
 105 /* Begin overlay.h */
 106 /*
 107   Simple analog overlay API for DXR3/H+ linux driver.
 108
 109   Henrik Johansson
 110 */
 111
 112
 113 /* Pattern drawing callback used by the calibration functions.
 114    The function is expected to:
 115      Clear the entire screen.
 116      Fill the screen with color bgcol (0xRRGGBB)
 117      Draw a rectangle at (xpos,ypos) of size (width,height) in fgcol (0xRRGGBB)
 118 */
 119
 120 typedef int (*pattern_drawer_cb)(int fgcol, int bgcol,
 121                              int xpos, int ypos, int width, int height, void *arg);
 122
 123 struct coeff {
 124     float k,m;
 125 };
 126
 127 typedef struct {
 128     int dev;
 129
 130     int xres, yres,depth;
 131     int xoffset,yoffset,xcorr;
 132     int jitter;
 133     int stability;
 134     int keycolor;
 135     struct coeff colcal_upper[3];
 136     struct coeff colcal_lower[3];
 137     float color_interval;
 138
 139     pattern_drawer_cb draw_pattern;
 140     void *dp_arg;
 141 } overlay_t;
 142
 143
 144 static overlay_t *overlay_init(int dev);
 145 static int overlay_release(overlay_t *);
 146
 147 static int overlay_read_state(overlay_t *o, char *path);
 148 static int overlay_write_state(overlay_t *o, char *path);
 149
 150 static int overlay_set_screen(overlay_t *o, int xres, int yres, int depth);
 151 static int overlay_set_mode(overlay_t *o, int mode);
 152 static int overlay_set_attribute(overlay_t *o, int attribute, int val);
 153 static int overlay_set_keycolor(overlay_t *o, int color);
 154 static int overlay_set_window(overlay_t *o, int xpos,int ypos,int width,int height);
 155 static int overlay_set_bcs(overlay_t *o, int brightness, int contrast, int saturation);
 156
 157 static int overlay_autocalibrate(overlay_t *o, pattern_drawer_cb pd, void *arg);
 158 static void overlay_update_params(overlay_t *o);
 159 static int overlay_signalmode(overlay_t *o, int mode);
 160 /* End overlay.h */
 161
 162
 163 #ifdef CONFIG_X11
 164 #define KEY_COLOR 0x80a040
 165 static XWindowAttributes xwin_attribs;
 166 static overlay_t *overlay_data;
 167 #endif
 168
 169
 170 /* Functions for working with the em8300's internal clock */
 171 /* End of internal clock functions */
 172
 173 static int control(uint32_t request, void *data)
 174 {
 175         switch (request) {
 176         case VOCTRL_SET_SPU_PALETTE:
 177                 if (ioctl(fd_spu, EM8300_IOCTL_SPU_SETPALETTE, data) < 0) {
 178                         mp_tmsg(MSGT_VO,MSGL_ERR, "[VO_DXR3] Unable to load new SPU palette!\n");
 179                         return VO_ERROR;
 180                 }
 181                 return VO_TRUE;
 182 #ifdef CONFIG_X11
 183         case VOCTRL_ONTOP:
 184                 vo_x11_ontop();
 185                 return VO_TRUE;
 186         case VOCTRL_FULLSCREEN:
 187                 if (dxr3_overlay) {
 188                         vo_x11_fullscreen();
 189                         overlay_signalmode(overlay_data,
 190                           vo_fs ? EM8300_OVERLAY_SIGNAL_ONLY :
 191                             EM8300_OVERLAY_SIGNAL_WITH_VGA);
 192                         return VO_TRUE;
 193                 }
 194                 return VO_FALSE;
 195 #endif
 196         case VOCTRL_RESUME:
 197                 if (dxr3_newsync) {
 198                         ioctl(fd_control, EM8300_IOCTL_SCR_GET, &ioval);
 199                         pts_offset = vo_pts - (ioval << 1);
 200                         if (pts_offset < 0) {
 201                                 pts_offset = 0;
 202                         }
 203                 }
 204
 205                 if (dxr3_prebuf) {
 206                         ioval = EM8300_PLAYMODE_PLAY;
 207                         if (ioctl(fd_control, EM8300_IOCTL_SET_PLAYMODE, &ioval) < 0) {
 208                                 mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Unable to set playmode!\n");
 209                         }
 210                 }
 211                 return VO_TRUE;
 212         case VOCTRL_PAUSE:
 213                 if (dxr3_prebuf) {
 214                         ioval = EM8300_PLAYMODE_PAUSED;
 215                         if (ioctl(fd_control, EM8300_IOCTL_SET_PLAYMODE, &ioval) < 0) {
 216                                 mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Unable to set playmode!\n");
 217                         }
 218                 }
 219                 return VO_TRUE;
 220         case VOCTRL_RESET:
 221                 if (dxr3_prebuf) {
 222                         close(fd_video);
 223                         fd_video = open(fdv_name, O_WRONLY);
 224                         close(fd_spu);
 225                         fd_spu = open(fds_name, O_WRONLY);
 226                         fsync(fd_video);
 227                         fsync(fd_spu);
 228                 }
 229                 return VO_TRUE;
 230         case VOCTRL_QUERY_FORMAT:
 231             {
 232                 uint32_t flag = 0;
 233
 234                 if (*((uint32_t*)data) != IMGFMT_MPEGPES)
 235                     return 0;
 236
 237                 flag = VFCAP_CSP_SUPPORTED | VFCAP_CSP_SUPPORTED_BY_HW | VFCAP_SPU;
 238                 if (dxr3_prebuf)
 239                     flag |= VFCAP_TIMER;
 240                 return flag;
 241             }
 242         case VOCTRL_SET_EQUALIZER:
 243             {
 244                 em8300_bcs_t bcs;
 245                 struct voctrl_set_equalizer_args *args = data;
 246
 247                 if (ioctl(fd_control, EM8300_IOCTL_GETBCS, &bcs) < 0)
 248                     return VO_FALSE;
 249                 if (!strcasecmp(args->name, "brightness"))
 250                     bcs.brightness = (args->value+100)*5;
 251                 else if (!strcasecmp(args->name, "contrast"))
 252                     bcs.contrast = (args->value+100)*5;
 253                 else if (!strcasecmp(args->name, "saturation"))
 254                     bcs.saturation = (args->value+100)*5;
 255                 else return VO_FALSE;
 256
 257                 if (ioctl(fd_control, EM8300_IOCTL_SETBCS, &bcs) < 0)
 258                     return VO_FALSE;
 259                 return VO_TRUE;
 260             }
 261         case VOCTRL_GET_EQUALIZER:
 262             {
 263                 em8300_bcs_t bcs;
 264                 struct voctrl_get_equalizer_args *args = data;
 265
 266                 if (ioctl(fd_control, EM8300_IOCTL_GETBCS, &bcs) < 0)
 267                     return VO_FALSE;
 268
 269                 if (!strcasecmp(args->name, "brightness"))
 270                     *args->valueptr = (bcs.brightness/5)-100;
 271                 else if (!strcasecmp(args->name, "contrast"))
 272                     *args->valueptr = (bcs.contrast/5)-100;
 273                 else if (!strcasecmp(args->name, "saturation"))
 274                     *args->valueptr = (bcs.saturation/5)-100;
 275                 else return VO_FALSE;
 276
 277                 return VO_TRUE;
 278             }
 279         }
 280         return VO_NOTIMPL;
 281 }
 282
 283 void calculate_cvals(unsigned long mask, int *shift, int *prec)
 284 {
 285         /* Calculate shift and precision */
 286         (*shift) = 0;
 287         (*prec) = 0;
 288
 289         while (!(mask & 0x1)) {
 290                 (*shift)++;
 291                 mask >>= 1;
 292         }
 293
 294         while (mask & 0x1) {
 295                 (*prec)++;
 296                 mask >>= 1;
 297         }
 298 }
 299
 300 static int config(uint32_t width, uint32_t height, uint32_t d_width, uint32_t d_height, uint32_t flags, char *title, uint32_t format)
 301 {
 302         int tmp1, tmp2, size;
 303         em8300_register_t reg;
 304
 305         /* Softzoom turned on, downscale */
 306         /* This activates the subpicture processor, you can safely disable this and still send */
 307         /* broken subpics to the em8300, if it's enabled and you send broken subpics you will end */
 308         /* up in a lockup */
 309         ioval = EM8300_SPUMODE_ON;
 310         if (ioctl(fd_control, EM8300_IOCTL_SET_SPUMODE, &ioval) < 0) {
 311                 mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Unable to set subpicture mode!\n");
 312                 uninit();
 313                 return -1;
 314         }
 315
 316         /* Set the playmode to play (just in case another app has set it to something else) */
 317         ioval = EM8300_PLAYMODE_PLAY;
 318         if (ioctl(fd_control, EM8300_IOCTL_SET_PLAYMODE, &ioval) < 0) {
 319                 mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Unable to set playmode!\n");
 320         }
 321
 322         /* Start em8300 prebuffering and sync engine */
 323         reg.microcode_register = 1;
 324         reg.reg = 0;
 325         reg.val = MVCOMMAND_SYNC;
 326         ioctl(fd_control, EM8300_IOCTL_WRITEREG, &reg);
 327
 328         /* Clean buffer by syncing it */
 329         ioval = EM8300_SUBDEVICE_VIDEO;
 330         ioctl(fd_control, EM8300_IOCTL_FLUSH, &ioval);
 331         ioval = EM8300_SUBDEVICE_AUDIO;
 332         ioctl(fd_control, EM8300_IOCTL_FLUSH, &ioval);
 333
 334         /* Sync the video device to make sure the buffers are empty
 335          * and set the playback speed to normal. Also reset the
 336          * em8300 internal clock.
 337          */
 338         fsync(fd_video);
 339         ioval = 0x900;
 340         ioctl(fd_control, EM8300_IOCTL_SCR_SETSPEED, &ioval);
 341
 342         /* Store some variables statically that we need later in another scope */
 343         img_format = format;
 344         v_width = width;
 345         v_height = height;
 346
 347         /* Set monitor_aspect to avoid jitter */
 348         monitor_aspect = (float) width / (float) height;
 349
 350         if (ioctl(fd_control, EM8300_IOCTL_GET_VIDEOMODE, &old_vmode) < 0) {
 351                 mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Unable to get TV norm!\n");
 352                 old_vmode = -1;
 353         }
 354
 355         /* adjust TV norm */
 356         if (dxr3_norm != 0) {
 357             if (dxr3_norm == 5) {
 358                         ioval = EM8300_VIDEOMODE_NTSC;
 359             } else if (dxr3_norm == 4) {
 360                         ioval = EM8300_VIDEOMODE_PAL60;
 361             } else if (dxr3_norm == 3) {
 362                         ioval = EM8300_VIDEOMODE_PAL;
 363             } else if (dxr3_norm == 2) {
 364                         if (vo_fps > 28) {
 365                             ioval = EM8300_VIDEOMODE_PAL60;
 366                         } else {
 367                             ioval = EM8300_VIDEOMODE_PAL;
 368                         }
 369
 370                         mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Auto-selected TV norm by framerate: ");
 371                         ioval == EM8300_VIDEOMODE_PAL60 ? mp_msg(MSGT_VO,MSGL_INFO, "PAL-60") : mp_msg(MSGT_VO,MSGL_INFO, "PAL");
 372                         printf(".\n");
 373                 } else {
 374                         if (vo_fps > 28) {
 375                             ioval = EM8300_VIDEOMODE_NTSC;
 376                         } else {
 377                             ioval = EM8300_VIDEOMODE_PAL;
 378                         }
 379
 380                         mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Auto-selected TV norm by framerate: ");
 381                         ioval == EM8300_VIDEOMODE_NTSC ? mp_msg(MSGT_VO,MSGL_INFO, "NTSC") : mp_msg(MSGT_VO,MSGL_INFO, "PAL");
 382                         printf(".\n");
 383             }
 384
 385                 if (old_vmode != ioval) {
 386                 if (ioctl(fd_control, EM8300_IOCTL_SET_VIDEOMODE, &ioval) < 0) {
 387                                 mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Unable to set TV norm!\n");
 388                 }
 389                 }
 390         }
 391
 392
 393         /* libavcodec requires a width and height that is x|16 */
 394         aspect_save_orig(width, height);
 395         aspect_save_prescale(d_width, d_height);
 396         ioctl(fd_control, EM8300_IOCTL_GET_VIDEOMODE, &ioval);
 397         if (ioval == EM8300_VIDEOMODE_NTSC) {
 398                 mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Setting up for NTSC.\n");
 399                 aspect_save_screenres(352, 240);
 400         } else {
 401                 mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Setting up for PAL/SECAM.\n");
 402                 aspect_save_screenres(352, 288);
 403         }
 404         aspect(&s_width, &s_height, A_ZOOM);
 405         s_width -= s_width % 16;
 406         s_height -= s_height % 16;
 407
 408         /* Try to figure out whether to use widescreen output or not */
 409         /* Anamorphic widescreen modes makes this a pain in the ass */
 410         tmp1 = abs(d_height - ((d_width / 4) * 3));
 411         tmp2 = abs(d_height - (int) (d_width / 2.35));
 412         if (tmp1 < tmp2) {
 413                 ioval = EM8300_ASPECTRATIO_4_3;
 414                 mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Setting aspect ratio to 4:3.\n");
 415         } else {
 416                 ioval = EM8300_ASPECTRATIO_16_9;
 417                 mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Setting aspect ratio to 16:9.\n");
 418         }
 419         ioctl(fd_control, EM8300_IOCTL_SET_ASPECTRATIO, &ioval);
 420
 421 #ifdef SPU_SUPPORT
 422 #ifdef CONFIG_FREETYPE
 423         if (ioval == EM8300_ASPECTRATIO_16_9) {
 424                 s_width *= d_height*1.78/s_height*(d_width*1.0/d_height)/2.35;
 425         } else {
 426                 s_width *= 0.84;
 427         }
 428         //printf("VO: [dxr3] sw/sh:dw/dh ->%i,%i,%i,%i\n",s_width,s_height,d_width,d_height);
 429 #else
 430         s_width*=2;
 431         s_height*=2;
 432 #endif
 433
 434         osdpicbuf = calloc( 1,s_width * s_height);
 435         if (osdpicbuf == NULL) {
 436                 mp_tmsg(MSGT_VO,MSGL_ERR, "[VO_DXR3] out of memory\n");
 437                 return -1;
 438         }
 439         spued = malloc(sizeof(encodedata));
 440         if (spued == NULL) {
 441                 free( osdpicbuf );
 442                 mp_tmsg(MSGT_VO,MSGL_ERR, "[VO_DXR3] out of memory\n");
 443                 return -1;
 444         }
 445         spubuf = malloc(sizeof(encodedata));
 446         if (spubuf == NULL) {
 447                 free( osdpicbuf );
 448                 free( spued );
 449                 mp_tmsg(MSGT_VO,MSGL_ERR, "[VO_DXR3] out of memory\n");
 450                 return -1;
 451         }
 452         osd_w = s_width;
 453         osd_h = s_height;
 454         osdpicbuf_w = s_width;
 455         osdpicbuf_h = s_height;
 456
 457         spubuf->count=0;
 458         pixbuf_encode_rle( 0,0,osdpicbuf_w,osdpicbuf_h - 1,osdpicbuf,osdpicbuf_w,spubuf );
 459
 460 #endif
 461
 462 #ifdef CONFIG_X11
 463         if (dxr3_overlay) {
 464                 XVisualInfo vinfo;
 465                 XSetWindowAttributes xswa;
 466                 XSizeHints hint;
 467                 unsigned long xswamask;
 468                 Colormap cmap;
 469                 XColor key_color;
 470                 Window junkwindow;
 471                 Screen *scr;
 472                 int depth, red_shift, red_prec, green_shift, green_prec, blue_shift, blue_prec, acq_color;
 473                 em8300_overlay_screen_t ovlscr;
 474                 em8300_attribute_t ovlattr;
 475
 476                 vo_dx = (vo_screenwidth - d_width) / 2;
 477                 vo_dy = (vo_screenheight - d_height) / 2;
 478                 vo_dwidth = d_width;
 479                 vo_dheight = d_height;
 480                 XGetWindowAttributes(mDisplay, DefaultRootWindow(mDisplay), &xwin_attribs);
 481                 depth = xwin_attribs.depth;
 482                 if (depth != 15 && depth != 16 && depth != 24 && depth != 32) {
 483                         depth = 24;
 484                 }
 485                 XMatchVisualInfo(mDisplay, mScreen, depth, TrueColor, &vinfo);
 486                 vo_x11_create_vo_window(&vinfo, vo_dx, vo_dy,
 487                         d_width, d_height, flags,
 488                         CopyFromParent, "Viewing Window", title);
 489                 xswa.background_pixel = KEY_COLOR;
 490                 xswa.border_pixel = 0;
 491                 xswamask = CWBackPixel | CWBorderPixel;
 492                 XChangeWindowAttributes(mDisplay, vo_window, xswamask, &xswa);
 493
 494                 /* Start setting up overlay */
 495                 XGetWindowAttributes(mDisplay, mRootWin, &xwin_attribs);
 496                 overlay_set_screen(overlay_data, xwin_attribs.width, xwin_attribs.height, xwin_attribs.depth);
 497                 overlay_read_state(overlay_data, NULL);
 498
 499                 /* Allocate keycolor */
 500                 cmap = vo_x11_create_colormap(&vinfo);
 501                 calculate_cvals(vinfo.red_mask, &red_shift, &red_prec);
 502                 calculate_cvals(vinfo.green_mask, &green_shift, &green_prec);
 503                 calculate_cvals(vinfo.blue_mask, &blue_shift, &blue_prec);
 504
 505                 key_color.red = ((KEY_COLOR >> 16) & 0xff) * 256;
 506                 key_color.green = ((KEY_COLOR >> 8) & 0xff) * 256;
 507                 key_color.blue = (KEY_COLOR & 0xff) * 256;
 508                 key_color.pixel = (((key_color.red >> (16 - red_prec)) << red_shift) +
 509                                    ((key_color.green >> (16 - green_prec)) << green_shift) +
 510                                    ((key_color.blue >> (16 - blue_prec)) << blue_shift));
 511                 key_color.flags = DoRed | DoGreen | DoBlue;
 512                 if (!XAllocColor(mDisplay, cmap, &key_color)) {
 513                         mp_tmsg(MSGT_VO,MSGL_ERR, "[VO_DXR3] Unable to allocate keycolor!\n");
 514                         return -1;
 515                 }
 516
 517                 acq_color = ((key_color.red / 256) << 16) | ((key_color.green / 256) << 8) | key_color.blue;
 518                 if (key_color.pixel != KEY_COLOR) {
 519                         mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Unable to allocate exact keycolor, using closest match (0x%lx).\n", key_color.pixel);
 520                 }
 521
 522                 /* Set keycolor and activate overlay */
 523                 XSetWindowBackground(mDisplay, vo_window, key_color.pixel);
 524                 XClearWindow(mDisplay, vo_window);
 525                 overlay_set_keycolor(overlay_data, key_color.pixel);
 526                 overlay_set_mode(overlay_data, EM8300_OVERLAY_MODE_OVERLAY);
 527                 overlay_set_mode(overlay_data, EM8300_OVERLAY_MODE_RECTANGLE);
 528         }
 529 #endif
 530
 531         return 0;
 532 }
 533
 534 static void draw_alpha(int x, int y, int w, int h, unsigned char* src, unsigned char *srca, int srcstride)
 535 {
 536 #ifdef SPU_SUPPORT
 537         unsigned char *buf = &osdpicbuf[(y * osdpicbuf_w) + x];
 538         int by = 0;
 539         register int lx, ly;
 540         register int stride = 0;
 541
 542         for (ly = 0; ly < h - 1; ly++)
 543          {
 544           for(lx = 0; lx < w; lx++ )
 545            if ( ( srca[stride + lx] )&&( src[stride + lx] >= 128 ) ) buf[by + lx] = 3;
 546           by+=osdpicbuf_w;
 547           stride+=srcstride;
 548         }
 549         pixbuf_encode_rle(x, y, osdpicbuf_w, osdpicbuf_h - 1, osdpicbuf, osdpicbuf_w, spued);
 550 #endif
 551 }
 552
 553 extern mp_osd_obj_t* vo_osd_list;
 554
 555 static void draw_osd(void)
 556 {
 557 #ifdef SPU_SUPPORT
 558  static int cleared = 0;
 559         int changed = 0;
 560
 561         if ((disposd % 15) == 0)
 562         {
 563                 {
 564                  mp_osd_obj_t* obj = vo_osd_list;
 565                  vo_update_osd( osd_w,osd_h );
 566                  while( obj )
 567                   {
 568                    if ( obj->flags & OSDFLAG_VISIBLE ) { changed=1; break; }
 569                    obj=obj->next;
 570                   }
 571                 }
 572                 if ( changed )
 573                  {
 574                   vo_draw_text(osd_w, osd_h, draw_alpha);
 575                   memset(osdpicbuf, 0, s_width * s_height);
 576                   cleared=0;
 577                  }
 578                   else
 579                    {
 580                     if ( !cleared )
 581                      {
 582                       spued->count=spubuf->count;
 583                       fast_memcpy( spued->data,spubuf->data,DATASIZE );
 584                       cleared=1;
 585                      }
 586                    }
 587
 588
 589                 /* could stand some check here to see if the subpic hasn't changed
 590                  * as if it hasn't and we re-send it it will "blink" as the last one
 591                  * is turned off, and the new one (same one) is turned on
 592                  */
 593 /*              Subpics are not stable yet =(
 594                 expect lockups if you enable */
 595                 write(fd_spu, spued->data, spued->count);
 596         }
 597         disposd++;
 598 #endif
 599 }
 600
 601
 602 static int draw_frame(uint8_t * src[])
 603 {
 604         vo_mpegpes_t *p = (vo_mpegpes_t *) src[0];
 605
 606 #ifdef SPU_SUPPORT
 607         if (p->id == 0x20) {
 608                 write(fd_spu, p->data, p->size);
 609         } else
 610 #endif
 611                 write(fd_video, p->data, p->size);
 612         return 0;
 613 }
 614
 615 static void flip_page(void)
 616 {
 617 #ifdef CONFIG_X11
 618         if (dxr3_overlay) {
 619                 int event = vo_x11_check_events(mDisplay);
 620                 if (event & VO_EVENT_RESIZE) {
 621                         Window junkwindow;
 622                         XGetWindowAttributes(mDisplay, vo_window, &xwin_attribs);
 623                         XTranslateCoordinates(mDisplay, vo_window, mRootWin, -xwin_attribs.border_width, -xwin_attribs.border_width, &xwin_attribs.x, &xwin_attribs.y, &junkwindow);
 624                         overlay_set_window(overlay_data, xwin_attribs.x, xwin_attribs.y, xwin_attribs.width, xwin_attribs.height);
 625                 }
 626                 if (event & VO_EVENT_EXPOSE) {
 627                         Window junkwindow;
 628                         XSetWindowBackground(mDisplay, vo_window, KEY_COLOR);
 629                         XClearWindow(mDisplay, vo_window);
 630                         XGetWindowAttributes(mDisplay, vo_window, &xwin_attribs);
 631                         XTranslateCoordinates(mDisplay, vo_window, mRootWin, -xwin_attribs.border_width, -xwin_attribs.border_width, &xwin_attribs.x, &xwin_attribs.y, &junkwindow);
 632                         overlay_set_window(overlay_data, xwin_attribs.x, xwin_attribs.y, xwin_attribs.width, xwin_attribs.height);
 633                 }
 634         }
 635 #endif
 636
 637         if (dxr3_newsync) {
 638                 ioctl(fd_control, EM8300_IOCTL_SCR_GET, &ioval);
 639                 ioval <<= 1;
 640                 if (vo_pts == 0) {
 641                         ioval = 0;
 642                         ioctl(fd_control, EM8300_IOCTL_SCR_SET, &ioval);
 643                         pts_offset = 0;
 644                 } else if ((vo_pts - pts_offset) < (ioval - 7200) || (vo_pts - pts_offset) > (ioval + 7200)) {
 645                         ioval = (vo_pts + pts_offset) >> 1;
 646                         ioctl(fd_control, EM8300_IOCTL_SCR_SET, &ioval);
 647                         ioctl(fd_control, EM8300_IOCTL_SCR_GET, &ioval);
 648                         pts_offset = vo_pts - (ioval << 1);
 649                         if (pts_offset < 0) {
 650                                 pts_offset = 0;
 651                         }
 652                 }
 653                 ioval = vo_pts + pts_offset;
 654                 ioctl(fd_video, EM8300_IOCTL_SPU_SETPTS, &ioval);
 655                 ioctl(fd_video, EM8300_IOCTL_VIDEO_SETPTS, &ioval);
 656                 prev_pts = vo_pts;
 657         } else if (dxr3_prebuf) {
 658                 ioctl(fd_spu, EM8300_IOCTL_SPU_SETPTS, &vo_pts);
 659                 ioctl(fd_video, EM8300_IOCTL_VIDEO_SETPTS, &vo_pts);
 660         }
 661 }
 662
 663 static int draw_slice(uint8_t *srcimg[], int stride[], int w, int h, int x0, int y0)
 664 {
 665         return -1;
 666 }
 667
 668 static void uninit(void)
 669 {
 670         mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Uninitializing.\n");
 671 #ifdef CONFIG_X11
 672         if (dxr3_overlay) {
 673                 overlay_set_mode(overlay_data, EM8300_OVERLAY_MODE_OFF);
 674                 overlay_release(overlay_data);
 675
 676                 vo_x11_uninit();
 677         }
 678 #endif
 679         if (old_vmode != -1) {
 680                 if (ioctl(fd_control, EM8300_IOCTL_SET_VIDEOMODE, &old_vmode) < 0) {
 681                         mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Failed restoring TV norm!\n");
 682                 }
 683         }
 684
 685         if (fd_video != -1) {
 686                 close(fd_video);
 687         }
 688         if (fd_spu != -1) {
 689                 close(fd_spu);
 690         }
 691         if (fd_control != -1) {
 692                 close(fd_control);
 693         }
 694 #ifdef SPU_SUPPORT
 695         free(osdpicbuf);
 696         free(spued);
 697 #endif
 698 }
 699
 700 static void check_events(void)
 701 {
 702 }
 703
 704 static int preinit(const char *arg)
 705 {
 706         char devname[MAX_STR_SIZE];
 707         int fdflags = O_WRONLY;
 708
 709         /* Parse commandline */
 710         while (arg) {
 711                 if (!strncmp("prebuf", arg, 6) && !dxr3_prebuf) {
 712                         mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Enabling prebuffering.\n");
 713                         dxr3_prebuf = 1;
 714                 } else if (!strncmp("sync", arg, 4) && !dxr3_newsync) {
 715                         mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Using new sync engine.\n");
 716                         dxr3_newsync = 1;
 717                 } else if (!strncmp("overlay", arg, 7) && !dxr3_overlay) {
 718 #ifdef CONFIG_X11
 719                         mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Using overlay.\n");
 720                         dxr3_overlay = 1;
 721 #else
 722                         mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Error: Overlay requires compiling with X11 libs/headers installed.\n");
 723 #endif
 724                 } else if (!strncmp("norm=", arg, 5)) {
 725                         arg += 5;
 726                         // dxr3_norm is 0 (-> don't change norm) by default
 727                         // but maybe someone changes this in the future
 728
 729                         mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Will set TV norm to: ");
 730
 731                         if (*arg == '5') {
 732                             dxr3_norm = 5;
 733                             mp_msg(MSGT_VO,MSGL_INFO, "NTSC");
 734                         } else if (*arg == '4') {
 735                             dxr3_norm = 4;
 736                             mp_msg(MSGT_VO,MSGL_INFO, "PAL-60");
 737                         } else if (*arg == '3') {
 738                             dxr3_norm = 3;
 739                             mp_msg(MSGT_VO,MSGL_INFO, "PAL");
 740                         } else if (*arg == '2') {
 741                             dxr3_norm = 2;
 742                             mp_tmsg(MSGT_VO,MSGL_INFO, "auto-adjust to movie framerate (PAL/PAL-60)");
 743                         } else if (*arg == '1') {
 744                             dxr3_norm = 1;
 745                             mp_tmsg(MSGT_VO,MSGL_INFO, "auto-adjust to movie framerate (PAL/NTSC)");
 746                         } else if (*arg == '0') {
 747                             dxr3_norm = 0;
 748                             mp_tmsg(MSGT_VO,MSGL_INFO, "Use current norm.");
 749                         } else {
 750                             dxr3_norm = 0;
 751                             mp_tmsg(MSGT_VO,MSGL_INFO, "Unknown norm supplied. Use current norm.");
 752                         }
 753
 754                         mp_msg(MSGT_VO,MSGL_INFO, ".\n");
 755                 } else if (arg[0] == '0' || arg[0] == '1' || arg[0] == '2' || arg[0] == '3') {
 756                         dxr3_device_num = arg[0];
 757                 }
 758
 759                 arg = strchr(arg, ':');
 760                 if (arg) {
 761                         arg++;
 762                 }
 763         }
 764
 765
 766         /* Open the control interface */
 767         sprintf(devname, "/dev/em8300-%d", dxr3_device_num);
 768         fd_control = open(devname, fdflags);
 769         if (fd_control < 1) {
 770                 /* Fall back to old naming scheme */
 771                 mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Error opening %s for writing, trying /dev/em8300 instead.\n", devname);
 772                 sprintf(devname, "/dev/em8300");
 773                 fd_control = open(devname, fdflags);
 774                 if (fd_control < 1) {
 775                         mp_tmsg(MSGT_VO,MSGL_ERR, "[VO_DXR3] Error opening /dev/em8300 for writing as well!\nBailing out.\n");
 776                         return -1;
 777                 }
 778         } else {
 779                 mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Opened: %s.\n", devname);
 780         }
 781
 782         /* Open the video interface */
 783         sprintf(devname, "/dev/em8300_mv-%d", dxr3_device_num);
 784         fd_video = open(devname, fdflags);
 785         if (fd_video < 0) {
 786                 /* Fall back to old naming scheme */
 787                 mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Error opening %s for writing, trying /dev/em8300_mv instead.\n", devname);
 788                 sprintf(devname, "/dev/em8300_mv");
 789                 fd_video = open(devname, fdflags);
 790                 if (fd_video < 0) {
 791                         mp_tmsg(MSGT_VO,MSGL_ERR, "[VO_DXR3] Error opening /dev/em8300_mv for writing as well!\nBailing out.\n");
 792                         uninit();
 793                         return -1;
 794                 }
 795         } else {
 796                 mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Opened: %s.\n", devname);
 797         }
 798         strcpy(fdv_name, devname);
 799
 800         /* Open the subpicture interface */
 801         sprintf(devname, "/dev/em8300_sp-%d", dxr3_device_num);
 802         fd_spu = open(devname, fdflags);
 803         if (fd_spu < 0) {
 804                 /* Fall back to old naming scheme */
 805                 mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Error opening %s for writing, trying /dev/em8300_sp instead.\n", devname);
 806                 sprintf(devname, "/dev/em8300_sp");
 807                 fd_spu = open(devname, fdflags);
 808                 if (fd_spu < 0) {
 809                         mp_tmsg(MSGT_VO,MSGL_ERR, "[VO_DXR3] Error opening /dev/em8300_sp for writing as well!\nBailing out.\n");
 810                         uninit();
 811                         return -1;
 812                 }
 813         } else {
 814                 mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Opened: %s.\n", devname);
 815         }
 816         strcpy(fds_name, devname);
 817
 818 #ifdef CONFIG_X11
 819         if (dxr3_overlay) {
 820
 821                 /* Fucked up hack needed to enable overlay.
 822                  * Will be removed as soon as I figure out
 823                  * how to make it work like it should
 824                  */
 825                 Display *dpy;
 826                 overlay_t *ov;
 827                 XWindowAttributes attribs;
 828
 829                 dpy = XOpenDisplay(NULL);
 830                 if (!dpy) {
 831                         mp_tmsg(MSGT_VO,MSGL_ERR, "[VO_DXR3] Unable to open display during overlay hack setup!\n");
 832                         return -1;
 833                 }
 834                 XGetWindowAttributes(dpy, RootWindow(dpy, DefaultScreen(dpy)), &attribs);
 835                 ov = overlay_init(fd_control);
 836                 overlay_set_screen(ov, attribs.width, attribs.height, PlanesOfScreen(ScreenOfDisplay(dpy, 0)));
 837                 overlay_read_state(ov, NULL);
 838                 overlay_set_keycolor(ov, KEY_COLOR);
 839                 overlay_set_mode(ov, EM8300_OVERLAY_MODE_OVERLAY);
 840                 overlay_set_mode(ov, EM8300_OVERLAY_MODE_RECTANGLE);
 841                 overlay_release(ov);
 842                 XCloseDisplay(dpy);
 843                 /* End of fucked up hack */
 844
 845                 /* Initialize overlay and X11 */
 846                 overlay_data = overlay_init(fd_control);
 847                 if (!vo_init()) {
 848                         mp_tmsg(MSGT_VO,MSGL_ERR, "[VO_DXR3] Unable to init X11!\n");
 849                         return -1;
 850                 }
 851         }
 852 #endif
 853
 854         if (dxr3_newsync) {
 855                 ioctl(fd_control, EM8300_IOCTL_SCR_GET, &ioval);
 856                 pts_offset = vo_pts - (ioval << 1);
 857                 if (pts_offset < 0) {
 858                         pts_offset = 0;
 859                 }
 860         }
 861
 862         return 0;
 863 }
 864
 865 /* Begin overlay.c */
 866 static int update_parameters(overlay_t *o)
 867 {
 868     overlay_set_attribute(o, EM9010_ATTRIBUTE_XOFFSET, o->xoffset);
 869     overlay_set_attribute(o, EM9010_ATTRIBUTE_YOFFSET, o->yoffset);
 870     overlay_set_attribute(o, EM9010_ATTRIBUTE_XCORR, o->xcorr);
 871     overlay_set_attribute(o, EM9010_ATTRIBUTE_STABILITY, o->stability);
 872     overlay_set_attribute(o, EM9010_ATTRIBUTE_JITTER, o->jitter);
 873     return 0;
 874 }
 875
 876 static int overlay_set_attribute(overlay_t *o, int attribute, int value)
 877 {
 878     em8300_attribute_t attr;
 879
 880     attr.attribute = attribute;
 881     attr.value = value;
 882     if (ioctl(o->dev, EM8300_IOCTL_OVERLAY_SET_ATTRIBUTE, &attr)==-1)
 883         {
 884              mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Failed setting overlay attribute.\n");
 885              return -1;
 886         }
 887
 888     return 0;
 889 }
 890
 891 static overlay_t *overlay_init(int dev)
 892 {
 893     overlay_t *o;
 894
 895     o = malloc(sizeof(overlay_t));
 896
 897     if(!o)
 898         return NULL;
 899
 900     memset(o,0,sizeof(overlay_t));
 901
 902     o->dev = dev;
 903     o->xres = 1280; o->yres=1024; o->xcorr=1000;
 904     o->color_interval=10;
 905
 906     return o;
 907 }
 908
 909 static int overlay_release(overlay_t *o)
 910 {
 911     free(o);
 912     return 0;
 913 }
 914 #define TYPE_INT 1
 915 #define TYPE_XINT 2
 916 #define TYPE_COEFF 3
 917 #define TYPE_FLOAT 4
 918
 919 struct lut_entry {
 920     char *name;
 921     int type;
 922     void *ptr;
 923 };
 924
 925 static struct lut_entry *new_lookuptable(overlay_t *o)
 926 {
 927     struct lut_entry m[] = {
 928         {"xoffset", TYPE_INT, &o->xoffset},
 929         {"yoffset", TYPE_INT, &o->yoffset},
 930         {"xcorr", TYPE_INT, &o->xcorr},
 931         {"jitter", TYPE_INT, &o->jitter},
 932         {"stability", TYPE_INT, &o->stability},
 933         {"keycolor", TYPE_XINT, &o->keycolor},
 934         {"colcal_upper", TYPE_COEFF, &o->colcal_upper[0]},
 935         {"colcal_lower", TYPE_COEFF, &o->colcal_lower[0]},
 936         {"color_interval", TYPE_FLOAT, &o->color_interval},
 937         {0,0,0}
 938     },*p;
 939
 940     p = malloc(sizeof(m));
 941     memcpy(p,m,sizeof(m));
 942     return p;
 943 }
 944
 945 static int lookup_parameter(overlay_t *o, struct lut_entry *lut, char *name, void **ptr, int *type) {
 946     int i;
 947
 948     for(i=0; lut[i].name; i++) {
 949         if(!strcmp(name,lut[i].name)) {
 950             *ptr = lut[i].ptr;
 951             *type = lut[i].type;
 952             return 1;
 953         }
 954     }
 955     return 0;
 956 }
 957
 958 static int overlay_read_state(overlay_t *o, char *p)
 959 {
 960     char *a,*tok;
 961     char path[128],fname[128],tmp[128],line[256];
 962     FILE *fp;
 963     struct lut_entry *lut;
 964     void *ptr;
 965     int type;
 966     int j;
 967
 968     if(!p) {
 969         av_strlcpy(fname, getenv("HOME"), sizeof( fname ));
 970         av_strlcat(fname,"/.overlay", sizeof( fname ));
 971     } else
 972         av_strlcpy(fname, p, sizeof( fname ));
 973
 974     sprintf(tmp,"/res_%dx%dx%d",o->xres,o->yres,o->depth);
 975     av_strlcat(fname, tmp, sizeof( fname ));
 976
 977     if(!(fp=fopen(fname,"r")))
 978         return -1;
 979
 980     lut = new_lookuptable(o);
 981
 982     while(!feof(fp)) {
 983         if(!fgets(line,256,fp))
 984             break;
 985         tok=strtok(line," ");
 986         if(lookup_parameter(o,lut,tok,&ptr,&type)) {
 987             tok=strtok(NULL," ");
 988             switch(type) {
 989             case TYPE_INT:
 990                 sscanf(tok,"%d",(int *)ptr);
 991                 break;
 992             case TYPE_XINT:
 993                 sscanf(tok,"%x",(int *)ptr);
 994                 break;
 995             case TYPE_FLOAT:
 996                 sscanf(tok,"%f",(float *)ptr);
 997                 break;
 998             case TYPE_COEFF:
 999                 for(j=0;j<3;j++) {
1000                     sscanf(tok,"%f",&((struct coeff *)ptr)[j].k);
1001                     tok=strtok(NULL," ");
1002                     sscanf(tok,"%f",&((struct coeff *)ptr)[j].m);
1003                     tok=strtok(NULL," ");
1004                 }
1005                 break;
1006             }
1007
1008         }
1009     }
1010
1011     update_parameters(o);
1012
1013     free(lut);
1014     fclose(fp);
1015     return 0;
1016 }
1017
1018 static void overlay_update_params(overlay_t *o) {
1019     update_parameters(o);
1020 }
1021
1022 static int overlay_write_state(overlay_t *o, char *p)
1023 {
1024     char *a;
1025     char path[128],fname[128],tmp[128];
1026     FILE *fp;
1027     char line[256],*tok;
1028     struct lut_entry *lut;
1029     int i,j;
1030
1031     if(!p) {
1032         av_strlcpy(fname, getenv("HOME"), sizeof( fname ));
1033         av_strlcat(fname,"/.overlay", sizeof( fname ));
1034     } else
1035         av_strlcpy(fname, p, sizeof( fname ));
1036
1037     if(access(fname, W_OK|X_OK|R_OK)) {
1038         if(mkdir(fname,0766))
1039             return -1;
1040     }
1041
1042     sprintf(tmp,"/res_%dx%dx%d",o->xres,o->yres,o->depth);
1043     av_strlcat(fname, tmp, sizeof( fname ));
1044
1045     if(!(fp=fopen(fname,"w")))
1046         return -1;
1047
1048     lut = new_lookuptable(o);
1049
1050     for(i=0; lut[i].name; i++) {
1051         fprintf(fp,"%s ",lut[i].name);
1052         switch(lut[i].type) {
1053         case TYPE_INT:
1054             fprintf(fp,"%d\n",*(int *)lut[i].ptr);
1055             break;
1056         case TYPE_XINT:
1057             fprintf(fp,"%06x\n",*(int *)lut[i].ptr);
1058             break;
1059         case TYPE_FLOAT:
1060             fprintf(fp,"%f\n",*(float *)lut[i].ptr);
1061             break;
1062         case TYPE_COEFF:
1063             for(j=0;j<3;j++)
1064                 fprintf(fp,"%f %f ",((struct coeff *)lut[i].ptr)[j].k,
1065                         ((struct coeff *)lut[i].ptr)[j].m);
1066             fprintf(fp,"\n");
1067             break;
1068         }
1069     }
1070
1071     fclose(fp);
1072     return 0;
1073 }
1074
1075 static int overlay_set_screen(overlay_t *o, int xres, int yres, int depth)
1076 {
1077    em8300_overlay_screen_t scr;
1078
1079    o->xres = xres;
1080    o->yres = yres;
1081    o->depth = depth;
1082
1083    scr.xsize = xres;
1084    scr.ysize = yres;
1085
1086    if (ioctl(o->dev, EM8300_IOCTL_OVERLAY_SETSCREEN, &scr)==-1)
1087         {
1088             mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Failed setting overlay screen!\nExiting.\n");
1089             return -1;
1090         }
1091    return 0;
1092 }
1093
1094 static int overlay_set_mode(overlay_t *o, int mode)
1095 {
1096     if (ioctl(o->dev, EM8300_IOCTL_OVERLAY_SETMODE, &mode)==-1) {
1097         mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Failed enabling overlay!\nExiting.\n");
1098         return -1;
1099     }
1100     return 0;
1101 }
1102
1103 static int overlay_set_window(overlay_t *o, int xpos,int ypos,int width,int height)
1104 {
1105     em8300_overlay_window_t win;
1106     win.xpos = xpos;
1107     win.ypos = ypos;
1108     win.width = width;
1109     win.height = height;
1110
1111     if (ioctl(o->dev, EM8300_IOCTL_OVERLAY_SETWINDOW, &win)==-1)
1112         {
1113             mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Failed resizing overlay window!\n");
1114             return -1;
1115         }
1116     return 0;
1117 }
1118
1119 static int overlay_set_bcs(overlay_t *o, int brightness, int contrast, int saturation)
1120 {
1121     em8300_bcs_t bcs;
1122     bcs.brightness = brightness;
1123     bcs.contrast = contrast;
1124     bcs.saturation = saturation;
1125
1126     if (ioctl(o->dev, EM8300_IOCTL_GETBCS, &bcs)==-1)
1127         {
1128             mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Failed setting overlay bcs!\n");
1129             return -1;
1130         }
1131     return 0;
1132 }
1133
1134 static int col_interp(float x, struct coeff c)
1135 {
1136     float y;
1137     y = x*c.k + c.m;
1138     if(y > 255)
1139         y = 255;
1140     if(y < 0)
1141         y = 0;
1142     return rint(y);
1143 }
1144
1145 static int overlay_set_keycolor(overlay_t *o, int color) {
1146     int r = (color & 0xff0000) >> 16;
1147     int g = (color & 0x00ff00) >> 8;
1148     int b = (color & 0x0000ff);
1149     float ru,gu,bu;
1150     float rl,gl,bl;
1151     int upper,lower;
1152
1153     ru = r+o->color_interval;
1154     gu = g+o->color_interval;
1155     bu = b+o->color_interval;
1156
1157     rl = r-o->color_interval;
1158     gl = g-o->color_interval;
1159     bl = b-o->color_interval;
1160
1161     upper = (col_interp(ru, o->colcal_upper[0]) << 16) |
1162             (col_interp(gu, o->colcal_upper[1]) << 8) |
1163             (col_interp(bu, o->colcal_upper[2]));
1164
1165     lower = (col_interp(rl, o->colcal_lower[0]) << 16) |
1166             (col_interp(gl, o->colcal_lower[1]) << 8) |
1167             (col_interp(bl, o->colcal_lower[2]));
1168
1169     //printf("0x%06x 0x%06x\n",upper,lower);
1170     overlay_set_attribute(o,EM9010_ATTRIBUTE_KEYCOLOR_UPPER,upper);
1171     overlay_set_attribute(o,EM9010_ATTRIBUTE_KEYCOLOR_LOWER,lower);
1172     return 0;
1173 }
1174
1175 static void least_sq_fit(int *x, int *y, int n, float *k, float *m)
1176 {
1177     float sx=0,sy=0,sxx=0,sxy=0;
1178     float delta,b;
1179     int i;
1180
1181     for(i=0; i < n; i++) {
1182         sx=sx+x[i];
1183         sy=sy+y[i];
1184         sxx=sxx+x[i]*x[i];
1185         sxy=sxy+x[i]*y[i];
1186     }
1187
1188     delta=sxx*n-sx*sx;
1189
1190     *m=(sxx*sy-sx*sxy)/delta;
1191     *k=(sxy*n-sx*sy)/delta;
1192 }
1193
1194 static int overlay_autocalibrate(overlay_t *o, pattern_drawer_cb pd, void *arg)
1195 {
1196     em8300_overlay_calibrate_t cal;
1197     em8300_overlay_window_t win;
1198     int x[256],r[256],g[256],b[256],n;
1199     float k,m;
1200
1201     int i;
1202
1203     o->draw_pattern=pd;
1204     o->dp_arg = arg;
1205
1206     overlay_set_mode(o, EM8300_OVERLAY_MODE_OVERLAY);
1207     overlay_set_screen(o, o->xres, o->yres, o->depth);
1208
1209     /* Calibrate Y-offset */
1210
1211     o->draw_pattern(0x0000ff, 0, 0, 0, 355, 1, o->dp_arg);
1212
1213     cal.cal_mode = EM8300_OVERLAY_CALMODE_YOFFSET;
1214     if (ioctl(o->dev, EM8300_IOCTL_OVERLAY_CALIBRATE, &cal))
1215         {
1216             mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Failed getting overlay Y-offset values!\nExiting.\n");
1217             return -1;
1218         }
1219     o->yoffset = cal.result;
1220     mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Yoffset: %d.\n",cal.result);
1221
1222     /* Calibrate X-offset */
1223
1224     o->draw_pattern(0x0000ff, 0, 0, 0, 2, 288, o->dp_arg);
1225
1226     cal.cal_mode = EM8300_OVERLAY_CALMODE_XOFFSET;
1227     if (ioctl(o->dev, EM8300_IOCTL_OVERLAY_CALIBRATE, &cal))
1228         {
1229             mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Failed getting overlay X-offset values!\nExiting.\n");
1230             return -1;
1231         }
1232     o->xoffset = cal.result;
1233     mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Xoffset: %d.\n",cal.result);
1234
1235     /* Calibrate X scale correction */
1236
1237     o->draw_pattern(0x0000ff, 0, 355, 0, 2, 288, o->dp_arg);
1238
1239     cal.cal_mode = EM8300_OVERLAY_CALMODE_XCORRECTION;
1240     if (ioctl(o->dev, EM8300_IOCTL_OVERLAY_CALIBRATE, &cal))
1241         {
1242             mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Failed getting overlay X scale correction!\nExiting.\n");
1243             return -1;
1244         }
1245     mp_tmsg(MSGT_VO,MSGL_INFO, "[VO_DXR3] Xcorrection: %d.\n",cal.result);
1246     o->xcorr = cal.result;
1247
1248     win.xpos = 10;
1249     win.ypos = 10;
1250     win.width = o->xres-20;
1251     win.height = o->yres-20;
1252     if (ioctl(o->dev, EM8300_IOCTL_OVERLAY_SETWINDOW, &win)==-1) {
1253         mp_tmsg(MSGT_VO,MSGL_ERR, "[VO_DXR3] Failed resizing overlay window!\n");
1254         exit(1);
1255     }
1256
1257     /* Calibrate key color upper limit */
1258
1259     for(i=128,n=0; i <= 0xff; i+=4) {
1260         o->draw_pattern(i | (i << 8) | (i << 16), 0,
1261                         (o->xres-200)/2,0,200,o->yres,o->dp_arg);
1262
1263         cal.arg = i;
1264         cal.arg2 = 1;
1265         cal.cal_mode = EM8300_OVERLAY_CALMODE_COLOR;
1266
1267         if (ioctl(o->dev, EM8300_IOCTL_OVERLAY_CALIBRATE, &cal))
1268             {
1269                 return -1 ;
1270             }
1271
1272         x[n] = i;
1273         r[n] = (cal.result>>16)&0xff;
1274         g[n] = (cal.result>>8)&0xff;
1275         b[n] = (cal.result)&0xff;
1276         n++;
1277     }
1278
1279     least_sq_fit(x,r,n,&o->colcal_upper[0].k,&o->colcal_upper[0].m);
1280     least_sq_fit(x,g,n,&o->colcal_upper[1].k,&o->colcal_upper[1].m);
1281     least_sq_fit(x,b,n,&o->colcal_upper[2].k,&o->colcal_upper[2].m);
1282
1283     /* Calibrate key color lower limit */
1284
1285     for(i=128,n=0; i <= 0xff; i+=4) {
1286         o->draw_pattern(i | (i << 8) | (i << 16), 0xffffff,
1287                         (o->xres-200)/2,0,200,o->yres, o->dp_arg);
1288
1289         cal.arg = i;
1290         cal.arg2 = 2;
1291         cal.cal_mode = EM8300_OVERLAY_CALMODE_COLOR;
1292
1293         if (ioctl(o->dev, EM8300_IOCTL_OVERLAY_CALIBRATE, &cal))
1294             {
1295                 return -1 ;
1296             }
1297         x[n] = i;
1298         r[n] = (cal.result>>16)&0xff;
1299         g[n] = (cal.result>>8)&0xff;
1300         b[n] = (cal.result)&0xff;
1301         n++;
1302     }
1303
1304     least_sq_fit(x,r,n,&o->colcal_lower[0].k,&o->colcal_lower[0].m);
1305     least_sq_fit(x,g,n,&o->colcal_lower[1].k,&o->colcal_lower[1].m);
1306     least_sq_fit(x,b,n,&o->colcal_lower[2].k,&o->colcal_lower[2].m);
1307
1308     overlay_set_mode(o, EM8300_OVERLAY_MODE_OFF);
1309
1310     return 0;
1311 }
1312
1313
1314 static int overlay_signalmode(overlay_t *o, int mode) {
1315         if(ioctl(o->dev, EM8300_IOCTL_OVERLAY_SIGNALMODE, &mode) ==-1) {
1316             mp_tmsg(MSGT_VO,MSGL_WARN, "[VO_DXR3] Failed to set signal mix!\n");
1317             return -1;
1318         }
1319         return 0;
1320 }
1321 /* End overlay.c */