GNU Linux-libre 5.10.219-gnu1
[releases.git] / drivers / block / aoe / aoechr.c
1 /* Copyright (c) 2012 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/completion.h>
10 #include <linux/delay.h>
11 #include <linux/slab.h>
12 #include <linux/mutex.h>
13 #include <linux/skbuff.h>
14 #include <linux/export.h>
15 #include "aoe.h"
16
17 enum {
18         //MINOR_STAT = 1, (moved to sysfs)
19         MINOR_ERR = 2,
20         MINOR_DISCOVER,
21         MINOR_INTERFACES,
22         MINOR_REVALIDATE,
23         MINOR_FLUSH,
24         MSGSZ = 2048,
25         NMSG = 100,             /* message backlog to retain */
26 };
27
28 struct aoe_chardev {
29         ulong minor;
30         char name[32];
31 };
32
33 enum { EMFL_VALID = 1 };
34
35 struct ErrMsg {
36         short flags;
37         short len;
38         char *msg;
39 };
40
41 static DEFINE_MUTEX(aoechr_mutex);
42
43 /* A ring buffer of error messages, to be read through
44  * "/dev/etherd/err".  When no messages are present,
45  * readers will block waiting for messages to appear.
46  */
47 static struct ErrMsg emsgs[NMSG];
48 static int emsgs_head_idx, emsgs_tail_idx;
49 static struct completion emsgs_comp;
50 static spinlock_t emsgs_lock;
51 static int nblocked_emsgs_readers;
52 static struct class *aoe_class;
53 static struct aoe_chardev chardevs[] = {
54         { MINOR_ERR, "err" },
55         { MINOR_DISCOVER, "discover" },
56         { MINOR_INTERFACES, "interfaces" },
57         { MINOR_REVALIDATE, "revalidate" },
58         { MINOR_FLUSH, "flush" },
59 };
60
61 static int
62 discover(void)
63 {
64         aoecmd_cfg(0xffff, 0xff);
65         return 0;
66 }
67
68 static int
69 interfaces(const char __user *str, size_t size)
70 {
71         if (set_aoe_iflist(str, size)) {
72                 printk(KERN_ERR
73                         "aoe: could not set interface list: too many interfaces\n");
74                 return -EINVAL;
75         }
76         return 0;
77 }
78
79 static int
80 revalidate(const char __user *str, size_t size)
81 {
82         int major, minor, n;
83         ulong flags;
84         struct aoedev *d;
85         struct sk_buff *skb;
86         char buf[16];
87
88         if (size >= sizeof buf)
89                 return -EINVAL;
90         buf[sizeof buf - 1] = '\0';
91         if (copy_from_user(buf, str, size))
92                 return -EFAULT;
93
94         n = sscanf(buf, "e%d.%d", &major, &minor);
95         if (n != 2) {
96                 pr_err("aoe: invalid device specification %s\n", buf);
97                 return -EINVAL;
98         }
99         d = aoedev_by_aoeaddr(major, minor, 0);
100         if (!d)
101                 return -EINVAL;
102         spin_lock_irqsave(&d->lock, flags);
103         aoecmd_cleanslate(d);
104         aoecmd_cfg(major, minor);
105 loop:
106         skb = aoecmd_ata_id(d);
107         spin_unlock_irqrestore(&d->lock, flags);
108         /* try again if we are able to sleep a bit,
109          * otherwise give up this revalidation
110          */
111         if (!skb && !msleep_interruptible(250)) {
112                 spin_lock_irqsave(&d->lock, flags);
113                 goto loop;
114         }
115         aoedev_put(d);
116         if (skb) {
117                 struct sk_buff_head queue;
118                 __skb_queue_head_init(&queue);
119                 __skb_queue_tail(&queue, skb);
120                 aoenet_xmit(&queue);
121         }
122         return 0;
123 }
124
125 void
126 aoechr_error(char *msg)
127 {
128         struct ErrMsg *em;
129         char *mp;
130         ulong flags, n;
131
132         n = strlen(msg);
133
134         spin_lock_irqsave(&emsgs_lock, flags);
135
136         em = emsgs + emsgs_tail_idx;
137         if ((em->flags & EMFL_VALID)) {
138 bail:           spin_unlock_irqrestore(&emsgs_lock, flags);
139                 return;
140         }
141
142         mp = kmemdup(msg, n, GFP_ATOMIC);
143         if (mp == NULL) {
144                 printk(KERN_ERR "aoe: allocation failure, len=%ld\n", n);
145                 goto bail;
146         }
147
148         em->msg = mp;
149         em->flags |= EMFL_VALID;
150         em->len = n;
151
152         emsgs_tail_idx++;
153         emsgs_tail_idx %= ARRAY_SIZE(emsgs);
154
155         spin_unlock_irqrestore(&emsgs_lock, flags);
156
157         if (nblocked_emsgs_readers)
158                 complete(&emsgs_comp);
159 }
160
161 static ssize_t
162 aoechr_write(struct file *filp, const char __user *buf, size_t cnt, loff_t *offp)
163 {
164         int ret = -EINVAL;
165
166         switch ((unsigned long) filp->private_data) {
167         default:
168                 printk(KERN_INFO "aoe: can't write to that file.\n");
169                 break;
170         case MINOR_DISCOVER:
171                 ret = discover();
172                 break;
173         case MINOR_INTERFACES:
174                 ret = interfaces(buf, cnt);
175                 break;
176         case MINOR_REVALIDATE:
177                 ret = revalidate(buf, cnt);
178                 break;
179         case MINOR_FLUSH:
180                 ret = aoedev_flush(buf, cnt);
181                 break;
182         }
183         if (ret == 0)
184                 ret = cnt;
185         return ret;
186 }
187
188 static int
189 aoechr_open(struct inode *inode, struct file *filp)
190 {
191         int n, i;
192
193         mutex_lock(&aoechr_mutex);
194         n = iminor(inode);
195         filp->private_data = (void *) (unsigned long) n;
196
197         for (i = 0; i < ARRAY_SIZE(chardevs); ++i)
198                 if (chardevs[i].minor == n) {
199                         mutex_unlock(&aoechr_mutex);
200                         return 0;
201                 }
202         mutex_unlock(&aoechr_mutex);
203         return -EINVAL;
204 }
205
206 static int
207 aoechr_rel(struct inode *inode, struct file *filp)
208 {
209         return 0;
210 }
211
212 static ssize_t
213 aoechr_read(struct file *filp, char __user *buf, size_t cnt, loff_t *off)
214 {
215         unsigned long n;
216         char *mp;
217         struct ErrMsg *em;
218         ssize_t len;
219         ulong flags;
220
221         n = (unsigned long) filp->private_data;
222         if (n != MINOR_ERR)
223                 return -EFAULT;
224
225         spin_lock_irqsave(&emsgs_lock, flags);
226
227         for (;;) {
228                 em = emsgs + emsgs_head_idx;
229                 if ((em->flags & EMFL_VALID) != 0)
230                         break;
231                 if (filp->f_flags & O_NDELAY) {
232                         spin_unlock_irqrestore(&emsgs_lock, flags);
233                         return -EAGAIN;
234                 }
235                 nblocked_emsgs_readers++;
236
237                 spin_unlock_irqrestore(&emsgs_lock, flags);
238
239                 n = wait_for_completion_interruptible(&emsgs_comp);
240
241                 spin_lock_irqsave(&emsgs_lock, flags);
242
243                 nblocked_emsgs_readers--;
244
245                 if (n) {
246                         spin_unlock_irqrestore(&emsgs_lock, flags);
247                         return -ERESTARTSYS;
248                 }
249         }
250         if (em->len > cnt) {
251                 spin_unlock_irqrestore(&emsgs_lock, flags);
252                 return -EAGAIN;
253         }
254         mp = em->msg;
255         len = em->len;
256         em->msg = NULL;
257         em->flags &= ~EMFL_VALID;
258
259         emsgs_head_idx++;
260         emsgs_head_idx %= ARRAY_SIZE(emsgs);
261
262         spin_unlock_irqrestore(&emsgs_lock, flags);
263
264         n = copy_to_user(buf, mp, len);
265         kfree(mp);
266         return n == 0 ? len : -EFAULT;
267 }
268
269 static const struct file_operations aoe_fops = {
270         .write = aoechr_write,
271         .read = aoechr_read,
272         .open = aoechr_open,
273         .release = aoechr_rel,
274         .owner = THIS_MODULE,
275         .llseek = noop_llseek,
276 };
277
278 static char *aoe_devnode(struct device *dev, umode_t *mode)
279 {
280         return kasprintf(GFP_KERNEL, "etherd/%s", dev_name(dev));
281 }
282
283 int __init
284 aoechr_init(void)
285 {
286         int n, i;
287
288         n = register_chrdev(AOE_MAJOR, "aoechr", &aoe_fops);
289         if (n < 0) {
290                 printk(KERN_ERR "aoe: can't register char device\n");
291                 return n;
292         }
293         init_completion(&emsgs_comp);
294         spin_lock_init(&emsgs_lock);
295         aoe_class = class_create(THIS_MODULE, "aoe");
296         if (IS_ERR(aoe_class)) {
297                 unregister_chrdev(AOE_MAJOR, "aoechr");
298                 return PTR_ERR(aoe_class);
299         }
300         aoe_class->devnode = aoe_devnode;
301
302         for (i = 0; i < ARRAY_SIZE(chardevs); ++i)
303                 device_create(aoe_class, NULL,
304                               MKDEV(AOE_MAJOR, chardevs[i].minor), NULL,
305                               chardevs[i].name);
306
307         return 0;
308 }
309
310 void
311 aoechr_exit(void)
312 {
313         int i;
314
315         for (i = 0; i < ARRAY_SIZE(chardevs); ++i)
316                 device_destroy(aoe_class, MKDEV(AOE_MAJOR, chardevs[i].minor));
317         class_destroy(aoe_class);
318         unregister_chrdev(AOE_MAJOR, "aoechr");
319 }
320