2 * Media Vision Pro Movie Studio
4 * "all you need is an I2C bus some RAM and a prayer"
6 * This draws heavily on code
8 * (c) Wolfgang Koehler, wolf@first.gmd.de, Dec. 1994
10 * 14478 Potsdam, Germany
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...
17 * 08/07/2003 Daniele Bellucci <bellucda@tiscali.it>
18 * - pms_capture: report back -EFAULT
21 #include <linux/module.h>
22 #include <linux/delay.h>
23 #include <linux/errno.h>
25 #include <linux/kernel.h>
26 #include <linux/slab.h>
28 #include <linux/ioport.h>
29 #include <linux/init.h>
31 #include <linux/sched.h>
32 #include <linux/videodev.h>
33 #include <asm/uaccess.h>
39 #define MVVMEMORYWIDTH 0x40 /* 512 bytes */
43 struct video_device v;
44 struct video_picture picture;
47 struct semaphore lock;
58 static int i2c_count = 0;
59 static struct i2c_info i2cinfo[64];
61 static int decoder = PHILIPS2;
62 static int standard = 0; /* 0 - auto 1 - ntsc 2 - pal 3 - secam */
65 * I/O ports and Shared Memory
68 static int io_port = 0x250;
69 static int data_port = 0x251;
70 static int mem_base = 0xC8000;
71 static int video_nr = -1;
75 static inline void mvv_write(u8 index, u8 value)
77 outw(index|(value<<8), io_port);
80 static inline u8 mvv_read(u8 index)
83 return inb(data_port);
86 static int pms_i2c_stat(u8 slave)
94 while((inb(data_port)&0x01)==0)
98 while((inb(data_port)&0x01)!=0)
102 outb(slave, io_port);
105 while((inb(data_port)&0x01)==0)
109 while((inb(data_port)&0x01)!=0)
115 char st=inb(data_port);
122 return inb(data_port);
125 static int pms_i2c_write(u16 slave, u16 sub, u16 data)
131 for(i=0;i<i2c_count;i++)
133 if((i2cinfo[i].slave==slave) &&
134 (i2cinfo[i].sub == sub))
136 if(i2cinfo[i].data==data)
138 i2cinfo[i].data=data;
143 if(i==i2c_count && i2c_count<64)
145 i2cinfo[i2c_count].slave=slave;
146 i2cinfo[i2c_count].sub=sub;
147 i2cinfo[i2c_count].data=data;
154 mvv_write(0x29, sub);
155 mvv_write(0x2A, data);
156 mvv_write(0x28, slave);
161 while((inb(data_port)&1)==0)
164 while((inb(data_port)&1)!=0)
168 count=inb(data_port);
175 static int pms_i2c_read(int slave, int sub)
178 for(i=0;i<i2c_count;i++)
180 if(i2cinfo[i].slave==slave && i2cinfo[i].sub==sub)
181 return i2cinfo[i].data;
187 static void pms_i2c_andor(int slave, int sub, int and, int or)
191 tmp=pms_i2c_read(slave, sub);
193 pms_i2c_write(slave, sub, tmp);
201 static void pms_videosource(short source)
203 mvv_write(0x2E, source?0x31:0x30);
206 static void pms_hue(short hue)
211 pms_i2c_write(0x8A, 0x00, hue);
214 pms_i2c_write(0x8A, 0x07, hue);
217 pms_i2c_write(0x42, 0x07, hue);
222 static void pms_colour(short colour)
227 pms_i2c_write(0x8A, 0x00, colour);
230 pms_i2c_write(0x42, 0x12, colour);
236 static void pms_contrast(short contrast)
241 pms_i2c_write(0x8A, 0x00, contrast);
244 pms_i2c_write(0x42, 0x13, contrast);
249 static void pms_brightness(short brightness)
254 pms_i2c_write(0x8A, 0x00, brightness);
255 pms_i2c_write(0x8A, 0x00, brightness);
256 pms_i2c_write(0x8A, 0x00, brightness);
259 pms_i2c_write(0x42, 0x19, brightness);
265 static void pms_format(short format)
270 if(decoder==PHILIPS1)
272 else if(decoder==PHILIPS2)
280 pms_i2c_andor(target, 0x0D, 0xFE,0x00);
281 pms_i2c_andor(target, 0x0F, 0x3F,0x80);
284 pms_i2c_andor(target, 0x0D, 0xFE, 0x00);
285 pms_i2c_andor(target, 0x0F, 0x3F, 0x40);
288 pms_i2c_andor(target, 0x0D, 0xFE, 0x00);
289 pms_i2c_andor(target, 0x0F, 0x3F, 0x00);
292 pms_i2c_andor(target, 0x0D, 0xFE, 0x01);
293 pms_i2c_andor(target, 0x0F, 0x3F, 0x00);
298 #ifdef FOR_FUTURE_EXPANSION
301 * These features of the PMS card are not currently exposes. They
302 * could become a private v4l ioctl for PMSCONFIG or somesuch if
303 * people need it. We also don't yet use the PMS interrupt.
306 static void pms_hstart(short start)
311 pms_i2c_write(0x8A, 0x05, start);
312 pms_i2c_write(0x8A, 0x18, start);
315 pms_i2c_write(0x42, 0x05, start);
316 pms_i2c_write(0x42, 0x18, start);
325 static void pms_bandpass(short pass)
327 if(decoder==PHILIPS2)
328 pms_i2c_andor(0x8A, 0x06, 0xCF, (pass&0x03)<<4);
329 else if(decoder==PHILIPS1)
330 pms_i2c_andor(0x42, 0x06, 0xCF, (pass&0x03)<<4);
333 static void pms_antisnow(short snow)
335 if(decoder==PHILIPS2)
336 pms_i2c_andor(0x8A, 0x06, 0xF3, (snow&0x03)<<2);
337 else if(decoder==PHILIPS1)
338 pms_i2c_andor(0x42, 0x06, 0xF3, (snow&0x03)<<2);
341 static void pms_sharpness(short sharp)
343 if(decoder==PHILIPS2)
344 pms_i2c_andor(0x8A, 0x06, 0xFC, sharp&0x03);
345 else if(decoder==PHILIPS1)
346 pms_i2c_andor(0x42, 0x06, 0xFC, sharp&0x03);
349 static void pms_chromaagc(short agc)
351 if(decoder==PHILIPS2)
352 pms_i2c_andor(0x8A, 0x0C, 0x9F, (agc&0x03)<<5);
353 else if(decoder==PHILIPS1)
354 pms_i2c_andor(0x42, 0x0C, 0x9F, (agc&0x03)<<5);
357 static void pms_vertnoise(short noise)
359 if(decoder==PHILIPS2)
360 pms_i2c_andor(0x8A, 0x10, 0xFC, noise&3);
361 else if(decoder==PHILIPS1)
362 pms_i2c_andor(0x42, 0x10, 0xFC, noise&3);
365 static void pms_forcecolour(short colour)
367 if(decoder==PHILIPS2)
368 pms_i2c_andor(0x8A, 0x0C, 0x7F, (colour&1)<<7);
369 else if(decoder==PHILIPS1)
370 pms_i2c_andor(0x42, 0x0C, 0x7, (colour&1)<<7);
373 static void pms_antigamma(short gamma)
375 if(decoder==PHILIPS2)
376 pms_i2c_andor(0xB8, 0x00, 0x7F, (gamma&1)<<7);
377 else if(decoder==PHILIPS1)
378 pms_i2c_andor(0x42, 0x20, 0x7, (gamma&1)<<7);
381 static void pms_prefilter(short filter)
383 if(decoder==PHILIPS2)
384 pms_i2c_andor(0x8A, 0x06, 0xBF, (filter&1)<<6);
385 else if(decoder==PHILIPS1)
386 pms_i2c_andor(0x42, 0x06, 0xBF, (filter&1)<<6);
389 static void pms_hfilter(short filter)
391 if(decoder==PHILIPS2)
392 pms_i2c_andor(0xB8, 0x04, 0x1F, (filter&7)<<5);
393 else if(decoder==PHILIPS1)
394 pms_i2c_andor(0x42, 0x24, 0x1F, (filter&7)<<5);
397 static void pms_vfilter(short filter)
399 if(decoder==PHILIPS2)
400 pms_i2c_andor(0xB8, 0x08, 0x9F, (filter&3)<<5);
401 else if(decoder==PHILIPS1)
402 pms_i2c_andor(0x42, 0x28, 0x9F, (filter&3)<<5);
405 static void pms_killcolour(short colour)
407 if(decoder==PHILIPS2)
409 pms_i2c_andor(0x8A, 0x08, 0x07, (colour&0x1F)<<3);
410 pms_i2c_andor(0x8A, 0x09, 0x07, (colour&0x1F)<<3);
412 else if(decoder==PHILIPS1)
414 pms_i2c_andor(0x42, 0x08, 0x07, (colour&0x1F)<<3);
415 pms_i2c_andor(0x42, 0x09, 0x07, (colour&0x1F)<<3);
419 static void pms_chromagain(short chroma)
421 if(decoder==PHILIPS2)
423 pms_i2c_write(0x8A, 0x11, chroma);
425 else if(decoder==PHILIPS1)
427 pms_i2c_write(0x42, 0x11, chroma);
432 static void pms_spacialcompl(short data)
434 mvv_write(0x3B, data);
437 static void pms_spacialcomph(short data)
439 mvv_write(0x3A, data);
442 static void pms_vstart(short start)
444 mvv_write(0x16, start);
445 mvv_write(0x17, (start>>8)&0x01);
450 static void pms_secamcross(short cross)
452 if(decoder==PHILIPS2)
453 pms_i2c_andor(0x8A, 0x0F, 0xDF, (cross&1)<<5);
454 else if(decoder==PHILIPS1)
455 pms_i2c_andor(0x42, 0x0F, 0xDF, (cross&1)<<5);
459 static void pms_swsense(short sense)
461 if(decoder==PHILIPS2)
463 pms_i2c_write(0x8A, 0x0A, sense);
464 pms_i2c_write(0x8A, 0x0B, sense);
466 else if(decoder==PHILIPS1)
468 pms_i2c_write(0x42, 0x0A, sense);
469 pms_i2c_write(0x42, 0x0B, sense);
474 static void pms_framerate(short frr)
476 int fps=(standard==1)?30:25;
480 mvv_write(0x14,0x80|fps);
484 static void pms_vert(u8 deciden, u8 decinum)
486 mvv_write(0x1C, deciden); /* Denominator */
487 mvv_write(0x1D, decinum); /* Numerator */
491 * Turn 16bit ratios into best small ratio the chipset can grok
494 static void pms_vertdeci(unsigned short decinum, unsigned short deciden)
496 /* Knock it down by /5 once */
505 while(decinum%3==0 && deciden%3==0)
513 while(decinum%2==0 && deciden%2==0)
524 decinum=(decinum+1)/2;
528 pms_vert(deciden,decinum);
531 static void pms_horzdeci(short decinum, short deciden)
544 deciden=640; /* 768 would be ideal */
547 while(((decinum|deciden)&1)==0)
555 decinum=(decinum+1)>>1;
560 mvv_write(0x24, 0x80|deciden);
561 mvv_write(0x25, decinum);
564 static void pms_resolution(short width, short height)
572 mvv_write(0x18, fg_height);
573 mvv_write(0x19, fg_height>>8);
577 mvv_write(0x1A, 0xFC);
578 mvv_write(0x1B, 0x00);
580 pms_vertdeci(240,240);
582 pms_vertdeci(fg_height,240);
586 mvv_write(0x1A, 0x1A);
587 mvv_write(0x1B, 0x01);
589 pms_vertdeci(270,270);
591 pms_vertdeci(fg_height, 270);
594 mvv_write(0x13, MVVMEMORYWIDTH);
595 mvv_write(0x42, 0x00);
596 mvv_write(0x43, 0x00);
597 mvv_write(0x44, MVVMEMORYWIDTH);
599 mvv_write(0x22, width+8);
600 mvv_write(0x23, (width+8)>> 8);
603 pms_horzdeci(width,640);
605 pms_horzdeci(width+8, 768);
607 mvv_write(0x30, mvv_read(0x30)&0xFE);
608 mvv_write(0x08, mvv_read(0x08)|0x01);
609 mvv_write(0x01, mvv_read(0x01)&0xFD);
610 mvv_write(0x32, 0x00);
611 mvv_write(0x33, MVVMEMORYWIDTH);
619 static void pms_vcrinput(short input)
621 if(decoder==PHILIPS2)
622 pms_i2c_andor(0x8A,0x0D,0x7F,(input&1)<<7);
623 else if(decoder==PHILIPS1)
624 pms_i2c_andor(0x42,0x0D,0x7F,(input&1)<<7);
628 static int pms_capture(struct pms_device *dev, char __user *buf, int rgb555, int count)
631 int dw = 2*dev->width;
634 char tmp[dw+32]; /* using a temp buffer is faster than direct */
637 unsigned char r8 = 0x5; /* value for reg8 */
640 r8 |= 0x20; /* else use untranslated rgb = 565 */
641 mvv_write(0x08,r8); /* capture rgb555/565, init DRAM, PC enable */
643 /* printf("%d %d %d %d %d %x %x\n",width,height,voff,nom,den,mvv_buf); */
645 for (y = 0; y < dev->height; y++ )
647 isa_writeb(0, src); /* synchronisiert neue Zeile */
650 * This is in truth a fifo, be very careful as if you
651 * forgot this odd things will occur 8)
654 isa_memcpy_fromio(tmp, src, dw+32); /* discard 16 word */
665 if (copy_to_user(buf, tmp+32, dt))
666 return len ? len : -EFAULT;
676 * Video4linux interfacing
679 static int pms_do_ioctl(struct inode *inode, struct file *file,
680 unsigned int cmd, void *arg)
682 struct video_device *dev = video_devdata(file);
683 struct pms_device *pd=(struct pms_device *)dev;
689 struct video_capability *b = arg;
690 strcpy(b->name, "Mediavision PMS");
691 b->type = VID_TYPE_CAPTURE|VID_TYPE_SCALES;
702 struct video_channel *v = arg;
703 if(v->channel<0 || v->channel>3)
707 /* Good question.. its composite or SVHS so.. */
708 v->type = VIDEO_TYPE_CAMERA;
712 strcpy(v->name, "Composite");break;
714 strcpy(v->name, "SVideo");break;
716 strcpy(v->name, "Composite(VCR)");break;
718 strcpy(v->name, "SVideo(VCR)");break;
724 struct video_channel *v = arg;
725 if(v->channel<0 || v->channel>3)
728 pms_videosource(v->channel&1);
729 pms_vcrinput(v->channel>>1);
735 struct video_tuner *v = arg;
738 strcpy(v->name, "Format");
741 v->flags= VIDEO_TUNER_PAL|VIDEO_TUNER_NTSC|VIDEO_TUNER_SECAM;
745 v->mode = VIDEO_MODE_AUTO;
748 v->mode = VIDEO_MODE_NTSC;
751 v->mode = VIDEO_MODE_PAL;
754 v->mode = VIDEO_MODE_SECAM;
761 struct video_tuner *v = arg;
767 case VIDEO_MODE_AUTO:
772 case VIDEO_MODE_NTSC:
782 case VIDEO_MODE_SECAM:
796 struct video_picture *p = arg;
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)))
813 pms_brightness(p->brightness>>8);
815 pms_colour(p->colour>>8);
816 pms_contrast(p->contrast>>8);
822 struct video_window *vw = arg;
827 if(vw->height<16||vw->height>480)
829 if(vw->width<16||vw->width>640)
832 pd->height=vw->height;
834 pms_resolution(pd->width, pd->height);
835 up(&pd->lock); /* Ok we figured out what to use from our wide choice */
840 struct video_window *vw = arg;
841 memset(vw,0,sizeof(*vw));
843 vw->height=pd->height;
862 static int pms_ioctl(struct inode *inode, struct file *file,
863 unsigned int cmd, unsigned long arg)
865 return video_usercopy(inode, file, cmd, arg, pms_do_ioctl);
868 static int pms_read(struct file *file, char __user *buf,
869 size_t count, loff_t *ppos)
871 struct video_device *v = video_devdata(file);
872 struct pms_device *pd=(struct pms_device *)v;
876 len=pms_capture(pd, buf, (pd->picture.depth==16)?0:1,count);
881 static struct file_operations pms_fops = {
882 .owner = THIS_MODULE,
883 .open = video_exclusive_open,
884 .release = video_exclusive_release,
890 static struct video_device pms_template=
892 .owner = THIS_MODULE,
893 .name = "Mediavision PMS",
894 .type = VID_TYPE_CAPTURE,
895 .hardware = VID_HARDWARE_PMS,
899 struct pms_device pms_device;
903 * Probe for and initialise the Mediavision PMS
906 static int init_mediavision(void)
912 unsigned char i2c_defs[]={
922 if (!request_region(0x9A01, 1, "Mediavision PMS config"))
924 printk(KERN_WARNING "mediavision: unable to detect: 0x9A01 in use.\n");
927 if (!request_region(io_port, 3, "Mediavision PMS"))
929 printk(KERN_WARNING "mediavision: I/O port %d in use.\n", io_port);
930 release_region(0x9A01, 1);
933 outb(0xB8, 0x9A01); /* Unlock */
934 outb(io_port>>4, 0x9A01); /* Set IO port */
938 decst=pms_i2c_stat(0x43);
942 else if(pms_i2c_stat(0xb9)!=-1)
944 else if(pms_i2c_stat(0x8b)!=-1)
949 printk(KERN_INFO "PMS type is %d\n", idec);
951 release_region(io_port, 3);
952 release_region(0x9A01, 1);
957 * Ok we have a PMS of some sort
960 mvv_write(0x04, mem_base>>12); /* Set the memory area */
962 /* Ok now load the defaults */
966 if(i2c_defs[i]==0xFF)
967 pms_i2c_andor(0x8A, i, 0x07,0x00);
969 pms_i2c_write(0x8A, i, i2c_defs[i]);
972 pms_i2c_write(0xB8,0x00,0x12);
973 pms_i2c_write(0xB8,0x04,0x00);
974 pms_i2c_write(0xB8,0x07,0x00);
975 pms_i2c_write(0xB8,0x08,0x00);
976 pms_i2c_write(0xB8,0x09,0xFF);
977 pms_i2c_write(0xB8,0x0A,0x00);
978 pms_i2c_write(0xB8,0x0B,0x10);
979 pms_i2c_write(0xB8,0x10,0x03);
981 mvv_write(0x01, 0x00);
982 mvv_write(0x05, 0xA0);
983 mvv_write(0x08, 0x25);
984 mvv_write(0x09, 0x00);
985 mvv_write(0x0A, 0x20|MVVMEMORYWIDTH);
987 mvv_write(0x10, 0x02);
988 mvv_write(0x1E, 0x0C);
989 mvv_write(0x1F, 0x03);
990 mvv_write(0x26, 0x06);
992 mvv_write(0x2B, 0x00);
993 mvv_write(0x2C, 0x20);
994 mvv_write(0x2D, 0x00);
995 mvv_write(0x2F, 0x70);
996 mvv_write(0x32, 0x00);
997 mvv_write(0x33, MVVMEMORYWIDTH);
998 mvv_write(0x34, 0x00);
999 mvv_write(0x35, 0x00);
1000 mvv_write(0x3A, 0x80);
1001 mvv_write(0x3B, 0x10);
1002 mvv_write(0x20, 0x00);
1003 mvv_write(0x21, 0x00);
1004 mvv_write(0x30, 0x22);
1009 * Initialization and module stuff
1012 static int __init init_pms_cards(void)
1014 printk(KERN_INFO "Mediavision Pro Movie Studio driver 0.02\n");
1016 data_port = io_port +1;
1018 if(init_mediavision())
1020 printk(KERN_INFO "Board not found.\n");
1023 memcpy(&pms_device, &pms_template, sizeof(pms_template));
1024 init_MUTEX(&pms_device.lock);
1025 pms_device.height=240;
1026 pms_device.width=320;
1028 pms_resolution(320,240);
1029 return video_register_device((struct video_device *)&pms_device, VFL_TYPE_GRABBER, video_nr);
1032 MODULE_PARM(io_port,"i");
1033 MODULE_PARM(mem_base,"i");
1034 MODULE_PARM(video_nr,"i");
1035 MODULE_LICENSE("GPL");
1038 static void __exit shutdown_mediavision(void)
1040 release_region(io_port,3);
1041 release_region(0x9A01, 1);
1044 static void __exit cleanup_pms_module(void)
1046 shutdown_mediavision();
1047 video_unregister_device((struct video_device *)&pms_device);
1050 module_init(init_pms_cards);
1051 module_exit(cleanup_pms_module);