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