moctel_mod.c

   1 #undef __KERNEL__
   2 #define __KERNEL__
   3 #undef MODULE
   4 #define MODULE
   5
   6 #include <linux/module.h>
   7 #include <linux/kernel.h>
   8 #include <linux/init.h>
   9 #include <linux/file.h>
  10 #include <linux/fs.h>
  11 #include <linux/ioctl.h>
  12 #include <linux/uaccess.h>
  13 #include <linux/miscdevice.h>
  14
  15 struct fetch_fops_args {
  16   int fd;
  17   u64 retp;
  18 };
  19
  20 #define MOCTEL_FETCH_FOPS _IOR('m', 1, struct fetch_fops_args)
  21
  22 static int ioctl_open(struct inode *nodp, struct file *filp) {
  23   return 0;
  24 }
  25
  26 static const struct file_operations dummy_fops = {};
  27
  28 static long ioctl_ioctl(struct file *filp_, unsigned int cmd, unsigned long arg) {
  29   struct fetch_fops_args args;
  30   struct file *filp;
  31   const struct file_operations *fops;
  32
  33   if (cmd != MOCTEL_FETCH_FOPS) return -EINVAL;
  34   if (copy_from_user(&args, (struct fetch_fops_args __user *)arg, sizeof(args))) return -EINVAL;
  35   filp = fget(args.fd);
  36   if (!filp) return -EBADF;
  37   fops = filp->f_op;
  38   if (!fops) fops = &dummy_fops;
  39   fput(filp);
  40   if (copy_to_user((struct file_operations __user *)args.retp, fops, sizeof(*fops))) return -EINVAL;
  41   return 0;
  42 }
  43
  44 static int ioctl_release(struct inode *nodp, struct file *filp) {
  45   return 0;
  46 }
  47
  48 static const struct file_operations ioctl_fops = {
  49   .owner = THIS_MODULE,
  50   .unlocked_ioctl = ioctl_ioctl,
  51   .open = ioctl_open,
  52   .release = ioctl_release
  53 };
  54
  55 static struct miscdevice ioctl_miscdev = {
  56   .minor = 0,
  57   .name = "ioctl_info",
  58   .fops = &ioctl_fops
  59 };
  60
  61 static int __init init_ioctl(void) {
  62   int ret;
  63   printk(KERN_INFO "loading ioctl helper\n");
  64
  65   ret = misc_register(&ioctl_miscdev);
  66   return ret;
  67 }
  68
  69 static void __exit cleanup_ioctl(void) {
  70   printk(KERN_INFO "unloading ioctl helper\n");
  71   misc_deregister(&ioctl_miscdev);
  72 }
  73
  74 module_init(init_ioctl);
  75 module_exit(cleanup_ioctl);