[S390] qdio: improve inbound buffer acknowledgement
[linux-2.6] / drivers / s390 / char / vmlogrdr.c
1 /*
2  * drivers/s390/char/vmlogrdr.c
3  *      character device driver for reading z/VM system service records
4  *
5  *
6  *      Copyright 2004 IBM Corporation
7  *      character device driver for reading z/VM system service records,
8  *      Version 1.0
9  *      Author(s): Xenia Tkatschow <xenia@us.ibm.com>
10  *                 Stefan Weinhuber <wein@de.ibm.com>
11  *
12  */
13 #include <linux/module.h>
14 #include <linux/init.h>
15 #include <linux/errno.h>
16 #include <linux/types.h>
17 #include <linux/interrupt.h>
18 #include <linux/spinlock.h>
19 #include <asm/atomic.h>
20 #include <asm/uaccess.h>
21 #include <asm/cpcmd.h>
22 #include <asm/debug.h>
23 #include <asm/ebcdic.h>
24 #include <net/iucv/iucv.h>
25 #include <linux/kmod.h>
26 #include <linux/cdev.h>
27 #include <linux/device.h>
28 #include <linux/smp_lock.h>
29 #include <linux/string.h>
30
31
32
33 MODULE_AUTHOR
34         ("(C) 2004 IBM Corporation by Xenia Tkatschow (xenia@us.ibm.com)\n"
35          "                            Stefan Weinhuber (wein@de.ibm.com)");
36 MODULE_DESCRIPTION ("Character device driver for reading z/VM "
37                     "system service records.");
38 MODULE_LICENSE("GPL");
39
40
41 /*
42  * The size of the buffer for iucv data transfer is one page,
43  * but in addition to the data we read from iucv we also
44  * place an integer and some characters into that buffer,
45  * so the maximum size for record data is a little less then
46  * one page.
47  */
48 #define NET_BUFFER_SIZE (PAGE_SIZE - sizeof(int) - sizeof(FENCE))
49
50 /*
51  * The elements that are concurrently accessed by bottom halves are
52  * connection_established, iucv_path_severed, local_interrupt_buffer
53  * and receive_ready. The first three can be protected by
54  * priv_lock.  receive_ready is atomic, so it can be incremented and
55  * decremented without holding a lock.
56  * The variable dev_in_use needs to be protected by the lock, since
57  * it's a flag used by open to make sure that the device is opened only
58  * by one user at the same time.
59  */
60 struct vmlogrdr_priv_t {
61         char system_service[8];
62         char internal_name[8];
63         char recording_name[8];
64         struct iucv_path *path;
65         int connection_established;
66         int iucv_path_severed;
67         struct iucv_message local_interrupt_buffer;
68         atomic_t receive_ready;
69         int minor_num;
70         char * buffer;
71         char * current_position;
72         int remaining;
73         ulong residual_length;
74         int buffer_free;
75         int dev_in_use; /* 1: already opened, 0: not opened*/
76         spinlock_t priv_lock;
77         struct device  *device;
78         struct device  *class_device;
79         int autorecording;
80         int autopurge;
81 };
82
83
84 /*
85  * File operation structure for vmlogrdr devices
86  */
87 static int vmlogrdr_open(struct inode *, struct file *);
88 static int vmlogrdr_release(struct inode *, struct file *);
89 static ssize_t vmlogrdr_read (struct file *filp, char __user *data,
90                               size_t count, loff_t * ppos);
91
92 static const struct file_operations vmlogrdr_fops = {
93         .owner   = THIS_MODULE,
94         .open    = vmlogrdr_open,
95         .release = vmlogrdr_release,
96         .read    = vmlogrdr_read,
97 };
98
99
100 static void vmlogrdr_iucv_path_complete(struct iucv_path *, u8 ipuser[16]);
101 static void vmlogrdr_iucv_path_severed(struct iucv_path *, u8 ipuser[16]);
102 static void vmlogrdr_iucv_message_pending(struct iucv_path *,
103                                           struct iucv_message *);
104
105
106 static struct iucv_handler vmlogrdr_iucv_handler = {
107         .path_complete   = vmlogrdr_iucv_path_complete,
108         .path_severed    = vmlogrdr_iucv_path_severed,
109         .message_pending = vmlogrdr_iucv_message_pending,
110 };
111
112
113 static DECLARE_WAIT_QUEUE_HEAD(conn_wait_queue);
114 static DECLARE_WAIT_QUEUE_HEAD(read_wait_queue);
115
116 /*
117  * pointer to system service private structure
118  * minor number 0 --> logrec
119  * minor number 1 --> account
120  * minor number 2 --> symptom
121  */
122
123 static struct vmlogrdr_priv_t sys_ser[] = {
124         { .system_service = "*LOGREC ",
125           .internal_name  = "logrec",
126           .recording_name = "EREP",
127           .minor_num      = 0,
128           .buffer_free    = 1,
129           .priv_lock      = __SPIN_LOCK_UNLOCKED(sys_ser[0].priv_lock),
130           .autorecording  = 1,
131           .autopurge      = 1,
132         },
133         { .system_service = "*ACCOUNT",
134           .internal_name  = "account",
135           .recording_name = "ACCOUNT",
136           .minor_num      = 1,
137           .buffer_free    = 1,
138           .priv_lock      = __SPIN_LOCK_UNLOCKED(sys_ser[1].priv_lock),
139           .autorecording  = 1,
140           .autopurge      = 1,
141         },
142         { .system_service = "*SYMPTOM",
143           .internal_name  = "symptom",
144           .recording_name = "SYMPTOM",
145           .minor_num      = 2,
146           .buffer_free    = 1,
147           .priv_lock      = __SPIN_LOCK_UNLOCKED(sys_ser[2].priv_lock),
148           .autorecording  = 1,
149           .autopurge      = 1,
150         }
151 };
152
153 #define MAXMINOR  (sizeof(sys_ser)/sizeof(struct vmlogrdr_priv_t))
154
155 static char FENCE[] = {"EOR"};
156 static int vmlogrdr_major = 0;
157 static struct cdev  *vmlogrdr_cdev = NULL;
158 static int recording_class_AB;
159
160
161 static void vmlogrdr_iucv_path_complete(struct iucv_path *path, u8 ipuser[16])
162 {
163         struct vmlogrdr_priv_t * logptr = path->private;
164
165         spin_lock(&logptr->priv_lock);
166         logptr->connection_established = 1;
167         spin_unlock(&logptr->priv_lock);
168         wake_up(&conn_wait_queue);
169 }
170
171
172 static void vmlogrdr_iucv_path_severed(struct iucv_path *path, u8 ipuser[16])
173 {
174         struct vmlogrdr_priv_t * logptr = path->private;
175         u8 reason = (u8) ipuser[8];
176
177         printk (KERN_ERR "vmlogrdr: connection severed with"
178                 " reason %i\n", reason);
179
180         iucv_path_sever(path, NULL);
181         kfree(path);
182         logptr->path = NULL;
183
184         spin_lock(&logptr->priv_lock);
185         logptr->connection_established = 0;
186         logptr->iucv_path_severed = 1;
187         spin_unlock(&logptr->priv_lock);
188
189         wake_up(&conn_wait_queue);
190         /* just in case we're sleeping waiting for a record */
191         wake_up_interruptible(&read_wait_queue);
192 }
193
194
195 static void vmlogrdr_iucv_message_pending(struct iucv_path *path,
196                                           struct iucv_message *msg)
197 {
198         struct vmlogrdr_priv_t * logptr = path->private;
199
200         /*
201          * This function is the bottom half so it should be quick.
202          * Copy the external interrupt data into our local eib and increment
203          * the usage count
204          */
205         spin_lock(&logptr->priv_lock);
206         memcpy(&logptr->local_interrupt_buffer, msg, sizeof(*msg));
207         atomic_inc(&logptr->receive_ready);
208         spin_unlock(&logptr->priv_lock);
209         wake_up_interruptible(&read_wait_queue);
210 }
211
212
213 static int vmlogrdr_get_recording_class_AB(void)
214 {
215         char cp_command[]="QUERY COMMAND RECORDING ";
216         char cp_response[80];
217         char *tail;
218         int len,i;
219
220         cpcmd(cp_command, cp_response, sizeof(cp_response), NULL);
221         len = strnlen(cp_response,sizeof(cp_response));
222         // now the parsing
223         tail=strnchr(cp_response,len,'=');
224         if (!tail)
225                 return 0;
226         tail++;
227         if (!strncmp("ANY",tail,3))
228                 return 1;
229         if (!strncmp("NONE",tail,4))
230                 return 0;
231         /*
232          * expect comma separated list of classes here, if one of them
233          * is A or B return 1 otherwise 0
234          */
235         for (i=tail-cp_response; i<len; i++)
236                 if ( cp_response[i]=='A' || cp_response[i]=='B' )
237                         return 1;
238         return 0;
239 }
240
241
242 static int vmlogrdr_recording(struct vmlogrdr_priv_t * logptr,
243                               int action, int purge)
244 {
245
246         char cp_command[80];
247         char cp_response[160];
248         char *onoff, *qid_string;
249
250         memset(cp_command, 0x00, sizeof(cp_command));
251         memset(cp_response, 0x00, sizeof(cp_response));
252
253         onoff = ((action == 1) ? "ON" : "OFF");
254         qid_string = ((recording_class_AB == 1) ? " QID * " : "");
255
256         /*
257          * The recording commands needs to be called with option QID
258          * for guests that have previlege classes A or B.
259          * Purging has to be done as separate step, because recording
260          * can't be switched on as long as records are on the queue.
261          * Doing both at the same time doesn't work.
262          */
263
264         if (purge) {
265                 snprintf(cp_command, sizeof(cp_command),
266                          "RECORDING %s PURGE %s",
267                          logptr->recording_name,
268                          qid_string);
269
270                 cpcmd(cp_command, cp_response, sizeof(cp_response), NULL);
271         }
272
273         memset(cp_command, 0x00, sizeof(cp_command));
274         memset(cp_response, 0x00, sizeof(cp_response));
275         snprintf(cp_command, sizeof(cp_command), "RECORDING %s %s %s",
276                 logptr->recording_name,
277                 onoff,
278                 qid_string);
279
280         cpcmd(cp_command, cp_response, sizeof(cp_response), NULL);
281         /* The recording command will usually answer with 'Command complete'
282          * on success, but when the specific service was never connected
283          * before then there might be an additional informational message
284          * 'HCPCRC8072I Recording entry not found' before the
285          * 'Command complete'. So I use strstr rather then the strncmp.
286          */
287         if (strstr(cp_response,"Command complete"))
288                 return 0;
289         else
290                 return -EIO;
291
292 }
293
294
295 static int vmlogrdr_open (struct inode *inode, struct file *filp)
296 {
297         int dev_num = 0;
298         struct vmlogrdr_priv_t * logptr = NULL;
299         int connect_rc = 0;
300         int ret;
301
302         dev_num = iminor(inode);
303         if (dev_num > MAXMINOR)
304                 return -ENODEV;
305         logptr = &sys_ser[dev_num];
306
307         /*
308          * only allow for blocking reads to be open
309          */
310         if (filp->f_flags & O_NONBLOCK)
311                 return -ENOSYS;
312
313         /* Besure this device hasn't already been opened */
314         lock_kernel();
315         spin_lock_bh(&logptr->priv_lock);
316         if (logptr->dev_in_use) {
317                 spin_unlock_bh(&logptr->priv_lock);
318                 unlock_kernel();
319                 return -EBUSY;
320         }
321         logptr->dev_in_use = 1;
322         logptr->connection_established = 0;
323         logptr->iucv_path_severed = 0;
324         atomic_set(&logptr->receive_ready, 0);
325         logptr->buffer_free = 1;
326         spin_unlock_bh(&logptr->priv_lock);
327
328         /* set the file options */
329         filp->private_data = logptr;
330         filp->f_op = &vmlogrdr_fops;
331
332         /* start recording for this service*/
333         if (logptr->autorecording) {
334                 ret = vmlogrdr_recording(logptr,1,logptr->autopurge);
335                 if (ret)
336                         printk (KERN_WARNING "vmlogrdr: failed to start "
337                                 "recording automatically\n");
338         }
339
340         /* create connection to the system service */
341         logptr->path = iucv_path_alloc(10, 0, GFP_KERNEL);
342         if (!logptr->path)
343                 goto out_dev;
344         connect_rc = iucv_path_connect(logptr->path, &vmlogrdr_iucv_handler,
345                                        logptr->system_service, NULL, NULL,
346                                        logptr);
347         if (connect_rc) {
348                 printk (KERN_ERR "vmlogrdr: iucv connection to %s "
349                         "failed with rc %i \n", logptr->system_service,
350                         connect_rc);
351                 goto out_path;
352         }
353
354         /* We've issued the connect and now we must wait for a
355          * ConnectionComplete or ConnectinSevered Interrupt
356          * before we can continue to process.
357          */
358         wait_event(conn_wait_queue, (logptr->connection_established)
359                    || (logptr->iucv_path_severed));
360         if (logptr->iucv_path_severed)
361                 goto out_record;
362         ret = nonseekable_open(inode, filp);
363         unlock_kernel();
364         return ret;
365
366 out_record:
367         if (logptr->autorecording)
368                 vmlogrdr_recording(logptr,0,logptr->autopurge);
369 out_path:
370         kfree(logptr->path);    /* kfree(NULL) is ok. */
371         logptr->path = NULL;
372 out_dev:
373         logptr->dev_in_use = 0;
374         unlock_kernel();
375         return -EIO;
376 }
377
378
379 static int vmlogrdr_release (struct inode *inode, struct file *filp)
380 {
381         int ret;
382
383         struct vmlogrdr_priv_t * logptr = filp->private_data;
384
385         iucv_path_sever(logptr->path, NULL);
386         kfree(logptr->path);
387         logptr->path = NULL;
388         if (logptr->autorecording) {
389                 ret = vmlogrdr_recording(logptr,0,logptr->autopurge);
390                 if (ret)
391                         printk (KERN_WARNING "vmlogrdr: failed to stop "
392                                 "recording automatically\n");
393         }
394         logptr->dev_in_use = 0;
395
396         return 0;
397 }
398
399
400 static int vmlogrdr_receive_data(struct vmlogrdr_priv_t *priv)
401 {
402         int rc, *temp;
403         /* we need to keep track of two data sizes here:
404          * The number of bytes we need to receive from iucv and
405          * the total number of bytes we actually write into the buffer.
406          */
407         int user_data_count, iucv_data_count;
408         char * buffer;
409
410         if (atomic_read(&priv->receive_ready)) {
411                 spin_lock_bh(&priv->priv_lock);
412                 if (priv->residual_length){
413                         /* receive second half of a record */
414                         iucv_data_count = priv->residual_length;
415                         user_data_count = 0;
416                         buffer = priv->buffer;
417                 } else {
418                         /* receive a new record:
419                          * We need to return the total length of the record
420                          * + size of FENCE in the first 4 bytes of the buffer.
421                          */
422                         iucv_data_count = priv->local_interrupt_buffer.length;
423                         user_data_count = sizeof(int);
424                         temp = (int*)priv->buffer;
425                         *temp= iucv_data_count + sizeof(FENCE);
426                         buffer = priv->buffer + sizeof(int);
427                 }
428                 /*
429                  * If the record is bigger then our buffer, we receive only
430                  * a part of it. We can get the rest later.
431                  */
432                 if (iucv_data_count > NET_BUFFER_SIZE)
433                         iucv_data_count = NET_BUFFER_SIZE;
434                 rc = iucv_message_receive(priv->path,
435                                           &priv->local_interrupt_buffer,
436                                           0, buffer, iucv_data_count,
437                                           &priv->residual_length);
438                 spin_unlock_bh(&priv->priv_lock);
439                 /* An rc of 5 indicates that the record was bigger then
440                  * the buffer, which is OK for us. A 9 indicates that the
441                  * record was purged befor we could receive it.
442                  */
443                 if (rc == 5)
444                         rc = 0;
445                 if (rc == 9)
446                         atomic_set(&priv->receive_ready, 0);
447         } else {
448                 rc = 1;
449         }
450         if (!rc) {
451                 priv->buffer_free = 0;
452                 user_data_count += iucv_data_count;
453                 priv->current_position = priv->buffer;
454                 if (priv->residual_length == 0){
455                         /* the whole record has been captured,
456                          * now add the fence */
457                         atomic_dec(&priv->receive_ready);
458                         buffer = priv->buffer + user_data_count;
459                         memcpy(buffer, FENCE, sizeof(FENCE));
460                         user_data_count += sizeof(FENCE);
461                 }
462                 priv->remaining = user_data_count;
463         }
464
465         return rc;
466 }
467
468
469 static ssize_t vmlogrdr_read(struct file *filp, char __user *data,
470                              size_t count, loff_t * ppos)
471 {
472         int rc;
473         struct vmlogrdr_priv_t * priv = filp->private_data;
474
475         while (priv->buffer_free) {
476                 rc = vmlogrdr_receive_data(priv);
477                 if (rc) {
478                         rc = wait_event_interruptible(read_wait_queue,
479                                         atomic_read(&priv->receive_ready));
480                         if (rc)
481                                 return rc;
482                 }
483         }
484         /* copy only up to end of record */
485         if (count > priv->remaining)
486                 count = priv->remaining;
487
488         if (copy_to_user(data, priv->current_position, count))
489                 return -EFAULT;
490
491         *ppos += count;
492         priv->current_position += count;
493         priv->remaining -= count;
494
495         /* if all data has been transferred, set buffer free */
496         if (priv->remaining == 0)
497                 priv->buffer_free = 1;
498
499         return count;
500 }
501
502 static ssize_t vmlogrdr_autopurge_store(struct device * dev,
503                                         struct device_attribute *attr,
504                                         const char * buf, size_t count)
505 {
506         struct vmlogrdr_priv_t *priv = dev->driver_data;
507         ssize_t ret = count;
508
509         switch (buf[0]) {
510         case '0':
511                 priv->autopurge=0;
512                 break;
513         case '1':
514                 priv->autopurge=1;
515                 break;
516         default:
517                 ret = -EINVAL;
518         }
519         return ret;
520 }
521
522
523 static ssize_t vmlogrdr_autopurge_show(struct device *dev,
524                                        struct device_attribute *attr,
525                                        char *buf)
526 {
527         struct vmlogrdr_priv_t *priv = dev->driver_data;
528         return sprintf(buf, "%u\n", priv->autopurge);
529 }
530
531
532 static DEVICE_ATTR(autopurge, 0644, vmlogrdr_autopurge_show,
533                    vmlogrdr_autopurge_store);
534
535
536 static ssize_t vmlogrdr_purge_store(struct device * dev,
537                                     struct device_attribute *attr,
538                                     const char * buf, size_t count)
539 {
540
541         char cp_command[80];
542         char cp_response[80];
543         struct vmlogrdr_priv_t *priv = dev->driver_data;
544
545         if (buf[0] != '1')
546                 return -EINVAL;
547
548         memset(cp_command, 0x00, sizeof(cp_command));
549         memset(cp_response, 0x00, sizeof(cp_response));
550
551         /*
552          * The recording command needs to be called with option QID
553          * for guests that have previlege classes A or B.
554          * Other guests will not recognize the command and we have to
555          * issue the same command without the QID parameter.
556          */
557
558         if (recording_class_AB)
559                 snprintf(cp_command, sizeof(cp_command),
560                          "RECORDING %s PURGE QID * ",
561                          priv->recording_name);
562         else
563                 snprintf(cp_command, sizeof(cp_command),
564                          "RECORDING %s PURGE ",
565                          priv->recording_name);
566
567         cpcmd(cp_command, cp_response, sizeof(cp_response), NULL);
568
569         return count;
570 }
571
572
573 static DEVICE_ATTR(purge, 0200, NULL, vmlogrdr_purge_store);
574
575
576 static ssize_t vmlogrdr_autorecording_store(struct device *dev,
577                                             struct device_attribute *attr,
578                                             const char *buf, size_t count)
579 {
580         struct vmlogrdr_priv_t *priv = dev->driver_data;
581         ssize_t ret = count;
582
583         switch (buf[0]) {
584         case '0':
585                 priv->autorecording=0;
586                 break;
587         case '1':
588                 priv->autorecording=1;
589                 break;
590         default:
591                 ret = -EINVAL;
592         }
593         return ret;
594 }
595
596
597 static ssize_t vmlogrdr_autorecording_show(struct device *dev,
598                                            struct device_attribute *attr,
599                                            char *buf)
600 {
601         struct vmlogrdr_priv_t *priv = dev->driver_data;
602         return sprintf(buf, "%u\n", priv->autorecording);
603 }
604
605
606 static DEVICE_ATTR(autorecording, 0644, vmlogrdr_autorecording_show,
607                    vmlogrdr_autorecording_store);
608
609
610 static ssize_t vmlogrdr_recording_store(struct device * dev,
611                                         struct device_attribute *attr,
612                                         const char * buf, size_t count)
613 {
614         struct vmlogrdr_priv_t *priv = dev->driver_data;
615         ssize_t ret;
616
617         switch (buf[0]) {
618         case '0':
619                 ret = vmlogrdr_recording(priv,0,0);
620                 break;
621         case '1':
622                 ret = vmlogrdr_recording(priv,1,0);
623                 break;
624         default:
625                 ret = -EINVAL;
626         }
627         if (ret)
628                 return ret;
629         else
630                 return count;
631
632 }
633
634
635 static DEVICE_ATTR(recording, 0200, NULL, vmlogrdr_recording_store);
636
637
638 static ssize_t vmlogrdr_recording_status_show(struct device_driver *driver,
639                                               char *buf)
640 {
641
642         char cp_command[] = "QUERY RECORDING ";
643         int len;
644
645         cpcmd(cp_command, buf, 4096, NULL);
646         len = strlen(buf);
647         return len;
648 }
649
650
651 static DRIVER_ATTR(recording_status, 0444, vmlogrdr_recording_status_show,
652                    NULL);
653
654 static struct attribute *vmlogrdr_attrs[] = {
655         &dev_attr_autopurge.attr,
656         &dev_attr_purge.attr,
657         &dev_attr_autorecording.attr,
658         &dev_attr_recording.attr,
659         NULL,
660 };
661
662 static struct attribute_group vmlogrdr_attr_group = {
663         .attrs = vmlogrdr_attrs,
664 };
665
666 static struct class *vmlogrdr_class;
667 static struct device_driver vmlogrdr_driver = {
668         .name = "vmlogrdr",
669         .bus  = &iucv_bus,
670 };
671
672
673 static int vmlogrdr_register_driver(void)
674 {
675         int ret;
676
677         /* Register with iucv driver */
678         ret = iucv_register(&vmlogrdr_iucv_handler, 1);
679         if (ret)
680                 goto out;
681
682         ret = driver_register(&vmlogrdr_driver);
683         if (ret)
684                 goto out_iucv;
685
686         ret = driver_create_file(&vmlogrdr_driver,
687                                  &driver_attr_recording_status);
688         if (ret)
689                 goto out_driver;
690
691         vmlogrdr_class = class_create(THIS_MODULE, "vmlogrdr");
692         if (IS_ERR(vmlogrdr_class)) {
693                 ret = PTR_ERR(vmlogrdr_class);
694                 vmlogrdr_class = NULL;
695                 goto out_attr;
696         }
697         return 0;
698
699 out_attr:
700         driver_remove_file(&vmlogrdr_driver, &driver_attr_recording_status);
701 out_driver:
702         driver_unregister(&vmlogrdr_driver);
703 out_iucv:
704         iucv_unregister(&vmlogrdr_iucv_handler, 1);
705 out:
706         return ret;
707 }
708
709
710 static void vmlogrdr_unregister_driver(void)
711 {
712         class_destroy(vmlogrdr_class);
713         vmlogrdr_class = NULL;
714         driver_remove_file(&vmlogrdr_driver, &driver_attr_recording_status);
715         driver_unregister(&vmlogrdr_driver);
716         iucv_unregister(&vmlogrdr_iucv_handler, 1);
717 }
718
719
720 static int vmlogrdr_register_device(struct vmlogrdr_priv_t *priv)
721 {
722         struct device *dev;
723         int ret;
724
725         dev = kzalloc(sizeof(struct device), GFP_KERNEL);
726         if (dev) {
727                 dev_set_name(dev, priv->internal_name);
728                 dev->bus = &iucv_bus;
729                 dev->parent = iucv_root;
730                 dev->driver = &vmlogrdr_driver;
731                 /*
732                  * The release function could be called after the
733                  * module has been unloaded. It's _only_ task is to
734                  * free the struct. Therefore, we specify kfree()
735                  * directly here. (Probably a little bit obfuscating
736                  * but legitime ...).
737                  */
738                 dev->release = (void (*)(struct device *))kfree;
739         } else
740                 return -ENOMEM;
741         ret = device_register(dev);
742         if (ret)
743                 return ret;
744
745         ret = sysfs_create_group(&dev->kobj, &vmlogrdr_attr_group);
746         if (ret) {
747                 device_unregister(dev);
748                 return ret;
749         }
750         priv->class_device = device_create(vmlogrdr_class, dev,
751                                            MKDEV(vmlogrdr_major,
752                                                  priv->minor_num),
753                                            priv, "%s", dev_name(dev));
754         if (IS_ERR(priv->class_device)) {
755                 ret = PTR_ERR(priv->class_device);
756                 priv->class_device=NULL;
757                 sysfs_remove_group(&dev->kobj, &vmlogrdr_attr_group);
758                 device_unregister(dev);
759                 return ret;
760         }
761         priv->device = dev;
762         return 0;
763 }
764
765
766 static int vmlogrdr_unregister_device(struct vmlogrdr_priv_t *priv)
767 {
768         device_destroy(vmlogrdr_class, MKDEV(vmlogrdr_major, priv->minor_num));
769         if (priv->device != NULL) {
770                 sysfs_remove_group(&priv->device->kobj, &vmlogrdr_attr_group);
771                 device_unregister(priv->device);
772                 priv->device=NULL;
773         }
774         return 0;
775 }
776
777
778 static int vmlogrdr_register_cdev(dev_t dev)
779 {
780         int rc = 0;
781         vmlogrdr_cdev = cdev_alloc();
782         if (!vmlogrdr_cdev) {
783                 return -ENOMEM;
784         }
785         vmlogrdr_cdev->owner = THIS_MODULE;
786         vmlogrdr_cdev->ops = &vmlogrdr_fops;
787         vmlogrdr_cdev->dev = dev;
788         rc = cdev_add(vmlogrdr_cdev, vmlogrdr_cdev->dev, MAXMINOR);
789         if (!rc)
790                 return 0;
791
792         // cleanup: cdev is not fully registered, no cdev_del here!
793         kobject_put(&vmlogrdr_cdev->kobj);
794         vmlogrdr_cdev=NULL;
795         return rc;
796 }
797
798
799 static void vmlogrdr_cleanup(void)
800 {
801         int i;
802
803         if (vmlogrdr_cdev) {
804                 cdev_del(vmlogrdr_cdev);
805                 vmlogrdr_cdev=NULL;
806         }
807         for (i=0; i < MAXMINOR; ++i ) {
808                 vmlogrdr_unregister_device(&sys_ser[i]);
809                 free_page((unsigned long)sys_ser[i].buffer);
810         }
811         vmlogrdr_unregister_driver();
812         if (vmlogrdr_major) {
813                 unregister_chrdev_region(MKDEV(vmlogrdr_major, 0), MAXMINOR);
814                 vmlogrdr_major=0;
815         }
816 }
817
818
819 static int __init vmlogrdr_init(void)
820 {
821         int rc;
822         int i;
823         dev_t dev;
824
825         if (! MACHINE_IS_VM) {
826                 printk (KERN_ERR "vmlogrdr: not running under VM, "
827                                 "driver not loaded.\n");
828                 return -ENODEV;
829         }
830
831         recording_class_AB = vmlogrdr_get_recording_class_AB();
832
833         rc = alloc_chrdev_region(&dev, 0, MAXMINOR, "vmlogrdr");
834         if (rc)
835                 return rc;
836         vmlogrdr_major = MAJOR(dev);
837
838         rc=vmlogrdr_register_driver();
839         if (rc)
840                 goto cleanup;
841
842         for (i=0; i < MAXMINOR; ++i ) {
843                 sys_ser[i].buffer = (char *) get_zeroed_page(GFP_KERNEL);
844                 if (!sys_ser[i].buffer) {
845                         rc = -ENOMEM;
846                         break;
847                 }
848                 sys_ser[i].current_position = sys_ser[i].buffer;
849                 rc=vmlogrdr_register_device(&sys_ser[i]);
850                 if (rc)
851                         break;
852         }
853         if (rc)
854                 goto cleanup;
855
856         rc = vmlogrdr_register_cdev(dev);
857         if (rc)
858                 goto cleanup;
859         return 0;
860
861 cleanup:
862         vmlogrdr_cleanup();
863         return rc;
864 }
865
866
867 static void __exit vmlogrdr_exit(void)
868 {
869         vmlogrdr_cleanup();
870         return;
871 }
872
873
874 module_init(vmlogrdr_init);
875 module_exit(vmlogrdr_exit);