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