[S390] pm: monreader power management callbacks.

Signed-off-by: Gerald Schaefer <gerald.schaefer@de.ibm.com>
Signed-off-by: Martin Schwidefsky <schwidefsky@de.ibm.com>

diff --git a/drivers/s390/char/monreader.c b/drivers/s390/char/monreader.c
index 97e63cf..75a8831 100644 (file)
--- a/drivers/s390/char/monreader.c
+++ b/drivers/s390/char/monreader.c
@@ -1,10 +1,9 @@
 /*
- * drivers/s390/char/monreader.c
- *
  * Character device driver for reading z/VM *MONITOR service records.
  *
- *   Copyright IBM Corp. 2004, 2008
- *   Author: Gerald Schaefer <gerald.schaefer@de.ibm.com>
+ * Copyright IBM Corp. 2004, 2009
+ *
+ * Author: Gerald Schaefer <gerald.schaefer@de.ibm.com>
  */
 
 #define KMSG_COMPONENT "monreader"
@@ -22,6 +21,7 @@
 #include <linux/spinlock.h>
 #include <linux/interrupt.h>
 #include <linux/poll.h>
+#include <linux/device.h>
 #include <net/iucv/iucv.h>
 #include <asm/uaccess.h>
 #include <asm/ebcdic.h>
@@ -78,6 +78,7 @@ static u8 user_data_sever[16] = {
        0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
 };
 
+static struct device *monreader_device;
 
 /******************************************************************************
  *                             helper functions                               *
@@ -319,11 +320,12 @@ static int mon_open(struct inode *inode, struct file *filp)
                goto out_path;
        }
        filp->private_data = monpriv;
+       monreader_device->driver_data = monpriv;
        unlock_kernel();
        return nonseekable_open(inode, filp);
 
 out_path:
-       kfree(monpriv->path);
+       iucv_path_free(monpriv->path);
 out_priv:
        mon_free_mem(monpriv);
 out_use:
@@ -341,10 +343,13 @@ static int mon_close(struct inode *inode, struct file *filp)
        /*
         * Close IUCV connection and unregister
         */
-       rc = iucv_path_sever(monpriv->path, user_data_sever);
-       if (rc)
-               pr_warning("Disconnecting the z/VM *MONITOR system service "
-                          "failed with rc=%i\n", rc);
+       if (monpriv->path) {
+               rc = iucv_path_sever(monpriv->path, user_data_sever);
+               if (rc)
+                       pr_warning("Disconnecting the z/VM *MONITOR system "
+                                  "service failed with rc=%i\n", rc);
+               iucv_path_free(monpriv->path);
+       }
 
        atomic_set(&monpriv->iucv_severed, 0);
        atomic_set(&monpriv->iucv_connected, 0);
@@ -452,6 +457,94 @@ static struct miscdevice mon_dev = {
        .minor      = MISC_DYNAMIC_MINOR,
 };
 
