int vfc_saa9051_init(struct vfc_dev *dev) { int i; for(i=0;i<VFC_SAA9051_NR;i++) { dev->saa9051_state_array[i]=saa9051_init_array[i]; } vfc_i2c_sendbuf(dev,VFC_SAA9051_ADDR, dev->saa9051_state_array, VFC_SAA9051_NR); return 0; }
static int vfc_debug(struct vfc_dev *dev, int cmd, unsigned long arg) { struct vfc_debug_inout inout; unsigned char *buffer; if (!capable(CAP_SYS_ADMIN)) return -EPERM; switch(cmd) { case VFC_I2C_SEND: if(copy_from_user(&inout, (void *)arg, sizeof(inout))) return -EFAULT; buffer = kmalloc(inout.len*sizeof(char), GFP_KERNEL); if (buffer == NULL) return -ENOMEM; if(copy_from_user(buffer, inout.buffer, inout.len*sizeof(char))) { kfree(buffer); return -EFAULT; } vfc_lock_device(dev); inout.ret= vfc_i2c_sendbuf(dev,inout.addr & 0xff, inout.buffer,inout.len); if (copy_to_user((void *)arg,&inout,sizeof(inout))) { kfree(buffer); return -EFAULT; } vfc_unlock_device(dev); break; case VFC_I2C_RECV: if (copy_from_user(&inout, (void *)arg, sizeof(inout))) return -EFAULT; buffer = kmalloc(inout.len, GFP_KERNEL); if (buffer == NULL) return -ENOMEM; memset(buffer,0,inout.len*sizeof(char)); vfc_lock_device(dev); inout.ret= vfc_i2c_recvbuf(dev,inout.addr & 0xff ,buffer,inout.len); vfc_unlock_device(dev); if (copy_to_user(inout.buffer, buffer, inout.len)) { kfree(buffer); return -EFAULT; } if (copy_to_user((void *)arg,&inout,sizeof(inout))) { kfree(buffer); return -EFAULT; } kfree(buffer); break; default: return -EINVAL; }; return 0; }