/spare/repo/netdev-2.6 branch 'ieee80211'
[linux-2.6] / drivers / sbus / char / vfc_dev.c
1 /*
2  * drivers/sbus/char/vfc_dev.c
3  *
4  * Driver for the Videopix Frame Grabber.
5  * 
6  * In order to use the VFC you need to program the video controller
7  * chip. This chip is the Phillips SAA9051.  You need to call their
8  * documentation ordering line to get the docs.
9  *
10  * There is very little documentation on the VFC itself.  There is
11  * some useful info that can be found in the manuals that come with
12  * the card.  I will hopefully write some better docs at a later date.
13  *
14  * Copyright (C) 1996 Manish Vachharajani (mvachhar@noc.rutgers.edu)
15  * */
16
17 #include <linux/module.h>
18 #include <linux/kernel.h>
19 #include <linux/string.h>
20 #include <linux/slab.h>
21 #include <linux/errno.h>
22 #include <linux/sched.h>
23 #include <linux/fs.h>
24 #include <linux/smp_lock.h>
25 #include <linux/delay.h>
26 #include <linux/spinlock.h>
27 #include <linux/mm.h>
28
29 #include <asm/openprom.h>
30 #include <asm/oplib.h>
31 #include <asm/io.h>
32 #include <asm/system.h>
33 #include <asm/sbus.h>
34 #include <asm/page.h>
35 #include <asm/pgtable.h>
36 #include <asm/uaccess.h>
37
38 #define VFC_MAJOR (60)
39
40 #if 0
41 #define VFC_IOCTL_DEBUG
42 #endif
43
44 #include "vfc.h"
45 #include <asm/vfc_ioctls.h>
46
47 static struct file_operations vfc_fops;
48 struct vfc_dev **vfc_dev_lst;
49 static char vfcstr[]="vfc";
50 static unsigned char saa9051_init_array[VFC_SAA9051_NR] = {
51         0x00, 0x64, 0x72, 0x52,
52         0x36, 0x18, 0xff, 0x20,
53         0xfc, 0x77, 0xe3, 0x50,
54         0x3e
55 };
56
57 void vfc_lock_device(struct vfc_dev *dev)
58 {
59         down(&dev->device_lock_sem);
60 }
61
62 void vfc_unlock_device(struct vfc_dev *dev)
63 {
64         up(&dev->device_lock_sem);
65 }
66
67
68 void vfc_captstat_reset(struct vfc_dev *dev) 
69 {
70         dev->control_reg |= VFC_CONTROL_CAPTRESET;
71         sbus_writel(dev->control_reg, &dev->regs->control);
72         dev->control_reg &= ~VFC_CONTROL_CAPTRESET;
73         sbus_writel(dev->control_reg, &dev->regs->control);
74         dev->control_reg |= VFC_CONTROL_CAPTRESET;
75         sbus_writel(dev->control_reg, &dev->regs->control);
76 }
77
78 void vfc_memptr_reset(struct vfc_dev *dev) 
79 {
80         dev->control_reg |= VFC_CONTROL_MEMPTR;
81         sbus_writel(dev->control_reg, &dev->regs->control);
82         dev->control_reg &= ~VFC_CONTROL_MEMPTR;
83         sbus_writel(dev->control_reg, &dev->regs->control);
84         dev->control_reg |= VFC_CONTROL_MEMPTR; 
85         sbus_writel(dev->control_reg, &dev->regs->control);
86 }
87
88 int vfc_csr_init(struct vfc_dev *dev)
89 {
90         dev->control_reg = 0x80000000;
91         sbus_writel(dev->control_reg, &dev->regs->control);
92         udelay(200); 
93         dev->control_reg &= ~0x80000000;
94         sbus_writel(dev->control_reg, &dev->regs->control);
95         udelay(100); 
96         sbus_writel(0x0f000000, &dev->regs->i2c_magic2);
97
98         vfc_memptr_reset(dev);
99
100         dev->control_reg &= ~VFC_CONTROL_DIAGMODE;
101         dev->control_reg &= ~VFC_CONTROL_CAPTURE;
102         dev->control_reg |= 0x40000000;
103         sbus_writel(dev->control_reg, &dev->regs->control);
104
105         vfc_captstat_reset(dev);
106
107         return 0;
108 }
109
110 int vfc_saa9051_init(struct vfc_dev *dev)
111 {
112         int i;
113
114         for (i = 0; i < VFC_SAA9051_NR; i++)
115                 dev->saa9051_state_array[i] = saa9051_init_array[i];
116
117         vfc_i2c_sendbuf(dev,VFC_SAA9051_ADDR,
118                         dev->saa9051_state_array, VFC_SAA9051_NR);
119         return 0;
120 }
121
122 int init_vfc_hw(struct vfc_dev *dev) 
123 {
124         vfc_lock_device(dev);
125         vfc_csr_init(dev);
126
127         vfc_pcf8584_init(dev);
128         vfc_init_i2c_bus(dev); /* hopefully this doesn't undo the magic
129                                   sun code above*/
130         vfc_saa9051_init(dev);
131         vfc_unlock_device(dev);
132         return 0; 
133 }
134
135 int init_vfc_devstruct(struct vfc_dev *dev, int instance) 
136 {
137         dev->instance=instance;
138         init_MUTEX(&dev->device_lock_sem);
139         dev->control_reg=0;
140         dev->busy=0;
141         return 0;
142 }
143
144 int init_vfc_device(struct sbus_dev *sdev,struct vfc_dev *dev, int instance)
145 {
146         if(dev == NULL) {
147                 printk(KERN_ERR "VFC: Bogus pointer passed\n");
148                 return -ENOMEM;
149         }
150         printk("Initializing vfc%d\n",instance);
151         dev->regs = NULL;
152         dev->regs = (volatile struct vfc_regs *)
153                 sbus_ioremap(&sdev->resource[0], 0,
154                              sizeof(struct vfc_regs), vfcstr);
155         dev->which_io = sdev->reg_addrs[0].which_io;
156         dev->phys_regs = (struct vfc_regs *) sdev->reg_addrs[0].phys_addr;
157         if (dev->regs == NULL)
158                 return -EIO;
159
160         printk("vfc%d: registers mapped at phys_addr: 0x%lx\n    virt_addr: 0x%lx\n",
161                instance,(unsigned long)sdev->reg_addrs[0].phys_addr,(unsigned long)dev->regs);
162
163         if (init_vfc_devstruct(dev, instance))
164                 return -EINVAL;
165         if (init_vfc_hw(dev))
166                 return -EIO;
167
168         devfs_mk_cdev(MKDEV(VFC_MAJOR, instance),
169                         S_IFCHR | S_IRUSR | S_IWUSR,
170                         "vfc/%d", instance);
171         return 0;
172 }
173
174
175 struct vfc_dev *vfc_get_dev_ptr(int instance) 
176 {
177         return vfc_dev_lst[instance];
178 }
179
180 static DEFINE_SPINLOCK(vfc_dev_lock);
181
182 static int vfc_open(struct inode *inode, struct file *file) 
183 {
184         struct vfc_dev *dev;
185
186         spin_lock(&vfc_dev_lock);
187         dev = vfc_get_dev_ptr(iminor(inode));
188         if (dev == NULL) {
189                 spin_unlock(&vfc_dev_lock);
190                 return -ENODEV;
191         }
192         if (dev->busy) {
193                 spin_unlock(&vfc_dev_lock);
194                 return -EBUSY;
195         }
196
197         dev->busy = 1;
198         spin_unlock(&vfc_dev_lock);
199
200         vfc_lock_device(dev);
201         
202         vfc_csr_init(dev);
203         vfc_pcf8584_init(dev);
204         vfc_init_i2c_bus(dev);
205         vfc_saa9051_init(dev);
206         vfc_memptr_reset(dev);
207         vfc_captstat_reset(dev);
208         
209         vfc_unlock_device(dev);
210         return 0;
211 }
212
213 static int vfc_release(struct inode *inode,struct file *file) 
214 {
215         struct vfc_dev *dev;
216
217         spin_lock(&vfc_dev_lock);
218         dev = vfc_get_dev_ptr(iminor(inode));
219         if (!dev || !dev->busy) {
220                 spin_unlock(&vfc_dev_lock);
221                 return -EINVAL;
222         }
223         dev->busy = 0;
224         spin_unlock(&vfc_dev_lock);
225         return 0;
226 }
227
228 static int vfc_debug(struct vfc_dev *dev, int cmd, void __user *argp)
229 {
230         struct vfc_debug_inout inout;
231         unsigned char *buffer;
232
233         if (!capable(CAP_SYS_ADMIN))
234                 return -EPERM;
235
236         switch(cmd) {
237         case VFC_I2C_SEND:
238                 if(copy_from_user(&inout, argp, sizeof(inout)))
239                         return -EFAULT;
240
241                 buffer = kmalloc(inout.len, GFP_KERNEL);
242                 if (buffer == NULL)
243                         return -ENOMEM;
244
245                 if(copy_from_user(buffer, inout.buffer, inout.len)) {
246                         kfree(buffer);
247                         return -EFAULT;
248                 }
249                 
250
251                 vfc_lock_device(dev);
252                 inout.ret=
253                         vfc_i2c_sendbuf(dev,inout.addr & 0xff,
254                                         buffer,inout.len);
255
256                 if (copy_to_user(argp,&inout,sizeof(inout))) {
257                         kfree(buffer);
258                         return -EFAULT;
259                 }
260                 vfc_unlock_device(dev);
261
262                 break;
263         case VFC_I2C_RECV:
264                 if (copy_from_user(&inout, argp, sizeof(inout)))
265                         return -EFAULT;
266
267                 buffer = kmalloc(inout.len, GFP_KERNEL);
268                 if (buffer == NULL)
269                         return -ENOMEM;
270
271                 memset(buffer,0,inout.len);
272                 vfc_lock_device(dev);
273                 inout.ret=
274                         vfc_i2c_recvbuf(dev,inout.addr & 0xff
275                                         ,buffer,inout.len);
276                 vfc_unlock_device(dev);
277                 
278                 if (copy_to_user(inout.buffer, buffer, inout.len)) {
279                         kfree(buffer);
280                         return -EFAULT;
281                 }
282                 if (copy_to_user(argp,&inout,sizeof(inout))) {
283                         kfree(buffer);
284                         return -EFAULT;
285                 }
286                 kfree(buffer);
287                 break;
288         default:
289                 return -EINVAL;
290         };
291
292         return 0;
293 }
294
295 int vfc_capture_start(struct vfc_dev *dev) 
296 {
297         vfc_captstat_reset(dev);
298         dev->control_reg = sbus_readl(&dev->regs->control);
299         if((dev->control_reg & VFC_STATUS_CAPTURE)) {
300                 printk(KERN_ERR "vfc%d: vfc capture status not reset\n",
301                        dev->instance);
302                 return -EIO;
303         }
304
305         vfc_lock_device(dev);
306         dev->control_reg &= ~VFC_CONTROL_CAPTURE;
307         sbus_writel(dev->control_reg, &dev->regs->control);
308         dev->control_reg |= VFC_CONTROL_CAPTURE;
309         sbus_writel(dev->control_reg, &dev->regs->control);
310         dev->control_reg &= ~VFC_CONTROL_CAPTURE;
311         sbus_writel(dev->control_reg, &dev->regs->control);
312         vfc_unlock_device(dev);
313
314         return 0;
315 }
316
317 int vfc_capture_poll(struct vfc_dev *dev) 
318 {
319         int timeout = 1000;
320
321         while (!timeout--) {
322                 if (dev->regs->control & VFC_STATUS_CAPTURE)
323                         break;
324                 vfc_i2c_delay_no_busy(dev, 100);
325         }
326         if(!timeout) {
327                 printk(KERN_WARNING "vfc%d: capture timed out\n",
328                        dev->instance);
329                 return -ETIMEDOUT;
330         }
331         return 0;
332 }
333
334
335
336 static int vfc_set_control_ioctl(struct inode *inode, struct file *file, 
337                           struct vfc_dev *dev, unsigned long arg) 
338 {
339         int setcmd, ret = 0;
340
341         if (copy_from_user(&setcmd,(void __user *)arg,sizeof(unsigned int)))
342                 return -EFAULT;
343
344         VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCSCTRL) arg=0x%x\n",
345                                 dev->instance,setcmd));
346
347         switch(setcmd) {
348         case MEMPRST:
349                 vfc_lock_device(dev);
350                 vfc_memptr_reset(dev);
351                 vfc_unlock_device(dev);
352                 ret=0;
353                 break;
354         case CAPTRCMD:
355                 vfc_capture_start(dev);
356                 vfc_capture_poll(dev);
357                 break;
358         case DIAGMODE:
359                 if(capable(CAP_SYS_ADMIN)) {
360                         vfc_lock_device(dev);
361                         dev->control_reg |= VFC_CONTROL_DIAGMODE;
362                         sbus_writel(dev->control_reg, &dev->regs->control);
363                         vfc_unlock_device(dev);
364                         ret = 0;
365                 } else {
366                         ret = -EPERM; 
367                 }
368                 break;
369         case NORMMODE:
370                 vfc_lock_device(dev);
371                 dev->control_reg &= ~VFC_CONTROL_DIAGMODE;
372                 sbus_writel(dev->control_reg, &dev->regs->control);
373                 vfc_unlock_device(dev);
374                 ret = 0;
375                 break;
376         case CAPTRSTR:
377                 vfc_capture_start(dev);
378                 ret = 0;
379                 break;
380         case CAPTRWAIT:
381                 vfc_capture_poll(dev);
382                 ret = 0;
383                 break;
384         default:
385                 ret = -EINVAL;
386                 break;
387         };
388
389         return ret;
390 }
391
392
393 int vfc_port_change_ioctl(struct inode *inode, struct file *file, 
394                           struct vfc_dev *dev, unsigned long arg) 
395 {
396         int ret = 0;
397         int cmd;
398
399         if(copy_from_user(&cmd, (void __user *)arg, sizeof(unsigned int))) {
400                 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: User passed bogus pointer to "
401                                         "vfc_port_change_ioctl\n",
402                                         dev->instance));
403                 return -EFAULT;
404         }
405         
406         VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCPORTCHG) arg=0x%x\n",
407                                 dev->instance, cmd));
408
409         switch(cmd) {
410         case 1:
411         case 2:
412                 VFC_SAA9051_SA(dev,VFC_SAA9051_HSY_START) = 0x72; 
413                 VFC_SAA9051_SA(dev,VFC_SAA9051_HSY_STOP) = 0x52;
414                 VFC_SAA9051_SA(dev,VFC_SAA9051_HC_START) = 0x36;
415                 VFC_SAA9051_SA(dev,VFC_SAA9051_HC_STOP) = 0x18;
416                 VFC_SAA9051_SA(dev,VFC_SAA9051_HORIZ_PEAK) = VFC_SAA9051_BP2;
417                 VFC_SAA9051_SA(dev,VFC_SAA9051_C3) = VFC_SAA9051_CT | VFC_SAA9051_SS3;
418                 VFC_SAA9051_SA(dev,VFC_SAA9051_SECAM_DELAY) = 0x3e;
419                 break;
420         case 3:
421                 VFC_SAA9051_SA(dev,VFC_SAA9051_HSY_START) = 0x3a;
422                 VFC_SAA9051_SA(dev,VFC_SAA9051_HSY_STOP) = 0x17;
423                 VFC_SAA9051_SA(dev,VFC_SAA9051_HC_START) = 0xfa;
424                 VFC_SAA9051_SA(dev,VFC_SAA9051_HC_STOP) = 0xde;
425                 VFC_SAA9051_SA(dev,VFC_SAA9051_HORIZ_PEAK) =
426                         VFC_SAA9051_BY | VFC_SAA9051_PF | VFC_SAA9051_BP2;
427                 VFC_SAA9051_SA(dev,VFC_SAA9051_C3) = VFC_SAA9051_YC;
428                 VFC_SAA9051_SA(dev,VFC_SAA9051_SECAM_DELAY) = 0;
429                 VFC_SAA9051_SA(dev,VFC_SAA9051_C2) &=
430                         ~(VFC_SAA9051_SS0 | VFC_SAA9051_SS1);
431                 break;
432         default:
433                 ret = -EINVAL;
434                 return ret;
435                 break;
436         }
437
438         switch(cmd) {
439         case 1:
440                 VFC_SAA9051_SA(dev,VFC_SAA9051_C2) |=
441                         (VFC_SAA9051_SS0 | VFC_SAA9051_SS1);
442                 break;
443         case 2:
444                 VFC_SAA9051_SA(dev,VFC_SAA9051_C2) &=
445                         ~(VFC_SAA9051_SS0 | VFC_SAA9051_SS1);
446                 VFC_SAA9051_SA(dev,VFC_SAA9051_C2) |= VFC_SAA9051_SS0; 
447                 break;
448         case 3:
449                 break;
450         default:
451                 ret = -EINVAL;
452                 return ret;
453                 break;
454         }
455         VFC_SAA9051_SA(dev,VFC_SAA9051_C3) &= ~(VFC_SAA9051_SS2);
456         ret=vfc_update_saa9051(dev);
457         udelay(500);
458         VFC_SAA9051_SA(dev,VFC_SAA9051_C3) |= (VFC_SAA9051_SS2);
459         ret=vfc_update_saa9051(dev);
460         return ret;
461 }
462
463 int vfc_set_video_ioctl(struct inode *inode, struct file *file, 
464                         struct vfc_dev *dev, unsigned long arg) 
465 {
466         int ret = 0;
467         int cmd;
468
469         if(copy_from_user(&cmd, (void __user *)arg, sizeof(unsigned int))) {
470                 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: User passed bogus pointer to "
471                                         "vfc_set_video_ioctl\n",
472                                         dev->instance));
473                 return ret;
474         }
475         
476         VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCSVID) arg=0x%x\n",
477                                 dev->instance, cmd));
478         switch(cmd) {
479         case STD_NTSC:
480                 VFC_SAA9051_SA(dev,VFC_SAA9051_C1) &= ~VFC_SAA9051_ALT;
481                 VFC_SAA9051_SA(dev,VFC_SAA9051_C1) |= VFC_SAA9051_YPN | 
482                         VFC_SAA9051_CCFR0 | VFC_SAA9051_CCFR1 | VFC_SAA9051_FS;
483                 ret = vfc_update_saa9051(dev);
484                 break;
485         case STD_PAL:
486                 VFC_SAA9051_SA(dev,VFC_SAA9051_C1) &= ~(VFC_SAA9051_YPN | 
487                                                         VFC_SAA9051_CCFR1 | 
488                                                         VFC_SAA9051_CCFR0 |
489                                                         VFC_SAA9051_FS);
490                 VFC_SAA9051_SA(dev,VFC_SAA9051_C1) |= VFC_SAA9051_ALT;
491                 ret = vfc_update_saa9051(dev);
492                 break;
493
494         case COLOR_ON:
495                 VFC_SAA9051_SA(dev,VFC_SAA9051_C1) |= VFC_SAA9051_CO;
496                 VFC_SAA9051_SA(dev,VFC_SAA9051_HORIZ_PEAK) &=
497                         ~(VFC_SAA9051_BY | VFC_SAA9051_PF);
498                 ret = vfc_update_saa9051(dev);
499                 break;
500         case MONO:
501                 VFC_SAA9051_SA(dev,VFC_SAA9051_C1) &= ~(VFC_SAA9051_CO);
502                 VFC_SAA9051_SA(dev,VFC_SAA9051_HORIZ_PEAK) |=
503                         (VFC_SAA9051_BY | VFC_SAA9051_PF);
504                 ret = vfc_update_saa9051(dev);
505                 break;
506         default:
507                 ret = -EINVAL;
508                 break;
509         };
510
511         return ret;
512 }
513
514 int vfc_get_video_ioctl(struct inode *inode, struct file *file, 
515                         struct vfc_dev *dev, unsigned long arg) 
516 {
517         int ret = 0;
518         unsigned int status = NO_LOCK;
519         unsigned char buf[1];
520
521         if(vfc_i2c_recvbuf(dev, VFC_SAA9051_ADDR, buf, 1)) {
522                 printk(KERN_ERR "vfc%d: Unable to get status\n",
523                        dev->instance);
524                 return -EIO;
525         }
526
527         if(buf[0] & VFC_SAA9051_HLOCK) {
528                 status = NO_LOCK;
529         } else if(buf[0] & VFC_SAA9051_FD) {
530                 if(buf[0] & VFC_SAA9051_CD)
531                         status = NTSC_COLOR;
532                 else
533                         status = NTSC_NOCOLOR;
534         } else {
535                 if(buf[0] & VFC_SAA9051_CD)
536                         status = PAL_COLOR;
537                 else
538                         status = PAL_NOCOLOR;
539         }
540         VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCGVID) returning status 0x%x; "
541                                 "buf[0]=%x\n", dev->instance, status, buf[0]));
542
543         if (copy_to_user((void __user *)arg,&status,sizeof(unsigned int))) {
544                 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: User passed bogus pointer to "
545                                         "vfc_get_video_ioctl\n",
546                                         dev->instance));
547                 return ret;
548         }
549         return ret;
550 }
551
552 static int vfc_ioctl(struct inode *inode, struct file *file, unsigned int cmd,
553               unsigned long arg) 
554 {
555         int ret = 0;
556         unsigned int tmp;
557         struct vfc_dev *dev;
558         void __user *argp = (void __user *)arg;
559
560         dev = vfc_get_dev_ptr(iminor(inode));
561         if(dev == NULL)
562                 return -ENODEV;
563         
564         switch(cmd & 0x0000ffff) {
565         case VFCGCTRL:
566 #if 0
567                 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCGCTRL)\n", dev->instance));
568 #endif
569                 tmp = sbus_readl(&dev->regs->control);
570                 if(copy_to_user(argp, &tmp, sizeof(unsigned int))) {
571                         ret = -EFAULT;
572                         break;
573                 }
574                 ret = 0;
575                 break;
576         case VFCSCTRL:
577                 ret = vfc_set_control_ioctl(inode, file, dev, arg);
578                 break;
579         case VFCGVID:
580                 ret = vfc_get_video_ioctl(inode, file, dev, arg);
581                 break;
582         case VFCSVID:
583                 ret = vfc_set_video_ioctl(inode, file, dev, arg);
584                 break;
585         case VFCHUE:
586                 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCHUE)\n", dev->instance));
587                 if(copy_from_user(&tmp,argp,sizeof(unsigned int))) {
588                         VFC_IOCTL_DEBUG_PRINTK(("vfc%d: User passed bogus pointer "
589                                                 "to IOCTL(VFCHUE)", dev->instance));
590                         ret = -EFAULT;
591                 } else {
592                         VFC_SAA9051_SA(dev,VFC_SAA9051_HUE) = tmp;
593                         vfc_update_saa9051(dev);
594                         ret = 0;
595                 }
596                 break;
597         case VFCPORTCHG:
598                 ret = vfc_port_change_ioctl(inode, file, dev, arg);
599                 break;
600         case VFCRDINFO:
601                 ret = -EINVAL;
602                 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCRDINFO)\n", dev->instance));
603                 break;
604         default:
605                 ret = vfc_debug(vfc_get_dev_ptr(iminor(inode)), cmd, argp);
606                 break;
607         };
608
609         return ret;
610 }
611
612 static int vfc_mmap(struct file *file, struct vm_area_struct *vma) 
613 {
614         unsigned int map_size, ret, map_offset;
615         struct vfc_dev *dev;
616         
617         dev = vfc_get_dev_ptr(iminor(file->f_dentry->d_inode));
618         if(dev == NULL)
619                 return -ENODEV;
620
621         map_size = vma->vm_end - vma->vm_start;
622         if(map_size > sizeof(struct vfc_regs)) 
623                 map_size = sizeof(struct vfc_regs);
624
625         vma->vm_flags |=
626                 (VM_SHM | VM_LOCKED | VM_IO | VM_MAYREAD | VM_MAYWRITE | VM_MAYSHARE);
627         map_offset = (unsigned int) (long)dev->phys_regs;
628         ret = io_remap_pfn_range(vma, vma->vm_start,
629                                   MK_IOSPACE_PFN(dev->which_io,
630                                         map_offset >> PAGE_SHIFT),
631                                   map_size, vma->vm_page_prot);
632
633         if(ret)
634                 return -EAGAIN;
635
636         return 0;
637 }
638
639
640 static struct file_operations vfc_fops = {
641         .owner =        THIS_MODULE,
642         .llseek =       no_llseek,
643         .ioctl =        vfc_ioctl,
644         .mmap =         vfc_mmap,
645         .open =         vfc_open,
646         .release =      vfc_release,
647 };
648
649 static int vfc_probe(void)
650 {
651         struct sbus_bus *sbus;
652         struct sbus_dev *sdev = NULL;
653         int ret;
654         int instance = 0, cards = 0;
655
656         for_all_sbusdev(sdev, sbus) {
657                 if (strcmp(sdev->prom_name, "vfc") == 0) {
658                         cards++;
659                         continue;
660                 }
661         }
662
663         if (!cards)
664                 return -ENODEV;
665
666         vfc_dev_lst = (struct vfc_dev **)kmalloc(sizeof(struct vfc_dev *) *
667                                                  (cards+1),
668                                                  GFP_KERNEL);
669         if (vfc_dev_lst == NULL)
670                 return -ENOMEM;
671         memset(vfc_dev_lst, 0, sizeof(struct vfc_dev *) * (cards + 1));
672         vfc_dev_lst[cards] = NULL;
673
674         ret = register_chrdev(VFC_MAJOR, vfcstr, &vfc_fops);
675         if(ret) {
676                 printk(KERN_ERR "Unable to get major number %d\n", VFC_MAJOR);
677                 kfree(vfc_dev_lst);
678                 return -EIO;
679         }
680         devfs_mk_dir("vfc");
681         instance = 0;
682         for_all_sbusdev(sdev, sbus) {
683                 if (strcmp(sdev->prom_name, "vfc") == 0) {
684                         vfc_dev_lst[instance]=(struct vfc_dev *)
685                                 kmalloc(sizeof(struct vfc_dev), GFP_KERNEL);
686                         if (vfc_dev_lst[instance] == NULL)
687                                 return -ENOMEM;
688                         ret = init_vfc_device(sdev,
689                                               vfc_dev_lst[instance],
690                                               instance);
691                         if(ret) {
692                                 printk(KERN_ERR "Unable to initialize"
693                                        " vfc%d device\n",
694                                        instance);
695                         } else {
696                         }
697                 
698                         instance++;
699                         continue;
700                 }
701         }
702
703         return 0;
704 }
705
706 #ifdef MODULE
707 int init_module(void)
708 #else 
709 int vfc_init(void)
710 #endif
711 {
712         return vfc_probe();
713 }
714
715 #ifdef MODULE
716 static void deinit_vfc_device(struct vfc_dev *dev)
717 {
718         if(dev == NULL)
719                 return;
720         devfs_remove("vfc/%d", dev->instance);
721         sbus_iounmap((unsigned long)dev->regs, sizeof(struct vfc_regs));
722         kfree(dev);
723 }
724
725 void cleanup_module(void)
726 {
727         struct vfc_dev **devp;
728
729         unregister_chrdev(VFC_MAJOR,vfcstr);
730
731         for (devp = vfc_dev_lst; *devp; devp++)
732                 deinit_vfc_device(*devp);
733
734         devfs_remove("vfc");
735         kfree(vfc_dev_lst);
736         return;
737 }
738 #endif
739
740 MODULE_LICENSE("GPL");
741