+
+/******************************************************************************
+ *                             suspend / resume                              *
+ *****************************************************************************/
+static int monreader_freeze(struct device *dev)
+{
+       struct mon_private *monpriv = dev->driver_data;
+       int rc;
+
+       if (!monpriv)
+               return 0;
+       if (monpriv->path) {
+               rc = iucv_path_sever(monpriv->path, user_data_sever);
+               if (rc)
+                       pr_warning("Disconnecting the z/VM *MONITOR system "
+                                  "service failed with rc=%i\n", rc);
+               iucv_path_free(monpriv->path);
+       }
+       atomic_set(&monpriv->iucv_severed, 0);
+       atomic_set(&monpriv->iucv_connected, 0);
+       atomic_set(&monpriv->read_ready, 0);
+       atomic_set(&monpriv->msglim_count, 0);
+       monpriv->write_index  = 0;
+       monpriv->read_index   = 0;
+       monpriv->path = NULL;
+       return 0;
+}
+
+static int monreader_thaw(struct device *dev)
+{
+       struct mon_private *monpriv = dev->driver_data;
+       int rc;
+
+       if (!monpriv)
+               return 0;
+       rc = -ENOMEM;
+       monpriv->path = iucv_path_alloc(MON_MSGLIM, IUCV_IPRMDATA, GFP_KERNEL);
+       if (!monpriv->path)
+               goto out;
+       rc = iucv_path_connect(monpriv->path, &monreader_iucv_handler,
+                              MON_SERVICE, NULL, user_data_connect, monpriv);
+       if (rc) {
+               pr_err("Connecting to the z/VM *MONITOR system service "
+                      "failed with rc=%i\n", rc);
+               goto out_path;
+       }
+       wait_event(mon_conn_wait_queue,
+                  atomic_read(&monpriv->iucv_connected) ||
+                  atomic_read(&monpriv->iucv_severed));
+       if (atomic_read(&monpriv->iucv_severed))
+               goto out_path;
+       return 0;
+out_path:
+       rc = -EIO;
+       iucv_path_free(monpriv->path);
+       monpriv->path = NULL;
+out:
+       atomic_set(&monpriv->iucv_severed, 1);
+       return rc;
+}
+
+static int monreader_restore(struct device *dev)
+{
+       int rc;
+
+       segment_unload(mon_dcss_name);
+       rc = segment_load(mon_dcss_name, SEGMENT_SHARED,
+                         &mon_dcss_start, &mon_dcss_end);
+       if (rc < 0) {
+               segment_warning(rc, mon_dcss_name);
+               panic("fatal monreader resume error: no monitor dcss\n");
+       }
+       return monreader_thaw(dev);
+}
+
+static struct dev_pm_ops monreader_pm_ops = {
+       .freeze  = monreader_freeze,
+       .thaw    = monreader_thaw,
+       .restore = monreader_restore,
+};
+
+static struct device_driver monreader_driver = {
+       .name = "monreader",
+       .bus  = &iucv_bus,
+       .pm   = &monreader_pm_ops,
+};
+
+
 /******************************************************************************
  *                              module init/exit                              *
  *****************************************************************************/
@@ -475,16 +568,33 @@ static int __init mon_init(void)
                return rc;
        }
 
+       rc = driver_register(&monreader_driver);
+       if (rc)
+               goto out_iucv;
+       monreader_device = kzalloc(sizeof(struct device), GFP_KERNEL);
+       if (!monreader_device)
+               goto out_driver;
+       dev_set_name(monreader_device, "monreader-dev");
+       monreader_device->bus = &iucv_bus;
+       monreader_device->parent = iucv_root;
+       monreader_device->driver = &monreader_driver;
+       monreader_device->release = (void (*)(struct device *))kfree;
+       rc = device_register(monreader_device);
+       if (rc) {
+               kfree(monreader_device);
+               goto out_driver;
+       }
+
        rc = segment_type(mon_dcss_name);
        if (rc < 0) {
                segment_warning(rc, mon_dcss_name);
-               goto out_iucv;
+               goto out_device;
        }
        if (rc != SEG_TYPE_SC) {
                pr_err("The specified *MONITOR DCSS %s does not have the "
                       "required type SC\n", mon_dcss_name);
                rc = -EINVAL;
-               goto out_iucv;
+               goto out_device;
        }
 
        rc = segment_load(mon_dcss_name, SEGMENT_SHARED,
@@ -492,7 +602,7 @@ static int __init mon_init(void)
        if (rc < 0) {
                segment_warning(rc, mon_dcss_name);
                rc = -EINVAL;
-               goto out_iucv;
+               goto out_device;
        }
        dcss_mkname(mon_dcss_name, &user_data_connect[8]);
 
@@ -503,6 +613,10 @@ static int __init mon_init(void)
 
 out:
        segment_unload(mon_dcss_name);
+out_device:
+       device_unregister(monreader_device);
+out_driver:
+       driver_unregister(&monreader_driver);
 out_iucv:
        iucv_unregister(&monreader_iucv_handler, 1);
        return rc;
@@ -512,6 +626,8 @@ static void __exit mon_exit(void)
 {
        segment_unload(mon_dcss_name);
        WARN_ON(misc_deregister(&mon_dev) != 0);
+       device_unregister(monreader_device);
+       driver_unregister(&monreader_driver);
        iucv_unregister(&monreader_iucv_handler, 1);
        return;
 }