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