int vfc_get_video_ioctl(struct inode *inode, struct file *file, struct vfc_dev *dev, unsigned long arg) { int ret=0; unsigned int status=NO_LOCK; unsigned char buf[1]; if(vfc_i2c_recvbuf(dev,VFC_SAA9051_ADDR,buf,1)) { printk(KERN_ERR "vfc%d: Unable to get status\n",dev->instance); return -EIO; } if(buf[0] & VFC_SAA9051_HLOCK) { status = NO_LOCK; } else if(buf[0] & VFC_SAA9051_FD) { if(buf[0] & VFC_SAA9051_CD) status=NTSC_COLOR; else status=NTSC_NOCOLOR; } else { if(buf[0] & VFC_SAA9051_CD) status=PAL_COLOR; else status=PAL_NOCOLOR; } VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCGVID) returning status 0x%x; buf[0]=%x\n",dev->instance, status,buf[0])); if (copy_to_user((void *)arg,&status,sizeof(unsigned int))) { VFC_IOCTL_DEBUG_PRINTK(("vfc%d: User passed bogus pointer to " "vfc_get_video_ioctl\n",dev->instance)); return ret; } return ret; }
static int vfc_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg) { int ret = 0; unsigned int tmp; struct vfc_dev *dev; dev = vfc_get_dev_ptr(MINOR(inode->i_rdev)); if(dev == NULL) return -ENODEV; switch(cmd & 0x0000ffff) { case VFCGCTRL: #if 0 VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCGCTRL)\n", dev->instance)); #endif tmp = sbus_readl(&dev->regs->control); if(copy_to_user((void *)arg, &tmp, sizeof(unsigned int))) { ret = -EFAULT; break; } ret = 0; break; case VFCSCTRL: ret = vfc_set_control_ioctl(inode, file, dev, arg); break; case VFCGVID: ret = vfc_get_video_ioctl(inode, file, dev, arg); break; case VFCSVID: ret = vfc_set_video_ioctl(inode, file, dev, arg); break; case VFCHUE: VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCHUE)\n", dev->instance)); if(copy_from_user(&tmp,(void *)arg,sizeof(unsigned int))) { VFC_IOCTL_DEBUG_PRINTK(("vfc%d: User passed bogus pointer " "to IOCTL(VFCHUE)", dev->instance)); ret = -EFAULT; } else { VFC_SAA9051_SA(dev,VFC_SAA9051_HUE) = tmp; vfc_update_saa9051(dev); ret = 0; } break; case VFCPORTCHG: ret = vfc_port_change_ioctl(inode, file, dev, arg); break; case VFCRDINFO: ret = -EINVAL; VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCRDINFO)\n", dev->instance)); break; default: ret = vfc_debug(vfc_get_dev_ptr(MINOR(inode->i_rdev)), cmd, arg); break; }; return ret; }
int vfc_set_video_ioctl(struct inode *inode, struct file *file, struct vfc_dev *dev, unsigned long arg) { int ret = 0; int cmd; if(copy_from_user(&cmd, (void *)arg, sizeof(unsigned int))) { VFC_IOCTL_DEBUG_PRINTK(("vfc%d: User passed bogus pointer to " "vfc_set_video_ioctl\n", dev->instance)); return ret; } VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCSVID) arg=0x%x\n", dev->instance, cmd)); switch(cmd) { case STD_NTSC: VFC_SAA9051_SA(dev,VFC_SAA9051_C1) &= ~VFC_SAA9051_ALT; VFC_SAA9051_SA(dev,VFC_SAA9051_C1) |= VFC_SAA9051_YPN | VFC_SAA9051_CCFR0 | VFC_SAA9051_CCFR1 | VFC_SAA9051_FS; ret = vfc_update_saa9051(dev); break; case STD_PAL: VFC_SAA9051_SA(dev,VFC_SAA9051_C1) &= ~(VFC_SAA9051_YPN | VFC_SAA9051_CCFR1 | VFC_SAA9051_CCFR0 | VFC_SAA9051_FS); VFC_SAA9051_SA(dev,VFC_SAA9051_C1) |= VFC_SAA9051_ALT; ret = vfc_update_saa9051(dev); break; case COLOR_ON: VFC_SAA9051_SA(dev,VFC_SAA9051_C1) |= VFC_SAA9051_CO; VFC_SAA9051_SA(dev,VFC_SAA9051_HORIZ_PEAK) &= ~(VFC_SAA9051_BY | VFC_SAA9051_PF); ret = vfc_update_saa9051(dev); break; case MONO: VFC_SAA9051_SA(dev,VFC_SAA9051_C1) &= ~(VFC_SAA9051_CO); VFC_SAA9051_SA(dev,VFC_SAA9051_HORIZ_PEAK) |= (VFC_SAA9051_BY | VFC_SAA9051_PF); ret = vfc_update_saa9051(dev); break; default: ret = -EINVAL; break; }; return ret; }
static int vfc_set_control_ioctl(struct inode *inode, struct file *file, struct vfc_dev *dev, unsigned long arg) { int setcmd, ret = 0; if (copy_from_user(&setcmd,(void *)arg,sizeof(unsigned int))) return -EFAULT; VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCSCTRL) arg=0x%x\n", dev->instance,setcmd)); switch(setcmd) { case MEMPRST: vfc_lock_device(dev); vfc_memptr_reset(dev); vfc_unlock_device(dev); ret=0; break; case CAPTRCMD: vfc_capture_start(dev); vfc_capture_poll(dev); break; case DIAGMODE: if(capable(CAP_SYS_ADMIN)) { vfc_lock_device(dev); dev->control_reg |= VFC_CONTROL_DIAGMODE; sbus_writel(dev->control_reg, &dev->regs->control); vfc_unlock_device(dev); ret = 0; } else { ret = -EPERM; } break; case NORMMODE: vfc_lock_device(dev); dev->control_reg &= ~VFC_CONTROL_DIAGMODE; sbus_writel(dev->control_reg, &dev->regs->control); vfc_unlock_device(dev); ret = 0; break; case CAPTRSTR: vfc_capture_start(dev); ret = 0; break; case CAPTRWAIT: vfc_capture_poll(dev); ret = 0; break; default: ret = -EINVAL; break; }; return ret; }
int vfc_port_change_ioctl(struct inode *inode, struct file *file, struct vfc_dev *dev, unsigned long arg) { int ret = 0; int cmd; if(copy_from_user(&cmd, (void *)arg, sizeof(unsigned int))) { VFC_IOCTL_DEBUG_PRINTK(("vfc%d: User passed bogus pointer to " "vfc_port_change_ioctl\n", dev->instance)); return -EFAULT; } VFC_IOCTL_DEBUG_PRINTK(("vfc%d: IOCTL(VFCPORTCHG) arg=0x%x\n", dev->instance, cmd)); switch(cmd) { case 1: case 2: VFC_SAA9051_SA(dev,VFC_SAA9051_HSY_START) = 0x72; VFC_SAA9051_SA(dev,VFC_SAA9051_HSY_STOP) = 0x52; VFC_SAA9051_SA(dev,VFC_SAA9051_HC_START) = 0x36; VFC_SAA9051_SA(dev,VFC_SAA9051_HC_STOP) = 0x18; VFC_SAA9051_SA(dev,VFC_SAA9051_HORIZ_PEAK) = VFC_SAA9051_BP2; VFC_SAA9051_SA(dev,VFC_SAA9051_C3) = VFC_SAA9051_CT | VFC_SAA9051_SS3; VFC_SAA9051_SA(dev,VFC_SAA9051_SECAM_DELAY) = 0x3e; break; case 3: VFC_SAA9051_SA(dev,VFC_SAA9051_HSY_START) = 0x3a; VFC_SAA9051_SA(dev,VFC_SAA9051_HSY_STOP) = 0x17; VFC_SAA9051_SA(dev,VFC_SAA9051_HC_START) = 0xfa; VFC_SAA9051_SA(dev,VFC_SAA9051_HC_STOP) = 0xde; VFC_SAA9051_SA(dev,VFC_SAA9051_HORIZ_PEAK) = VFC_SAA9051_BY | VFC_SAA9051_PF | VFC_SAA9051_BP2; VFC_SAA9051_SA(dev,VFC_SAA9051_C3) = VFC_SAA9051_YC; VFC_SAA9051_SA(dev,VFC_SAA9051_SECAM_DELAY) = 0; VFC_SAA9051_SA(dev,VFC_SAA9051_C2) &= ~(VFC_SAA9051_SS0 | VFC_SAA9051_SS1); break; default: ret = -EINVAL; return ret; break; } switch(cmd) { case 1: VFC_SAA9051_SA(dev,VFC_SAA9051_C2) |= (VFC_SAA9051_SS0 | VFC_SAA9051_SS1); break; case 2: VFC_SAA9051_SA(dev,VFC_SAA9051_C2) &= ~(VFC_SAA9051_SS0 | VFC_SAA9051_SS1); VFC_SAA9051_SA(dev,VFC_SAA9051_C2) |= VFC_SAA9051_SS0; break; case 3: break; default: ret = -EINVAL; return ret; break; } VFC_SAA9051_SA(dev,VFC_SAA9051_C3) &= ~(VFC_SAA9051_SS2); ret=vfc_update_saa9051(dev); udelay(500); VFC_SAA9051_SA(dev,VFC_SAA9051_C3) |= (VFC_SAA9051_SS2); ret=vfc_update_saa9051(dev); return ret; }