s390/cio: Introduce on-close CHSC IOCTLs

Introduce two new ioctls CHSC_ON_CLOSE_SET and CHSC_ON_CLOSE_REMOVE
that allow to add and remove one CHSC that is unconditionally executed
when the CHSC device node is closed.

Signed-off-by: Michael Holzheu <holzheu@linux.vnet.ibm.com>
Signed-off-by: Martin Schwidefsky <schwidefsky@de.ibm.com>

1 files changed, 94 insertions, 0 deletions

diff --git a/drivers/s390/cio/chsc_sch.c b/drivers/s390/cio/chsc_sch.c
index 5fe9f8c4b4fb..64cd60063ffc 100644
--- a/drivers/s390/cio/chsc_sch.c
+++ b/drivers/s390/cio/chsc_sch.c
@@ -29,6 +29,10 @@
 static debug_info_t *chsc_debug_msg_id;
 static debug_info_t *chsc_debug_log_id;
 
+static struct chsc_request *on_close_request;
+static struct chsc_async_area *on_close_chsc_area;
+static DEFINE_MUTEX(on_close_mutex);
+
 #define CHSC_MSG(imp, args...) do {                                     \
                 debug_sprintf_event(chsc_debug_msg_id, imp , ##args);   \
         } while (0)
@@ -362,6 +366,68 @@ out_free:
         return ret;
 }
 
+static int chsc_ioctl_on_close_set(void __user *user_area)
+{
+        char dbf[13];
+        int ret;
+
+        mutex_lock(&on_close_mutex);
+        if (on_close_chsc_area) {
+                ret = -EBUSY;
+                goto out_unlock;
+        }
+        on_close_request = kzalloc(sizeof(*on_close_request), GFP_KERNEL);
+        if (!on_close_request) {
+                ret = -ENOMEM;
+                goto out_unlock;
+        }
+        on_close_chsc_area = (void *)get_zeroed_page(GFP_DMA | GFP_KERNEL);
+        if (!on_close_chsc_area) {
+                ret = -ENOMEM;
+                goto out_free_request;
+        }
+        if (copy_from_user(on_close_chsc_area, user_area, PAGE_SIZE)) {
+                ret = -EFAULT;
+                goto out_free_chsc;
+        }
+        ret = 0;
+        goto out_unlock;
+
+out_free_chsc:
+        free_page((unsigned long)on_close_chsc_area);
+        on_close_chsc_area = NULL;
+out_free_request:
+        kfree(on_close_request);
+        on_close_request = NULL;
+out_unlock:
+        mutex_unlock(&on_close_mutex);
+        sprintf(dbf, "ocsret:%d", ret);
+        CHSC_LOG(0, dbf);
+        return ret;
+}
+
+static int chsc_ioctl_on_close_remove(void)
+{
+        char dbf[13];
+        int ret;
+
+        mutex_lock(&on_close_mutex);
+        if (!on_close_chsc_area) {
+                ret = -ENOENT;
+                goto out_unlock;
+        }
+        free_page((unsigned long)on_close_chsc_area);
+        on_close_chsc_area = NULL;
+        kfree(on_close_request);
+        on_close_request = NULL;
+        ret = 0;
+out_unlock:
+        mutex_unlock(&on_close_mutex);
+        sprintf(dbf, "ocrret:%d", ret);
+        CHSC_LOG(0, dbf);
+        return ret;
+}
+
 static int chsc_ioctl_start_sync(void __user *user_area)
 {
         struct chsc_sync_area *chsc_area;
@@ -842,6 +908,10 @@ static long chsc_ioctl(struct file *filp, unsigned int cmd,
                 return chsc_ioctl_chpd(argp);
         case CHSC_INFO_DCAL:
                 return chsc_ioctl_dcal(argp);
+        case CHSC_ON_CLOSE_SET:
+                return chsc_ioctl_on_close_set(argp);
+        case CHSC_ON_CLOSE_REMOVE:
+                return chsc_ioctl_on_close_remove();
         default: /* unknown ioctl number */
                 return -ENOIOCTLCMD;
         }
@@ -860,6 +930,30 @@ static int chsc_open(struct inode *inode, struct file *file)
 
 static int chsc_release(struct inode *inode, struct file *filp)
 {
+        char dbf[13];
+        int ret;
+
+        mutex_lock(&on_close_mutex);
+        if (!on_close_chsc_area)
+                goto out_unlock;
+        init_completion(&on_close_request->completion);
+        CHSC_LOG(0, "on_close");
+        chsc_log_command(on_close_chsc_area);
+        spin_lock_irq(&chsc_lock);
+        ret = chsc_async(on_close_chsc_area, on_close_request);
+        spin_unlock_irq(&chsc_lock);
+        if (ret == -EINPROGRESS) {
+                wait_for_completion(&on_close_request->completion);
+                ret = chsc_examine_irb(on_close_request);
+        }
+        sprintf(dbf, "relret:%d", ret);
+        CHSC_LOG(0, dbf);
+        free_page((unsigned long)on_close_chsc_area);
+        on_close_chsc_area = NULL;
+        kfree(on_close_request);
+        on_close_request = NULL;
+out_unlock:
+        mutex_unlock(&on_close_mutex);
         atomic_inc(&chsc_ready_for_use);
         return 0;
 }