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