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