drivers/char/pms.c

   1 /*
   2  *      Media Vision Pro Movie Studio
   3  *                      or
   4  *      "all you need is an I2C bus some RAM and a prayer"
   5  *
   6  *      This draws heavily on code
   7  *
   8  *      (c) Wolfgang Koehler,  wolf@first.gmd.de, Dec. 1994
   9  *      Kiefernring 15
  10  *      14478 Potsdam, Germany
  11  *
  12  *      Most of this code is directly derived from his userspace driver.
  13  *      His driver works so send any reports to alan@redhat.com unless the
  14  *      userspace driver also doesnt work for you...
  15  */
  16
  17 #include <linux/module.h>
  18 #include <linux/delay.h>
  19 #include <linux/errno.h>
  20 #include <linux/fs.h>
  21 #include <linux/kernel.h>
  22 #include <linux/malloc.h>
  23 #include <linux/mm.h>
  24 #include <linux/ioport.h>
  25 #include <asm/io.h>
  26 #include <linux/sched.h>
  27 #include <linux/videodev.h>
  28 #include <linux/version.h>
  29 #include <asm/uaccess.h>
  30
  31
  32 #define MOTOROLA        1
  33 #define PHILIPS2        2
  34 #define PHILIPS1        3
  35 #define MVVMEMORYWIDTH  0x40            /* 512 bytes */
  36
  37 struct pms_device
  38 {
  39         struct video_device v;
  40         struct video_picture picture;
  41         int height;
  42         int width;
  43 };
  44
  45 struct i2c_info
  46 {
  47         u8 slave;
  48         u8 sub;
  49         u8 data;
  50         u8 hits;
  51 };
  52
  53 static int i2c_count            = 0;
  54 static struct i2c_info i2cinfo[64];
  55
  56 static int decoder              = PHILIPS2;
  57 static int standard             = 0;    /* 0 - auto 1 - ntsc 2 - pal 3 - secam */
  58
  59 /*
  60  *      I/O ports and Shared Memory
  61  */
  62
  63 static int io_port              =       0x250;
  64 static int data_port            =       0x251;
  65 static int mem_base             =       0xC8000;
  66
  67
  68
  69 extern __inline__ void mvv_write(u8 index, u8 value)
  70 {
  71         outw(index|(value<<8), io_port);
  72 }
  73
  74 extern __inline__ u8 mvv_read(u8 index)
  75 {
  76         outb(index, io_port);
  77         return inb(data_port);
  78 }
  79
  80 static int pms_i2c_stat(u8 slave)
  81 {
  82         int counter;
  83         int i;
  84
  85         outb(0x28, io_port);
  86
  87         counter=0;
  88         while((inb(data_port)&0x01)==0)
  89                 if(counter++==256)
  90                         break;
  91
  92         while((inb(data_port)&0x01)!=0)
  93                 if(counter++==256)
  94                         break;
  95
  96         outb(slave, io_port);
  97
  98         counter=0;
  99         while((inb(data_port)&0x01)==0)
 100                 if(counter++==256)
 101                         break;
 102
 103         while((inb(data_port)&0x01)!=0)
 104                 if(counter++==256)
 105                         break;
 106
 107         for(i=0;i<12;i++)
 108         {
 109                 char st=inb(data_port);
 110                 if((st&2)!=0)
 111                         return -1;
 112                 if((st&1)==0)
 113                         break;
 114         }
 115         outb(0x29, io_port);
 116         return inb(data_port);
 117 }
 118
 119 static int pms_i2c_write(u16 slave, u16 sub, u16 data)
 120 {
 121         int skip=0;
 122         int count;
 123         int i;
 124
 125         for(i=0;i<i2c_count;i++)
 126         {
 127                 if((i2cinfo[i].slave==slave) &&
 128                    (i2cinfo[i].sub == sub))
 129                 {
 130                         if(i2cinfo[i].data==data)
 131                                 skip=1;
 132                         i2cinfo[i].data=data;
 133                         i=i2c_count+1;
 134                 }
 135         }
 136
 137         if(i==i2c_count && i2c_count<64)
 138         {
 139                 i2cinfo[i2c_count].slave=slave;
 140                 i2cinfo[i2c_count].sub=sub;
 141                 i2cinfo[i2c_count].data=data;
 142                 i2c_count++;
 143         }
 144
 145         if(skip)
 146                 return 0;
 147
 148         mvv_write(0x29, sub);
 149         mvv_write(0x2A, data);
 150         mvv_write(0x28, slave);
 151
 152         outb(0x28, io_port);
 153
 154         count=0;
 155         while((inb(data_port)&1)==0)
 156                 if(count>255)
 157                         break;
 158         while((inb(data_port)&1)!=0)
 159                 if(count>255)
 160                         break;
 161
 162         count=inb(data_port);
 163
 164         if(count&2)
 165                 return -1;
 166         return count;
 167 }
 168
 169 static int pms_i2c_read(int slave, int sub)
 170 {
 171         int i=0;
 172         for(i=0;i<i2c_count;i++)
 173         {
 174                 if(i2cinfo[i].slave==slave && i2cinfo[i].sub==sub)
 175                         return i2cinfo[i].data;
 176         }
 177         return 0;
 178 }
 179
 180
 181 static void pms_i2c_andor(int slave, int sub, int and, int or)
 182 {
 183         u8 tmp;
 184
 185         tmp=pms_i2c_read(slave, sub);
 186         tmp = (tmp&and)|or;
 187         pms_i2c_write(slave, sub, tmp);
 188 }
 189
 190 /*
 191  *      Control functions
 192  */
 193
 194
 195 static void pms_videosource(short source)
 196 {
 197         mvv_write(0x2E, source?0x31:0x30);
 198 }
 199
 200 static void pms_hue(short hue)
 201 {
 202         switch(decoder)
 203         {
 204                 case MOTOROLA:
 205                         pms_i2c_write(0x8A, 0x00, hue);
 206                         break;
 207                 case PHILIPS2:
 208                         pms_i2c_write(0x8A, 0x07, hue);
 209                         break;
 210                 case PHILIPS1:
 211                         pms_i2c_write(0x42, 0x07, hue);
 212                         break;
 213         }
 214 }
 215
 216 static void pms_colour(short colour)
 217 {
 218         switch(decoder)
 219         {
 220                 case MOTOROLA:
 221                         pms_i2c_write(0x8A, 0x00, colour);
 222                         break;
 223                 case PHILIPS1:
 224                         pms_i2c_write(0x42, 0x12, colour);
 225                         break;
 226         }
 227 }
 228
 229
 230 static void pms_contrast(short contrast)
 231 {
 232         switch(decoder)
 233         {
 234                 case MOTOROLA:
 235                         pms_i2c_write(0x8A, 0x00, contrast);
 236                         break;
 237                 case PHILIPS1:
 238                         pms_i2c_write(0x42, 0x13, contrast);
 239                         break;
 240         }
 241 }
 242
 243 static void pms_brightness(short brightness)
 244 {
 245         switch(decoder)
 246         {
 247                 case MOTOROLA:
 248                         pms_i2c_write(0x8A, 0x00, brightness);
 249                         pms_i2c_write(0x8A, 0x00, brightness);
 250                         pms_i2c_write(0x8A, 0x00, brightness);
 251                         break;
 252                 case PHILIPS1:
 253                         pms_i2c_write(0x42, 0x19, brightness);
 254                         break;
 255         }
 256 }
 257
 258
 259 static void pms_format(short format)
 260 {
 261         int target;
 262         standard = format;
 263
 264         if(decoder==PHILIPS1)
 265                 target=0x42;
 266         else if(decoder==PHILIPS2)
 267                 target=0x8A;
 268         else
 269                 return;
 270
 271         switch(format)
 272         {
 273                 case 0: /* Auto */
 274                         pms_i2c_andor(target, 0x0D, 0xFE,0x00);
 275                         pms_i2c_andor(target, 0x0F, 0x3F,0x80);
 276                         break;
 277                 case 1: /* NTSC */
 278                         pms_i2c_andor(target, 0x0D, 0xFE, 0x00);
 279                         pms_i2c_andor(target, 0x0F, 0x3F, 0x40);
 280                         break;
 281                 case 2: /* PAL */
 282                         pms_i2c_andor(target, 0x0D, 0xFE, 0x00);
 283                         pms_i2c_andor(target, 0x0F, 0x3F, 0x00);
 284                         break;
 285                 case 3: /* SECAM */
 286                         pms_i2c_andor(target, 0x0D, 0xFE, 0x01);
 287                         pms_i2c_andor(target, 0x0F, 0x3F, 0x00);
 288                         break;
 289         }
 290 }
 291
 292 #ifdef FOR_FUTURE_EXPANSION
 293
 294 /*
 295  *      These features of the PMS card are not currently exposes. They
 296  *      could become a private v4l ioctl for PMSCONFIG or somesuch if
 297  *      people need it. We also don't yet use the PMS interrupt.
 298  */
 299
 300 static void pms_hstart(short start)
 301 {
 302         switch(decoder)
 303         {
 304                 case PHILIPS1:
 305                         pms_i2c_write(0x8A, 0x05, start);
 306                         pms_i2c_write(0x8A, 0x18, start);
 307                         break;
 308                 case PHILIPS2:
 309                         pms_i2c_write(0x42, 0x05, start);
 310                         pms_i2c_write(0x42, 0x18, start);
 311                         break;
 312         }
 313 }
 314
 315 /*
 316  *      Bandpass filters
 317  */
 318
 319 static void pms_bandpass(short pass)
 320 {
 321         if(decoder==PHILIPS2)
 322                 pms_i2c_andor(0x8A, 0x06, 0xCF, (pass&0x03)<<4);
 323         else if(decoder==PHILIPS1)
 324                 pms_i2c_andor(0x42, 0x06, 0xCF, (pass&0x03)<<4);
 325 }
 326
 327 static void pms_antisnow(short snow)
 328 {
 329         if(decoder==PHILIPS2)
 330                 pms_i2c_andor(0x8A, 0x06, 0xF3, (snow&0x03)<<2);
 331         else if(decoder==PHILIPS1)
 332                 pms_i2c_andor(0x42, 0x06, 0xF3, (snow&0x03)<<2);
 333 }
 334
 335 static void pms_sharpness(short sharp)
 336 {
 337         if(decoder==PHILIPS2)
 338                 pms_i2c_andor(0x8A, 0x06, 0xFC, sharp&0x03);
 339         else if(decoder==PHILIPS1)
 340                 pms_i2c_andor(0x42, 0x06, 0xFC, sharp&0x03);
 341 }
 342
 343 static void pms_chromaagc(short agc)
 344 {
 345         if(decoder==PHILIPS2)
 346                 pms_i2c_andor(0x8A, 0x0C, 0x9F, (agc&0x03)<<5);
 347         else if(decoder==PHILIPS1)
 348                 pms_i2c_andor(0x42, 0x0C, 0x9F, (agc&0x03)<<5);
 349 }
 350
 351 static void pms_vertnoise(short noise)
 352 {
 353         if(decoder==PHILIPS2)
 354                 pms_i2c_andor(0x8A, 0x10, 0xFC, noise&3);
 355         else if(decoder==PHILIPS1)
 356                 pms_i2c_andor(0x42, 0x10, 0xFC, noise&3);
 357 }
 358
 359 static void pms_forcecolour(short colour)
 360 {
 361         if(decoder==PHILIPS2)
 362                 pms_i2c_andor(0x8A, 0x0C, 0x7F, (colour&1)<<7);
 363         else if(decoder==PHILIPS1)
 364                 pms_i2c_andor(0x42, 0x0C, 0x7, (colour&1)<<7);
 365 }
 366
 367 static void pms_antigamma(short gamma)
 368 {
 369         if(decoder==PHILIPS2)
 370                 pms_i2c_andor(0xB8, 0x00, 0x7F, (gamma&1)<<7);
 371         else if(decoder==PHILIPS1)
 372                 pms_i2c_andor(0x42, 0x20, 0x7, (gamma&1)<<7);
 373 }
 374
 375 static void pms_prefilter(short filter)
 376 {
 377         if(decoder==PHILIPS2)
 378                 pms_i2c_andor(0x8A, 0x06, 0xBF, (filter&1)<<6);
 379         else if(decoder==PHILIPS1)
 380                 pms_i2c_andor(0x42, 0x06, 0xBF, (filter&1)<<6);
 381 }
 382
 383 static void pms_hfilter(short filter)
 384 {
 385         if(decoder==PHILIPS2)
 386                 pms_i2c_andor(0xB8, 0x04, 0x1F, (filter&7)<<5);
 387         else if(decoder==PHILIPS1)
 388                 pms_i2c_andor(0x42, 0x24, 0x1F, (filter&7)<<5);
 389 }
 390
 391 static void pms_vfilter(short filter)
 392 {
 393         if(decoder==PHILIPS2)
 394                 pms_i2c_andor(0xB8, 0x08, 0x9F, (filter&3)<<5);
 395         else if(decoder==PHILIPS1)
 396                 pms_i2c_andor(0x42, 0x28, 0x9F, (filter&3)<<5);
 397 }
 398
 399 static void pms_killcolour(short colour)
 400 {
 401         if(decoder==PHILIPS2)
 402         {
 403                 pms_i2c_andor(0x8A, 0x08, 0x07, (colour&0x1F)<<3);
 404                 pms_i2c_andor(0x8A, 0x09, 0x07, (colour&0x1F)<<3);
 405         }
 406         else if(decoder==PHILIPS1)
 407         {
 408                 pms_i2c_andor(0x42, 0x08, 0x07, (colour&0x1F)<<3);
 409                 pms_i2c_andor(0x42, 0x09, 0x07, (colour&0x1F)<<3);
 410         }
 411 }
 412
 413 static void pms_chromagain(short chroma)
 414 {
 415         if(decoder==PHILIPS2)
 416         {
 417                 pms_i2c_write(0x8A, 0x11, chroma);
 418         }
 419         else if(decoder==PHILIPS1)
 420         {
 421                 pms_i2c_write(0x42, 0x11, chroma);
 422         }
 423 }
 424
 425
 426 static void pms_spacialcompl(short data)
 427 {
 428         mvv_write(0x3B, data);
 429 }
 430
 431 static void pms_spacialcomph(short data)
 432 {
 433         mvv_write(0x3A, data);
 434 }
 435
 436 static void pms_vstart(short start)
 437 {
 438         mvv_write(0x16, start);
 439         mvv_write(0x17, (start>>8)&0x01);
 440 }
 441
 442 #endif
 443
 444 static void pms_secamcross(short cross)
 445 {
 446         if(decoder==PHILIPS2)
 447                 pms_i2c_andor(0x8A, 0x0F, 0xDF, (cross&1)<<5);
 448         else if(decoder==PHILIPS1)
 449                 pms_i2c_andor(0x42, 0x0F, 0xDF, (cross&1)<<5);
 450 }
 451
 452
 453 static void pms_swsense(short sense)
 454 {
 455         if(decoder==PHILIPS2)
 456         {
 457                 pms_i2c_write(0x8A, 0x0A, sense);
 458                 pms_i2c_write(0x8A, 0x0B, sense);
 459         }
 460         else if(decoder==PHILIPS1)
 461         {
 462                 pms_i2c_write(0x42, 0x0A, sense);
 463                 pms_i2c_write(0x42, 0x0B, sense);
 464         }
 465 }
 466
 467
 468 static void pms_framerate(short frr)
 469 {
 470         int fps=(standard==1)?30:25;
 471         if(frr==0)
 472                 return;
 473         fps=fps/frr;
 474         mvv_write(0x14,0x80|fps);
 475         mvv_write(0x15,1);
 476 }
 477
 478 static void pms_vert(u8 deciden, u8 decinum)
 479 {
 480         mvv_write(0x1C, deciden);       /* Denominator */
 481         mvv_write(0x1D, decinum);       /* Numerator */
 482 }
 483
 484 /*
 485  *      Turn 16bit ratios into best small ratio the chipset can grok
 486  */
 487
 488 static void pms_vertdeci(unsigned short decinum, unsigned short deciden)
 489 {
 490         /* Knock it down by /5 once */
 491         if(decinum%5==0)
 492         {
 493                 deciden/=5;
 494                 decinum/=5;
 495         }
 496         /*
 497          *      3's
 498          */
 499         while(decinum%3==0 && deciden%3==0)
 500         {
 501                 deciden/=3;
 502                 decinum/=3;
 503         }
 504         /*
 505          *      2's
 506          */
 507         while(decinum%2==0 && deciden%2==0)
 508         {
 509                 decinum/=2;
 510                 deciden/=2;
 511         }
 512         /*
 513          *      Fudgyify
 514          */
 515         while(deciden>32)
 516         {
 517                 deciden/=2;
 518                 decinum=(decinum+1)/2;
 519         }
 520         if(deciden==32)
 521                 deciden--;
 522         pms_vert(deciden,decinum);
 523 }
 524
 525 static void pms_horzdeci(short decinum, short deciden)
 526 {
 527         if(decinum<=512)
 528         {
 529                 if(decinum%5==0)
 530                 {
 531                         decinum/=5;
 532                         deciden/=5;
 533                 }
 534         }
 535         else
 536         {
 537                 decinum=512;
 538                 deciden=640;    /* 768 would be ideal */
 539         }
 540
 541         while(((decinum|deciden)&1)==0)
 542         {
 543                 decinum>>=1;
 544                 deciden>>=1;
 545         }
 546         while(deciden>32)
 547         {
 548                 deciden>>=1;
 549                 decinum=(decinum+1)>>1;
 550         }
 551         if(deciden==32)
 552                 deciden--;
 553
 554         mvv_write(0x24, 0x80|deciden);
 555         mvv_write(0x25, decinum);
 556 }
 557
 558 static void pms_resolution(short width, short height)
 559 {
 560         int fg_height;
 561
 562         fg_height=height;
 563         if(fg_height>280)
 564                 fg_height=280;
 565
 566         mvv_write(0x18, fg_height);
 567         mvv_write(0x19, fg_height>>8);
 568
 569         if(standard==1)
 570         {
 571                 mvv_write(0x1A, 0xFC);
 572                 mvv_write(0x1B, 0x00);
 573                 if(height>fg_height)
 574                         pms_vertdeci(240,240);
 575                 else
 576                         pms_vertdeci(fg_height,240);
 577         }
 578         else
 579         {
 580                 mvv_write(0x1A, 0x1A);
 581                 mvv_write(0x1B, 0x01);
 582                 if(fg_height>256)
 583                         pms_vertdeci(270,270);
 584                 else
 585                         pms_vertdeci(fg_height, 270);
 586         }
 587         mvv_write(0x12,0);
 588         mvv_write(0x13, MVVMEMORYWIDTH);
 589         mvv_write(0x42, 0x00);
 590         mvv_write(0x43, 0x00);
 591         mvv_write(0x44, MVVMEMORYWIDTH);
 592
 593         mvv_write(0x22, width+8);
 594         mvv_write(0x23, (width+8)>> 8);
 595
 596         if(standard==1)
 597                 pms_horzdeci(width,640);
 598         else
 599                 pms_horzdeci(width+8, 768);
 600
 601         mvv_write(0x30, mvv_read(0x30)&0xFE);
 602         mvv_write(0x08, mvv_read(0x08)|0x01);
 603         mvv_write(0x01, mvv_read(0x01)&0xFD);
 604         mvv_write(0x32, 0x00);
 605         mvv_write(0x33, MVVMEMORYWIDTH);
 606 }
 607
 608
 609 /*
 610  *      Set Input
 611  */
 612
 613 static void pms_vcrinput(short input)
 614 {
 615         if(decoder==PHILIPS2)
 616                 pms_i2c_andor(0x8A,0x0D,0x7F,(input&1)<<7);
 617         else if(decoder==PHILIPS1)
 618                 pms_i2c_andor(0x42,0x0D,0x7F,(input&1)<<7);
 619 }
 620
 621
 622 static int pms_capture(struct pms_device *dev, char *buf, int rgb555, int count)
 623 {
 624         int y;
 625         int dw = 2*dev->width;
 626         char *src = (char *)bus_to_virt(mem_base);
 627
 628         char tmp[dw+32]; /* using a temp buffer is faster than direct  */
 629         int cnt = 0;
 630         int len=0;
 631         unsigned char r8 = 0x5;  /* value for reg8  */
 632
 633         if (rgb555)
 634                 r8 |= 0x20; /* else use untranslated rgb = 565 */
 635         mvv_write(0x08,r8); /* capture rgb555/565, init DRAM, PC enable */
 636
 637 /*      printf("%d %d %d %d %d %x %x\n",width,height,voff,nom,den,mvv_buf); */
 638
 639         for (y = 0; y < dev->height; y++ )
 640         {
 641                 *src = 0;  /* synchronisiert neue Zeile */
 642                 memcpy(tmp, src, dw+32); /* discard 16 word   */
 643                 cnt -= dev->height;
 644                 while (cnt <= 0)
 645                 {
 646                         /*
 647                          *      Don't copy too far
 648                          */
 649                         int dt=dw;
 650                         if(dt+len>count)
 651                                 dt=count-len;
 652                         cnt += dev->height;
 653                         copy_to_user(buf, tmp+32, dt);
 654                         buf += dt;
 655                         len += dt;
 656                 }
 657         }
 658         return len;
 659 }
 660
 661
 662 /*
 663  *      Video4linux interfacing
 664  */
 665
 666 static int pms_open(struct video_device *dev, int flags)
 667 {
 668         MOD_INC_USE_COUNT;
 669         return 0;
 670 }
 671
 672 static void pms_close(struct video_device *dev)
 673 {
 674         MOD_DEC_USE_COUNT;
 675 }
 676
 677 static int pms_init_done(struct video_device *dev)
 678 {
 679         return 0;
 680 }
 681
 682 static long pms_write(struct video_device *v, const char *buf, unsigned long count, int noblock)
 683 {
 684         return -EINVAL;
 685 }
 686
 687 static int pms_ioctl(struct video_device *dev, unsigned int cmd, void *arg)
 688 {
 689         struct pms_device *pd=(struct pms_device *)dev;
 690
 691         switch(cmd)
 692         {
 693                 case VIDIOCGCAP:
 694                 {
 695                         struct video_capability b;
 696                         strcpy(b.name, "Mediavision PMS");
 697                         b.type = VID_TYPE_CAPTURE|VID_TYPE_SCALES;
 698                         b.channels = 4;
 699                         b.audios = 0;
 700                         b.maxwidth = 640;
 701                         b.maxheight = 480;
 702                         b.minwidth = 16;
 703                         b.minheight = 16;
 704                         if(copy_to_user(arg, &b,sizeof(b)))
 705                                 return -EFAULT;
 706                         return 0;
 707                 }
 708                 case VIDIOCGCHAN:
 709                 {
 710                         struct video_channel v;
 711                         if(copy_from_user(&v, arg, sizeof(v)))
 712                                 return -EFAULT;
 713                         if(v.channel<0 || v.channel>3)
 714                                 return -EINVAL;
 715                         v.flags=0;
 716                         v.tuners=1;
 717                         /* Good question.. its composite or SVHS so.. */
 718                         v.type = VIDEO_TYPE_CAMERA;
 719                         switch(v.channel)
 720                         {
 721                                 case 0:
 722                                         strcpy(v.name, "Composite");break;
 723                                 case 1:
 724                                         strcpy(v.name, "SVideo");break;
 725                                 case 2:
 726                                         strcpy(v.name, "Composite(VCR)");break;
 727                                 case 3:
 728                                         strcpy(v.name, "SVideo(VCR)");break;
 729                         }
 730                         if(copy_to_user(arg, &v, sizeof(v)))
 731                                 return -EFAULT;
 732                         return 0;
 733                 }
 734                 case VIDIOCSCHAN:
 735                 {
 736                         int v;
 737                         if(copy_from_user(&v, arg,sizeof(v)))
 738                                 return -EFAULT;
 739                         if(v<0 || v>3)
 740                                 return -EINVAL;
 741                         pms_videosource(v&1);
 742                         pms_vcrinput(v>>1);
 743                         return 0;
 744                 }
 745                 case VIDIOCGTUNER:
 746                 {
 747                         struct video_tuner v;
 748                         if(copy_from_user(&v, arg, sizeof(v))!=0)
 749                                 return -EFAULT;
 750                         if(v.tuner)
 751                                 return -EINVAL;
 752                         strcpy(v.name, "Format");
 753                         v.rangelow=0;
 754                         v.rangehigh=0;
 755                         v.flags= VIDEO_TUNER_PAL|VIDEO_TUNER_NTSC|VIDEO_TUNER_SECAM;
 756                         switch(standard)
 757                         {
 758                                 case 0:
 759                                         v.mode = VIDEO_MODE_AUTO;
 760                                         break;
 761                                 case 1:
 762                                         v.mode = VIDEO_MODE_NTSC;
 763                                         break;
 764                                 case 2:
 765                                         v.mode = VIDEO_MODE_PAL;
 766                                         break;
 767                                 case 3:
 768                                         v.mode = VIDEO_MODE_SECAM;
 769                                         break;
 770                         }
 771                         if(copy_to_user(arg,&v,sizeof(v))!=0)
 772                                 return -EFAULT;
 773                         return 0;
 774                 }
 775                 case VIDIOCSTUNER:
 776                 {
 777                         struct video_tuner v;
 778                         if(copy_from_user(&v, arg, sizeof(v))!=0)
 779                                 return -EFAULT;
 780                         if(v.tuner)
 781                                 return -EINVAL;
 782                         switch(v.mode)
 783                         {
 784                                 case VIDEO_MODE_AUTO:
 785                                         pms_framerate(25);
 786                                         pms_secamcross(0);
 787                                         pms_format(0);
 788                                         break;
 789                                 case VIDEO_MODE_NTSC:
 790                                         pms_framerate(30);
 791                                         pms_secamcross(0);
 792                                         pms_format(1);
 793                                         break;
 794                                 case VIDEO_MODE_PAL:
 795                                         pms_framerate(25);
 796                                         pms_secamcross(0);
 797                                         pms_format(2);
 798                                         break;
 799                                 case VIDEO_MODE_SECAM:
 800                                         pms_framerate(25);
 801                                         pms_secamcross(1);
 802                                         pms_format(2);
 803                                         break;
 804                                 default:
 805                                         return -EINVAL;
 806                         }
 807                         return 0;
 808                 }
 809                 case VIDIOCGPICT:
 810                 {
 811                         struct video_picture p=pd->picture;
 812                         if(copy_to_user(arg, &p, sizeof(p)))
 813                                 return -EFAULT;
 814                         return 0;
 815                 }
 816                 case VIDIOCSPICT:
 817                 {
 818                         struct video_picture p;
 819                         if(copy_from_user(&p, arg, sizeof(p)))
 820                                 return -EFAULT;
 821                         if(!((p.palette==VIDEO_PALETTE_RGB565 && p.depth==16)
 822                             ||(p.palette==VIDEO_PALETTE_RGB555 && p.depth==15)))
 823                                 return -EINVAL;
 824                         pd->picture=p;
 825
 826                         /*
 827                          *      Now load the card.
 828                          */
 829
 830                         pms_brightness(p.brightness>>8);
 831                         pms_hue(p.hue>>8);
 832                         pms_colour(p.colour>>8);
 833                         pms_contrast(p.contrast>>8);
 834                         return 0;
 835                 }
 836                 case VIDIOCSWIN:
 837                 {
 838                         struct video_window vw;
 839                         if(copy_from_user(&vw, arg,sizeof(vw)))
 840                                 return -EFAULT;
 841                         if(vw.flags)
 842                                 return -EINVAL;
 843                         if(vw.clipcount)
 844                                 return -EINVAL;
 845                         if(vw.height<16||vw.height>480)
 846                                 return -EINVAL;
 847                         if(vw.width<16||vw.width>640)
 848                                 return -EINVAL;
 849                         pd->width=vw.width;
 850                         pd->height=vw.height;
 851                         pms_resolution(pd->width, pd->height);
 852                         /* Ok we figured out what to use from our wide choice */
 853                         return 0;
 854                 }
 855                 case VIDIOCGWIN:
 856                 {
 857                         struct video_window vw;
 858                         vw.x=0;
 859                         vw.y=0;
 860                         vw.width=pd->width;
 861                         vw.height=pd->height;
 862                         vw.chromakey=0;
 863                         vw.flags=0;
 864                         if(copy_to_user(arg, &vw, sizeof(vw)))
 865                                 return -EFAULT;
 866                         return 0;
 867                 }
 868                 case VIDIOCCAPTURE:
 869                         return -EINVAL;
 870                 case VIDIOCGFBUF:
 871                         return -EINVAL;
 872                 case VIDIOCSFBUF:
 873                         return -EINVAL;
 874                 case VIDIOCKEY:
 875                         return 0;
 876                 case VIDIOCGFREQ:
 877                         return -EINVAL;
 878                 case VIDIOCSFREQ:
 879                         return -EINVAL;
 880                 case VIDIOCGAUDIO:
 881                         return -EINVAL;
 882                 case VIDIOCSAUDIO:
 883                         return -EINVAL;
 884                 default:
 885                         return -ENOIOCTLCMD;
 886         }
 887         return 0;
 888 }
 889
 890 static long pms_read(struct video_device *v, char *buf, unsigned long count,  int noblock)
 891 {
 892         struct pms_device *pd=(struct pms_device *)v;
 893         int len;
 894
 895         /* FIXME: semaphore this */
 896         len=pms_capture(pd, buf, (pd->picture.depth==16)?0:1,count);
 897         return len;
 898 }
 899
 900
 901 struct video_device pms_template=
 902 {
 903         "Mediavision PMS",
 904         VID_TYPE_CAPTURE,
 905         VID_HARDWARE_PMS,
 906         pms_open,
 907         pms_close,
 908         pms_read,
 909         pms_write,
 910         NULL,           /* FIXME - we can use POLL on this board with the irq */
 911         pms_ioctl,
 912         NULL,
 913         pms_init_done,
 914         NULL,
 915         0,
 916         0
 917 };
 918
 919 struct pms_device pms_device;
 920
 921
 922 /*
 923  *      Probe for and initialise the Mediavision PMS
 924  */
 925
 926 static int init_mediavision(void)
 927 {
 928         int id;
 929         int idec, decst;
 930         int i;
 931
 932         unsigned char i2c_defs[]={
 933                 0x4C,0x30,0x00,0xE8,
 934                 0xB6,0xE2,0x00,0x00,
 935                 0xFF,0xFF,0x00,0x00,
 936                 0x00,0x00,0x78,0x98,
 937                 0x00,0x00,0x00,0x00,
 938                 0x34,0x0A,0xF4,0xCE,
 939                 0xE4
 940         };
 941
 942         if(check_region(0x9A01,1))
 943         {
 944                 printk(KERN_WARNING "mediavision: unable to detect: 0x9A01 in use.\n");
 945                 return -EBUSY;
 946         }
 947         if(check_region(io_port,3))
 948         {
 949                 printk(KERN_WARNING "mediavision: I/O port %d in use.\n", io_port);
 950                 return -EBUSY;
 951         }
 952         outb(0xB8, 0x9A01);             /* Unlock */
 953         outb(io_port>>4, 0x9A01);       /* Set IO port */
 954
 955
 956         id=mvv_read(3);
 957         decst=pms_i2c_stat(0x43);
 958
 959         if(decst!=-1)
 960                 idec=2;
 961         else if(pms_i2c_stat(0xb9)!=-1)
 962                 idec=3;
 963         else if(pms_i2c_stat(0x8b)!=-1)
 964                 idec=1;
 965         else
 966                 idec=0;
 967
 968         printk(KERN_INFO "PMS type is %d\n", idec);
 969         if(idec==0)
 970                 return -ENODEV;
 971
 972         /*
 973          *      Ok we have a PMS of some sort
 974          */
 975
 976         request_region(io_port,3, "Mediavision PMS");
 977         request_region(0x9A01, 1, "Mediavision PMS config");
 978
 979         mvv_write(0x04, mem_base>>12);  /* Set the memory area */
 980
 981         /* Ok now load the defaults */
 982
 983         for(i=0;i<0x19;i++)
 984         {
 985                 if(i2c_defs[i]==0xFF)
 986                         pms_i2c_andor(0x8A, i, 0x07,0x00);
 987                 else
 988                         pms_i2c_write(0x8A, i, i2c_defs[i]);
 989         }
 990
 991         pms_i2c_write(0xB8,0x00,0x12);
 992         pms_i2c_write(0xB8,0x04,0x00);
 993         pms_i2c_write(0xB8,0x07,0x00);
 994         pms_i2c_write(0xB8,0x08,0x00);
 995         pms_i2c_write(0xB8,0x09,0xFF);
 996         pms_i2c_write(0xB8,0x0A,0x00);
 997         pms_i2c_write(0xB8,0x0B,0x10);
 998         pms_i2c_write(0xB8,0x10,0x03);
 999
1000         mvv_write(0x01, 0x00);
1001         mvv_write(0x05, 0xA0);
1002         mvv_write(0x08, 0x25);
1003         mvv_write(0x09, 0x00);
1004         mvv_write(0x0A, 0x20|MVVMEMORYWIDTH);
1005
1006         mvv_write(0x10, 0x02);
1007         mvv_write(0x1E, 0x0C);
1008         mvv_write(0x1F, 0x03);
1009         mvv_write(0x26, 0x06);
1010
1011         mvv_write(0x2B, 0x00);
1012         mvv_write(0x2C, 0x20);
1013         mvv_write(0x2D, 0x00);
1014         mvv_write(0x2F, 0x70);
1015         mvv_write(0x32, 0x00);
1016         mvv_write(0x33, MVVMEMORYWIDTH);
1017         mvv_write(0x34, 0x00);
1018         mvv_write(0x35, 0x00);
1019         mvv_write(0x3A, 0x80);
1020         mvv_write(0x3B, 0x10);
1021         mvv_write(0x20, 0x00);
1022         mvv_write(0x21, 0x00);
1023         mvv_write(0x30, 0x22);
1024         return 0;
1025 }
1026
1027 static void shutdown_mediavision(void)
1028 {
1029         release_region(io_port,3);
1030         release_region(0x9A01, 1);
1031 }
1032
1033 /*
1034  *      Module stuff
1035  */
1036
1037 #ifdef MODULE
1038 int init_module(void)
1039 #else
1040 int init_pms_cards(struct video_init *v)
1041 #endif
1042 {
1043         printk(KERN_INFO "Mediavision Pro Movie Studio driver 0.02\n");
1044
1045         data_port = io_port +1;
1046
1047         if(init_mediavision())
1048         {
1049                 printk(KERN_INFO "Board not found.\n");
1050                 return -ENODEV;
1051         }
1052         memcpy(&pms_device, &pms_template, sizeof(pms_template));
1053         pms_device.height=240;
1054         pms_device.width=320;
1055         pms_swsense(75);
1056         pms_resolution(320,240);
1057         return video_register_device((struct video_device *)&pms_device, VFL_TYPE_GRABBER);
1058 }
1059
1060 #ifdef MODULE
1061
1062 MODULE_PARM(io_port,"i");
1063 MODULE_PARM(mem_base,"i");
1064
1065 void cleanup_module(void)
1066 {
1067         shutdown_mediavision();
1068         video_unregister_device((struct video_device *)&pms_device);
1069 }
1070
1071 #endif