drivers/char/pms.c

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