err.no Git - linux-2.6/blob - drivers/block/aoe/aoechr.c

   1 /* Copyright (c) 2006 Coraid, Inc.  See COPYING for GPL terms. */
   2 /*
   3  * aoechr.c
   4  * AoE character device driver
   5  */
   6
   7 #include <linux/hdreg.h>
   8 #include <linux/blkdev.h>
   9 #include <linux/delay.h>
  10 #include "aoe.h"
  11
  12 enum {
  13         //MINOR_STAT = 1, (moved to sysfs)
  14         MINOR_ERR = 2,
  15         MINOR_DISCOVER,
  16         MINOR_INTERFACES,
  17         MINOR_REVALIDATE,
  18         MSGSZ = 2048,
  19         NMSG = 100,             /* message backlog to retain */
  20 };
  21
  22 struct aoe_chardev {
  23         ulong minor;
  24         char name[32];
  25 };
  26
  27 enum { EMFL_VALID = 1 };
  28
  29 struct ErrMsg {
  30         short flags;
  31         short len;
  32         char *msg;
  33 };
  34
  35 static struct ErrMsg emsgs[NMSG];
  36 static int emsgs_head_idx, emsgs_tail_idx;
  37 static struct semaphore emsgs_sema;
  38 static spinlock_t emsgs_lock;
  39 static int nblocked_emsgs_readers;
  40 static struct class *aoe_class;
  41 static struct aoe_chardev chardevs[] = {
  42         { MINOR_ERR, "err" },
  43         { MINOR_DISCOVER, "discover" },
  44         { MINOR_INTERFACES, "interfaces" },
  45         { MINOR_REVALIDATE, "revalidate" },
  46 };
  47
  48 static int
  49 discover(void)
  50 {
  51         aoecmd_cfg(0xffff, 0xff);
  52         return 0;
  53 }
  54
  55 static int
  56 interfaces(const char __user *str, size_t size)
  57 {
  58         if (set_aoe_iflist(str, size)) {
  59                 printk(KERN_ERR
  60                         "aoe: could not set interface list: too many interfaces\n");
  61                 return -EINVAL;
  62         }
  63         return 0;
  64 }
  65
  66 static int
  67 revalidate(const char __user *str, size_t size)
  68 {
  69         int major, minor, n;
  70         ulong flags;
  71         struct aoedev *d;
  72         struct sk_buff *skb;
  73         char buf[16];
  74
  75         if (size >= sizeof buf)
  76                 return -EINVAL;
  77         buf[sizeof buf - 1] = '\0';
  78         if (copy_from_user(buf, str, size))
  79                 return -EFAULT;
  80
  81         /* should be e%d.%d format */
  82         n = sscanf(buf, "e%d.%d", &major, &minor);
  83         if (n != 2) {
  84                 printk(KERN_ERR "aoe: invalid device specification\n");
  85                 return -EINVAL;
  86         }
  87         d = aoedev_by_aoeaddr(major, minor);
  88         if (!d)
  89                 return -EINVAL;
  90         spin_lock_irqsave(&d->lock, flags);
  91         aoecmd_cleanslate(d);
  92 loop:
  93         skb = aoecmd_ata_id(d);
  94         spin_unlock_irqrestore(&d->lock, flags);
  95         /* try again if we are able to sleep a bit,
  96          * otherwise give up this revalidation
  97          */
  98         if (!skb && !msleep_interruptible(200)) {
  99                 spin_lock_irqsave(&d->lock, flags);
 100                 goto loop;
 101         }
 102         aoenet_xmit(skb);
 103         aoecmd_cfg(major, minor);
 104         return 0;
 105 }
 106
 107 void
 108 aoechr_error(char *msg)
 109 {
 110         struct ErrMsg *em;
 111         char *mp;
 112         ulong flags, n;
 113
 114         n = strlen(msg);
 115
 116         spin_lock_irqsave(&emsgs_lock, flags);
 117
 118         em = emsgs + emsgs_tail_idx;
 119         if ((em->flags & EMFL_VALID)) {
 120 bail:           spin_unlock_irqrestore(&emsgs_lock, flags);
 121                 return;
 122         }
 123
 124         mp = kmalloc(n, GFP_ATOMIC);
 125         if (mp == NULL) {
 126                 printk(KERN_ERR "aoe: allocation failure, len=%ld\n", n);
 127                 goto bail;
 128         }
 129
 130         memcpy(mp, msg, n);
 131         em->msg = mp;
 132         em->flags |= EMFL_VALID;
 133         em->len = n;
 134
 135         emsgs_tail_idx++;
 136         emsgs_tail_idx %= ARRAY_SIZE(emsgs);
 137
 138         spin_unlock_irqrestore(&emsgs_lock, flags);
 139
 140         if (nblocked_emsgs_readers)
 141                 up(&emsgs_sema);
 142 }
 143
 144 static ssize_t
 145 aoechr_write(struct file *filp, const char __user *buf, size_t cnt, loff_t *offp)
 146 {
 147         int ret = -EINVAL;
 148
 149         switch ((unsigned long) filp->private_data) {
 150         default:
 151                 printk(KERN_INFO "aoe: can't write to that file.\n");
 152                 break;
 153         case MINOR_DISCOVER:
 154                 ret = discover();
 155                 break;
 156         case MINOR_INTERFACES:
 157                 ret = interfaces(buf, cnt);
 158                 break;
 159         case MINOR_REVALIDATE:
 160                 ret = revalidate(buf, cnt);
 161         }
 162         if (ret == 0)
 163                 ret = cnt;
 164         return ret;
 165 }
 166
 167 static int
 168 aoechr_open(struct inode *inode, struct file *filp)
 169 {
 170         int n, i;
 171
 172         n = iminor(inode);
 173         filp->private_data = (void *) (unsigned long) n;
 174
 175         for (i = 0; i < ARRAY_SIZE(chardevs); ++i)
 176                 if (chardevs[i].minor == n)
 177                         return 0;
 178         return -EINVAL;
 179 }
 180
 181 static int
 182 aoechr_rel(struct inode *inode, struct file *filp)
 183 {
 184         return 0;
 185 }
 186
 187 static ssize_t
 188 aoechr_read(struct file *filp, char __user *buf, size_t cnt, loff_t *off)
 189 {
 190         unsigned long n;
 191         char *mp;
 192         struct ErrMsg *em;
 193         ssize_t len;
 194         ulong flags;
 195
 196         n = (unsigned long) filp->private_data;
 197         if (n != MINOR_ERR)
 198                 return -EFAULT;
 199
 200         spin_lock_irqsave(&emsgs_lock, flags);
 201
 202         for (;;) {
 203                 em = emsgs + emsgs_head_idx;
 204                 if ((em->flags & EMFL_VALID) != 0)
 205                         break;
 206                 if (filp->f_flags & O_NDELAY) {
 207                         spin_unlock_irqrestore(&emsgs_lock, flags);
 208                         return -EAGAIN;
 209                 }
 210                 nblocked_emsgs_readers++;
 211
 212                 spin_unlock_irqrestore(&emsgs_lock, flags);
 213
 214                 n = down_interruptible(&emsgs_sema);
 215
 216                 spin_lock_irqsave(&emsgs_lock, flags);
 217
 218                 nblocked_emsgs_readers--;
 219
 220                 if (n) {
 221                         spin_unlock_irqrestore(&emsgs_lock, flags);
 222                         return -ERESTARTSYS;
 223                 }
 224         }
 225         if (em->len > cnt) {
 226                 spin_unlock_irqrestore(&emsgs_lock, flags);
 227                 return -EAGAIN;
 228         }
 229         mp = em->msg;
 230         len = em->len;
 231         em->msg = NULL;
 232         em->flags &= ~EMFL_VALID;
 233
 234         emsgs_head_idx++;
 235         emsgs_head_idx %= ARRAY_SIZE(emsgs);
 236
 237         spin_unlock_irqrestore(&emsgs_lock, flags);
 238
 239         n = copy_to_user(buf, mp, len);
 240         kfree(mp);
 241         return n == 0 ? len : -EFAULT;
 242 }
 243
 244 static const struct file_operations aoe_fops = {
 245         .write = aoechr_write,
 246         .read = aoechr_read,
 247         .open = aoechr_open,
 248         .release = aoechr_rel,
 249         .owner = THIS_MODULE,
 250 };
 251
 252 int __init
 253 aoechr_init(void)
 254 {
 255         int n, i;
 256
 257         n = register_chrdev(AOE_MAJOR, "aoechr", &aoe_fops);
 258         if (n < 0) {
 259                 printk(KERN_ERR "aoe: can't register char device\n");
 260                 return n;
 261         }
 262         sema_init(&emsgs_sema, 0);
 263         spin_lock_init(&emsgs_lock);
 264         aoe_class = class_create(THIS_MODULE, "aoe");
 265         if (IS_ERR(aoe_class)) {
 266                 unregister_chrdev(AOE_MAJOR, "aoechr");
 267                 return PTR_ERR(aoe_class);
 268         }
 269         for (i = 0; i < ARRAY_SIZE(chardevs); ++i)
 270                 device_create(aoe_class, NULL,
 271                               MKDEV(AOE_MAJOR, chardevs[i].minor), chardevs[i].name);
 272
 273         return 0;
 274 }
 275
 276 void
 277 aoechr_exit(void)
 278 {
 279         int i;
 280
 281         for (i = 0; i < ARRAY_SIZE(chardevs); ++i)
 282                 device_destroy(aoe_class, MKDEV(AOE_MAJOR, chardevs[i].minor));
 283         class_destroy(aoe_class);
 284         unregister_chrdev(AOE_MAJOR, "aoechr");
 285 }
 286