2 * drivers/sbus/char/vfc_dev.c
4 * Driver for the Videopix Frame Grabber.
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.
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.
14 * Copyright (C) 1996 Manish Vachharajani (mvachhar@noc.rutgers.edu)
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>
24 #include <linux/smp_lock.h>
25 #include <linux/delay.h>
26 #include <linux/spinlock.h>
29 #include <asm/openprom.h>
30 #include <asm/oplib.h>
32 #include <asm/system.h>
35 #include <asm/pgtable.h>
36 #include <asm/uaccess.h>
38 #define VFC_MAJOR (60)
41 #define VFC_IOCTL_DEBUG
45 #include <asm/vfc_ioctls.h>
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,
57 void vfc_lock_device(struct vfc_dev
*dev
)
59 down(&dev
->device_lock_sem
);
62 void vfc_unlock_device(struct vfc_dev
*dev
)
64 up(&dev
->device_lock_sem
);
68 void vfc_captstat_reset(struct vfc_dev
*dev
)
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
);
78 void vfc_memptr_reset(struct vfc_dev
*dev
)
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
);
88 int vfc_csr_init(struct vfc_dev
*dev
)
90 dev
->control_reg
= 0x80000000;
91 sbus_writel(dev
->control_reg
, &dev
->regs
->control
);
93 dev
->control_reg
&= ~0x80000000;
94 sbus_writel(dev
->control_reg
, &dev
->regs
->control
);
96 sbus_writel(0x0f000000, &dev
->regs
->i2c_magic2
);
98 vfc_memptr_reset(dev
);
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
);
105 vfc_captstat_reset(dev
);
110 int vfc_saa9051_init(struct vfc_dev
*dev
)
114 for (i
= 0; i
< VFC_SAA9051_NR
; i
++)
115 dev
->saa9051_state_array
[i
] = saa9051_init_array
[i
];
117 vfc_i2c_sendbuf(dev
,VFC_SAA9051_ADDR
,
118 dev
->saa9051_state_array
, VFC_SAA9051_NR
);
122 int init_vfc_hw(struct vfc_dev
*dev
)
124 vfc_lock_device(dev
);
127 vfc_pcf8584_init(dev
);
128 vfc_init_i2c_bus(dev
); /* hopefully this doesn't undo the magic
130 vfc_saa9051_init(dev
);
131 vfc_unlock_device(dev
);
135 int init_vfc_devstruct(struct vfc_dev
*dev
, int instance
)
137 dev
->instance
=instance
;
138 init_MUTEX(&dev
->device_lock_sem
);
144 int init_vfc_device(struct sbus_dev
*sdev
,struct vfc_dev
*dev
, int instance
)
147 printk(KERN_ERR
"VFC: Bogus pointer passed\n");
150 printk("Initializing vfc%d\n",instance
);
152 dev
->regs
= (volatile struct vfc_regs __iomem
*)
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
)
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
);
163 if (init_vfc_devstruct(dev
, instance
))
165 if (init_vfc_hw(dev
))
171 struct vfc_dev
*vfc_get_dev_ptr(int instance
)
173 return vfc_dev_lst
[instance
];
176 static DEFINE_SPINLOCK(vfc_dev_lock
);
178 static int vfc_open(struct inode
*inode
, struct file
*file
)
182 spin_lock(&vfc_dev_lock
);
183 dev
= vfc_get_dev_ptr(iminor(inode
));
185 spin_unlock(&vfc_dev_lock
);
189 spin_unlock(&vfc_dev_lock
);
194 spin_unlock(&vfc_dev_lock
);
196 vfc_lock_device(dev
);
199 vfc_pcf8584_init(dev
);
200 vfc_init_i2c_bus(dev
);
201 vfc_saa9051_init(dev
);
202 vfc_memptr_reset(dev
);
203 vfc_captstat_reset(dev
);
205 vfc_unlock_device(dev
);
209 static int vfc_release(struct inode
*inode
,struct file
*file
)
213 spin_lock(&vfc_dev_lock
);
214 dev
= vfc_get_dev_ptr(iminor(inode
));
215 if (!dev
|| !dev
->busy
) {
216 spin_unlock(&vfc_dev_lock
);
220 spin_unlock(&vfc_dev_lock
);
224 static int vfc_debug(struct vfc_dev
*dev
, int cmd
, void __user
*argp
)
226 struct vfc_debug_inout inout
;
227 unsigned char *buffer
;
229 if (!capable(CAP_SYS_ADMIN
))
234 if(copy_from_user(&inout
, argp
, sizeof(inout
)))
237 buffer
= kmalloc(inout
.len
, GFP_KERNEL
);
241 if(copy_from_user(buffer
, inout
.buffer
, inout
.len
)) {
247 vfc_lock_device(dev
);
249 vfc_i2c_sendbuf(dev
,inout
.addr
& 0xff,
252 if (copy_to_user(argp
,&inout
,sizeof(inout
))) {
256 vfc_unlock_device(dev
);
260 if (copy_from_user(&inout
, argp
, sizeof(inout
)))
263 buffer
= kmalloc(inout
.len
, GFP_KERNEL
);
267 memset(buffer
,0,inout
.len
);
268 vfc_lock_device(dev
);
270 vfc_i2c_recvbuf(dev
,inout
.addr
& 0xff
272 vfc_unlock_device(dev
);
274 if (copy_to_user(inout
.buffer
, buffer
, inout
.len
)) {
278 if (copy_to_user(argp
,&inout
,sizeof(inout
))) {
291 int vfc_capture_start(struct vfc_dev
*dev
)
293 vfc_captstat_reset(dev
);
294 dev
->control_reg
= sbus_readl(&dev
->regs
->control
);
295 if((dev
->control_reg
& VFC_STATUS_CAPTURE
)) {
296 printk(KERN_ERR
"vfc%d: vfc capture status not reset\n",
301 vfc_lock_device(dev
);
302 dev
->control_reg
&= ~VFC_CONTROL_CAPTURE
;
303 sbus_writel(dev
->control_reg
, &dev
->regs
->control
);
304 dev
->control_reg
|= VFC_CONTROL_CAPTURE
;
305 sbus_writel(dev
->control_reg
, &dev
->regs
->control
);
306 dev
->control_reg
&= ~VFC_CONTROL_CAPTURE
;
307 sbus_writel(dev
->control_reg
, &dev
->regs
->control
);
308 vfc_unlock_device(dev
);
313 int vfc_capture_poll(struct vfc_dev
*dev
)
318 if (sbus_readl(&dev
->regs
->control
) & VFC_STATUS_CAPTURE
)
320 vfc_i2c_delay_no_busy(dev
, 100);
323 printk(KERN_WARNING
"vfc%d: capture timed out\n",
332 static int vfc_set_control_ioctl(struct inode
*inode
, struct file
*file
,
333 struct vfc_dev
*dev
, unsigned long arg
)
337 if (copy_from_user(&setcmd
,(void __user
*)arg
,sizeof(unsigned int)))
340 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCSCTRL) arg=0x%x\n",
341 dev
->instance
,setcmd
));
345 vfc_lock_device(dev
);
346 vfc_memptr_reset(dev
);
347 vfc_unlock_device(dev
);
351 vfc_capture_start(dev
);
352 vfc_capture_poll(dev
);
355 if(capable(CAP_SYS_ADMIN
)) {
356 vfc_lock_device(dev
);
357 dev
->control_reg
|= VFC_CONTROL_DIAGMODE
;
358 sbus_writel(dev
->control_reg
, &dev
->regs
->control
);
359 vfc_unlock_device(dev
);
366 vfc_lock_device(dev
);
367 dev
->control_reg
&= ~VFC_CONTROL_DIAGMODE
;
368 sbus_writel(dev
->control_reg
, &dev
->regs
->control
);
369 vfc_unlock_device(dev
);
373 vfc_capture_start(dev
);
377 vfc_capture_poll(dev
);
389 int vfc_port_change_ioctl(struct inode
*inode
, struct file
*file
,
390 struct vfc_dev
*dev
, unsigned long arg
)
395 if(copy_from_user(&cmd
, (void __user
*)arg
, sizeof(unsigned int))) {
396 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: User passed bogus pointer to "
397 "vfc_port_change_ioctl\n",
402 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCPORTCHG) arg=0x%x\n",
403 dev
->instance
, cmd
));
408 VFC_SAA9051_SA(dev
,VFC_SAA9051_HSY_START
) = 0x72;
409 VFC_SAA9051_SA(dev
,VFC_SAA9051_HSY_STOP
) = 0x52;
410 VFC_SAA9051_SA(dev
,VFC_SAA9051_HC_START
) = 0x36;
411 VFC_SAA9051_SA(dev
,VFC_SAA9051_HC_STOP
) = 0x18;
412 VFC_SAA9051_SA(dev
,VFC_SAA9051_HORIZ_PEAK
) = VFC_SAA9051_BP2
;
413 VFC_SAA9051_SA(dev
,VFC_SAA9051_C3
) = VFC_SAA9051_CT
| VFC_SAA9051_SS3
;
414 VFC_SAA9051_SA(dev
,VFC_SAA9051_SECAM_DELAY
) = 0x3e;
417 VFC_SAA9051_SA(dev
,VFC_SAA9051_HSY_START
) = 0x3a;
418 VFC_SAA9051_SA(dev
,VFC_SAA9051_HSY_STOP
) = 0x17;
419 VFC_SAA9051_SA(dev
,VFC_SAA9051_HC_START
) = 0xfa;
420 VFC_SAA9051_SA(dev
,VFC_SAA9051_HC_STOP
) = 0xde;
421 VFC_SAA9051_SA(dev
,VFC_SAA9051_HORIZ_PEAK
) =
422 VFC_SAA9051_BY
| VFC_SAA9051_PF
| VFC_SAA9051_BP2
;
423 VFC_SAA9051_SA(dev
,VFC_SAA9051_C3
) = VFC_SAA9051_YC
;
424 VFC_SAA9051_SA(dev
,VFC_SAA9051_SECAM_DELAY
) = 0;
425 VFC_SAA9051_SA(dev
,VFC_SAA9051_C2
) &=
426 ~(VFC_SAA9051_SS0
| VFC_SAA9051_SS1
);
436 VFC_SAA9051_SA(dev
,VFC_SAA9051_C2
) |=
437 (VFC_SAA9051_SS0
| VFC_SAA9051_SS1
);
440 VFC_SAA9051_SA(dev
,VFC_SAA9051_C2
) &=
441 ~(VFC_SAA9051_SS0
| VFC_SAA9051_SS1
);
442 VFC_SAA9051_SA(dev
,VFC_SAA9051_C2
) |= VFC_SAA9051_SS0
;
451 VFC_SAA9051_SA(dev
,VFC_SAA9051_C3
) &= ~(VFC_SAA9051_SS2
);
452 ret
=vfc_update_saa9051(dev
);
454 VFC_SAA9051_SA(dev
,VFC_SAA9051_C3
) |= (VFC_SAA9051_SS2
);
455 ret
=vfc_update_saa9051(dev
);
459 int vfc_set_video_ioctl(struct inode
*inode
, struct file
*file
,
460 struct vfc_dev
*dev
, unsigned long arg
)
465 if(copy_from_user(&cmd
, (void __user
*)arg
, sizeof(unsigned int))) {
466 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: User passed bogus pointer to "
467 "vfc_set_video_ioctl\n",
472 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCSVID) arg=0x%x\n",
473 dev
->instance
, cmd
));
476 VFC_SAA9051_SA(dev
,VFC_SAA9051_C1
) &= ~VFC_SAA9051_ALT
;
477 VFC_SAA9051_SA(dev
,VFC_SAA9051_C1
) |= VFC_SAA9051_YPN
|
478 VFC_SAA9051_CCFR0
| VFC_SAA9051_CCFR1
| VFC_SAA9051_FS
;
479 ret
= vfc_update_saa9051(dev
);
482 VFC_SAA9051_SA(dev
,VFC_SAA9051_C1
) &= ~(VFC_SAA9051_YPN
|
486 VFC_SAA9051_SA(dev
,VFC_SAA9051_C1
) |= VFC_SAA9051_ALT
;
487 ret
= vfc_update_saa9051(dev
);
491 VFC_SAA9051_SA(dev
,VFC_SAA9051_C1
) |= VFC_SAA9051_CO
;
492 VFC_SAA9051_SA(dev
,VFC_SAA9051_HORIZ_PEAK
) &=
493 ~(VFC_SAA9051_BY
| VFC_SAA9051_PF
);
494 ret
= vfc_update_saa9051(dev
);
497 VFC_SAA9051_SA(dev
,VFC_SAA9051_C1
) &= ~(VFC_SAA9051_CO
);
498 VFC_SAA9051_SA(dev
,VFC_SAA9051_HORIZ_PEAK
) |=
499 (VFC_SAA9051_BY
| VFC_SAA9051_PF
);
500 ret
= vfc_update_saa9051(dev
);
510 int vfc_get_video_ioctl(struct inode
*inode
, struct file
*file
,
511 struct vfc_dev
*dev
, unsigned long arg
)
514 unsigned int status
= NO_LOCK
;
515 unsigned char buf
[1];
517 if(vfc_i2c_recvbuf(dev
, VFC_SAA9051_ADDR
, buf
, 1)) {
518 printk(KERN_ERR
"vfc%d: Unable to get status\n",
523 if(buf
[0] & VFC_SAA9051_HLOCK
) {
525 } else if(buf
[0] & VFC_SAA9051_FD
) {
526 if(buf
[0] & VFC_SAA9051_CD
)
529 status
= NTSC_NOCOLOR
;
531 if(buf
[0] & VFC_SAA9051_CD
)
534 status
= PAL_NOCOLOR
;
536 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCGVID) returning status 0x%x; "
537 "buf[0]=%x\n", dev
->instance
, status
, buf
[0]));
539 if (copy_to_user((void __user
*)arg
,&status
,sizeof(unsigned int))) {
540 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: User passed bogus pointer to "
541 "vfc_get_video_ioctl\n",
548 static int vfc_ioctl(struct inode
*inode
, struct file
*file
, unsigned int cmd
,
554 void __user
*argp
= (void __user
*)arg
;
556 dev
= vfc_get_dev_ptr(iminor(inode
));
560 switch(cmd
& 0x0000ffff) {
563 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCGCTRL)\n", dev
->instance
));
565 tmp
= sbus_readl(&dev
->regs
->control
);
566 if(copy_to_user(argp
, &tmp
, sizeof(unsigned int))) {
573 ret
= vfc_set_control_ioctl(inode
, file
, dev
, arg
);
576 ret
= vfc_get_video_ioctl(inode
, file
, dev
, arg
);
579 ret
= vfc_set_video_ioctl(inode
, file
, dev
, arg
);
582 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCHUE)\n", dev
->instance
));
583 if(copy_from_user(&tmp
,argp
,sizeof(unsigned int))) {
584 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: User passed bogus pointer "
585 "to IOCTL(VFCHUE)", dev
->instance
));
588 VFC_SAA9051_SA(dev
,VFC_SAA9051_HUE
) = tmp
;
589 vfc_update_saa9051(dev
);
594 ret
= vfc_port_change_ioctl(inode
, file
, dev
, arg
);
598 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCRDINFO)\n", dev
->instance
));
601 ret
= vfc_debug(vfc_get_dev_ptr(iminor(inode
)), cmd
, argp
);
608 static int vfc_mmap(struct file
*file
, struct vm_area_struct
*vma
)
610 unsigned int map_size
, ret
, map_offset
;
613 dev
= vfc_get_dev_ptr(iminor(file
->f_dentry
->d_inode
));
617 map_size
= vma
->vm_end
- vma
->vm_start
;
618 if(map_size
> sizeof(struct vfc_regs
))
619 map_size
= sizeof(struct vfc_regs
);
622 (VM_MAYREAD
| VM_MAYWRITE
| VM_MAYSHARE
);
623 map_offset
= (unsigned int) (long)dev
->phys_regs
;
624 ret
= io_remap_pfn_range(vma
, vma
->vm_start
,
625 MK_IOSPACE_PFN(dev
->which_io
,
626 map_offset
>> PAGE_SHIFT
),
627 map_size
, vma
->vm_page_prot
);
636 static struct file_operations vfc_fops
= {
637 .owner
= THIS_MODULE
,
642 .release
= vfc_release
,
645 static int vfc_probe(void)
647 struct sbus_bus
*sbus
;
648 struct sbus_dev
*sdev
= NULL
;
650 int instance
= 0, cards
= 0;
652 for_all_sbusdev(sdev
, sbus
) {
653 if (strcmp(sdev
->prom_name
, "vfc") == 0) {
662 vfc_dev_lst
= (struct vfc_dev
**)kmalloc(sizeof(struct vfc_dev
*) *
665 if (vfc_dev_lst
== NULL
)
667 memset(vfc_dev_lst
, 0, sizeof(struct vfc_dev
*) * (cards
+ 1));
668 vfc_dev_lst
[cards
] = NULL
;
670 ret
= register_chrdev(VFC_MAJOR
, vfcstr
, &vfc_fops
);
672 printk(KERN_ERR
"Unable to get major number %d\n", VFC_MAJOR
);
677 for_all_sbusdev(sdev
, sbus
) {
678 if (strcmp(sdev
->prom_name
, "vfc") == 0) {
679 vfc_dev_lst
[instance
]=(struct vfc_dev
*)
680 kmalloc(sizeof(struct vfc_dev
), GFP_KERNEL
);
681 if (vfc_dev_lst
[instance
] == NULL
)
683 ret
= init_vfc_device(sdev
,
684 vfc_dev_lst
[instance
],
687 printk(KERN_ERR
"Unable to initialize"
702 int init_module(void)
711 static void deinit_vfc_device(struct vfc_dev
*dev
)
715 sbus_iounmap(dev
->regs
, sizeof(struct vfc_regs
));
719 void cleanup_module(void)
721 struct vfc_dev
**devp
;
723 unregister_chrdev(VFC_MAJOR
,vfcstr
);
725 for (devp
= vfc_dev_lst
; *devp
; devp
++)
726 deinit_vfc_device(*devp
);
733 MODULE_LICENSE("GPL");