[S390] pm: monwriter power management callbacks.

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

1 files changed, 92 insertions, 6 deletions

diff --git a/drivers/s390/char/monwriter.c b/drivers/s390/char/monwriter.c
index c7d7483bab9..66fb8eba93f 100644
--- a/drivers/s390/char/monwriter.c
+++ b/drivers/s390/char/monwriter.c
@@ -1,9 +1,7 @@
 /*
- * drivers/s390/char/monwriter.c
- *
  * Character device driver for writing z/VM *MONITOR service records.
  *
- * Copyright (C) IBM Corp. 2006
+ * Copyright IBM Corp. 2006, 2009
  *
  * Author(s): Melissa Howland <Melissa.Howland@us.ibm.com>
  */
@@ -22,6 +20,7 @@
 #include <linux/ctype.h>
 #include <linux/poll.h>
 #include <linux/mutex.h>
+#include <linux/platform_device.h>
 #include <asm/uaccess.h>
 #include <asm/ebcdic.h>
 #include <asm/io.h>
@@ -40,7 +39,10 @@ struct mon_buf {
         char *data;
 };
 
+static LIST_HEAD(mon_priv_list);
+
 struct mon_private {
+        struct list_head priv_list;
         struct list_head list;
         struct monwrite_hdr hdr;
         size_t hdr_to_read;
@@ -188,6 +190,7 @@ static int monwrite_open(struct inode *inode, struct file *filp)
         monpriv->hdr_to_read = sizeof(monpriv->hdr);
         mutex_init(&monpriv->thread_mutex);
         filp->private_data = monpriv;
+        list_add_tail(&monpriv->priv_list, &mon_priv_list);
         unlock_kernel();
         return nonseekable_open(inode, filp);
 }
@@ -206,6 +209,7 @@ static int monwrite_close(struct inode *inode, struct file *filp)
                 kfree(entry->data);
                 kfree(entry);
         }
+        list_del(&monpriv->priv_list);
         kfree(monpriv);
         return 0;
 }
@@ -281,20 +285,102 @@ static struct miscdevice mon_dev = {
 };
 
 /*
+ * suspend/resume
+ */
+
+static int monwriter_freeze(struct device *dev)
+{
+        struct mon_private *monpriv;
+        struct mon_buf *monbuf;
+
+        list_for_each_entry(monpriv, &mon_priv_list, priv_list) {
+                list_for_each_entry(monbuf, &monpriv->list, list) {
+                        if (monbuf->hdr.mon_function != MONWRITE_GEN_EVENT)
+                                monwrite_diag(&monbuf->hdr, monbuf->data,
+                                              APPLDATA_STOP_REC);
+                }
+        }
+        return 0;
+}
+
+static int monwriter_restore(struct device *dev)
+{
+        struct mon_private *monpriv;
+        struct mon_buf *monbuf;
+
+        list_for_each_entry(monpriv, &mon_priv_list, priv_list) {
+                list_for_each_entry(monbuf, &monpriv->list, list) {
+                        if (monbuf->hdr.mon_function == MONWRITE_START_INTERVAL)
+                                monwrite_diag(&monbuf->hdr, monbuf->data,
+                                              APPLDATA_START_INTERVAL_REC);
+                        if (monbuf->hdr.mon_function == MONWRITE_START_CONFIG)
+                                monwrite_diag(&monbuf->hdr, monbuf->data,
+                                              APPLDATA_START_CONFIG_REC);
+                }
+        }
+        return 0;
+}
+
+static int monwriter_thaw(struct device *dev)
+{
+        return monwriter_restore(dev);
+}
+
+static struct dev_pm_ops monwriter_pm_ops = {
+        .freeze         = monwriter_freeze,
+        .thaw           = monwriter_thaw,
+        .restore        = monwriter_restore,
+};
+
+static struct platform_driver monwriter_pdrv = {
+        .driver = {
+                .name   = "monwriter",
+                .owner  = THIS_MODULE,
+                .pm     = &monwriter_pm_ops,
+        },
+};
+
+static struct platform_device *monwriter_pdev;
+
+/*
  * module init/exit
  */
 
 static int __init mon_init(void)
 {
-        if (MACHINE_IS_VM)
-                return misc_register(&mon_dev);
-        else
+        int rc;
+
+        if (!MACHINE_IS_VM)
                 return -ENODEV;
+
+        rc = platform_driver_register(&monwriter_pdrv);
+        if (rc)
+                return rc;
+
+        monwriter_pdev = platform_device_register_simple("monwriter", -1, NULL,
+                                                        0);
+        if (IS_ERR(monwriter_pdev)) {
+                rc = PTR_ERR(monwriter_pdev);
+                goto out_driver;
+        }
+
+        rc = misc_register(&mon_dev);
+        if (rc)
+                goto out_device;
+        return 0;
+
+out_device:
+        platform_device_unregister(monwriter_pdev);
+out_driver:
+        platform_driver_unregister(&monwriter_pdrv);
+        return rc;
 }
 
 static void __exit mon_exit(void)
 {
         WARN_ON(misc_deregister(&mon_dev) != 0);
+        platform_device_unregister(monwriter_pdev);
+        platform_driver_unregister(&monwriter_pdrv);
 }
 
 module_init(mon_init);