[linux-2.6-block.git] / drivers / s390 / net / smsgiucv.c

// SPDX-License-Identifier: GPL-2.0+
/*
 * IUCV special message driver
 *
 * Copyright IBM Corp. 2003, 2009
 *
 * Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com)
 */

#include <linux/module.h>
#include <linux/init.h>
#include <linux/errno.h>
#include <linux/device.h>
#include <linux/slab.h>
#include <net/iucv/iucv.h>
#include <asm/cpcmd.h>
#include <asm/ebcdic.h>
#include "smsgiucv.h"

struct smsg_callback {
	struct list_head list;
	const char *prefix;
	int len;
	void (*callback)(const char *from, char *str);
};

MODULE_AUTHOR
   ("(C) 2003 IBM Corporation by Martin Schwidefsky (schwidefsky@de.ibm.com)");
MODULE_DESCRIPTION ("Linux for S/390 IUCV special message driver");

static struct iucv_path *smsg_path;
/* dummy device used as trigger for PM functions */
static struct device *smsg_dev;

static DEFINE_SPINLOCK(smsg_list_lock);
static LIST_HEAD(smsg_list);
static int iucv_path_connected;

static int smsg_path_pending(struct iucv_path *, u8 *, u8 *);
static void smsg_message_pending(struct iucv_path *, struct iucv_message *);

static struct iucv_handler smsg_handler = {
	.path_pending	 = smsg_path_pending,
	.message_pending = smsg_message_pending,
};

static int smsg_path_pending(struct iucv_path *path, u8 *ipvmid, u8 *ipuser)
{
	if (strncmp(ipvmid, "*MSG    ", 8) != 0)
		return -EINVAL;
	/* Path pending from *MSG. */
	return iucv_path_accept(path, &smsg_handler, "SMSGIUCV        ", NULL);
}

static void smsg_message_pending(struct iucv_path *path,
				 struct iucv_message *msg)
{
	struct smsg_callback *cb;
	unsigned char *buffer;
	unsigned char sender[9];
	int rc, i;

	buffer = kmalloc(msg->length + 1, GFP_ATOMIC | GFP_DMA);
	if (!buffer) {
		iucv_message_reject(path, msg);
		return;
	}
	rc = iucv_message_receive(path, msg, 0, buffer, msg->length, NULL);
	if (rc == 0) {
		buffer[msg->length] = 0;
		EBCASC(buffer, msg->length);
		memcpy(sender, buffer, 8);
		sender[8] = 0;
		/* Remove trailing whitespace from the sender name. */
		for (i = 7; i >= 0; i--) {
			if (sender[i] != ' ' && sender[i] != '\t')
				break;
			sender[i] = 0;
		}
		spin_lock(&smsg_list_lock);
		list_for_each_entry(cb, &smsg_list, list)
			if (strncmp(buffer + 8, cb->prefix, cb->len) == 0) {
				cb->callback(sender, buffer + 8);
				break;
			}
		spin_unlock(&smsg_list_lock);
	}
	kfree(buffer);
}

int smsg_register_callback(const char *prefix,
			   void (*callback)(const char *from, char *str))
{
	struct smsg_callback *cb;

	cb = kmalloc(sizeof(struct smsg_callback), GFP_KERNEL);
	if (!cb)
		return -ENOMEM;
	cb->prefix = prefix;
	cb->len = strlen(prefix);
	cb->callback = callback;
	spin_lock_bh(&smsg_list_lock);
	list_add_tail(&cb->list, &smsg_list);
	spin_unlock_bh(&smsg_list_lock);
	return 0;
}

void smsg_unregister_callback(const char *prefix,
			      void (*callback)(const char *from,
					       char *str))
{
	struct smsg_callback *cb, *tmp;

	spin_lock_bh(&smsg_list_lock);
	cb = NULL;
	list_for_each_entry(tmp, &smsg_list, list)
		if (tmp->callback == callback &&
		    strcmp(tmp->prefix, prefix) == 0) {
			cb = tmp;
			list_del(&cb->list);
			break;
		}
	spin_unlock_bh(&smsg_list_lock);
	kfree(cb);
}

static int smsg_pm_freeze(struct device *dev)
{
#ifdef CONFIG_PM_DEBUG
	printk(KERN_WARNING "smsg_pm_freeze\n");
#endif
	if (smsg_path && iucv_path_connected) {
		iucv_path_sever(smsg_path, NULL);
		iucv_path_connected = 0;
	}
	return 0;
}

static int smsg_pm_restore_thaw(struct device *dev)
{
	int rc;

#ifdef CONFIG_PM_DEBUG
	printk(KERN_WARNING "smsg_pm_restore_thaw\n");
#endif
	if (smsg_path && !iucv_path_connected) {
		memset(smsg_path, 0, sizeof(*smsg_path));
		smsg_path->msglim = 255;
		smsg_path->flags = 0;
		rc = iucv_path_connect(smsg_path, &smsg_handler, "*MSG    ",
				       NULL, NULL, NULL);
#ifdef CONFIG_PM_DEBUG
		if (rc)
			printk(KERN_ERR
			       "iucv_path_connect returned with rc %i\n", rc);
#endif
		if (!rc)
			iucv_path_connected = 1;
		cpcmd("SET SMSG IUCV", NULL, 0, NULL);
	}
	return 0;
}

static const struct dev_pm_ops smsg_pm_ops = {
	.freeze = smsg_pm_freeze,
	.thaw = smsg_pm_restore_thaw,
	.restore = smsg_pm_restore_thaw,
};

static struct device_driver smsg_driver = {
	.owner = THIS_MODULE,
	.name = SMSGIUCV_DRV_NAME,
	.bus  = &iucv_bus,
	.pm = &smsg_pm_ops,
};

static void __exit smsg_exit(void)
{
	cpcmd("SET SMSG OFF", NULL, 0, NULL);
	device_unregister(smsg_dev);
	iucv_unregister(&smsg_handler, 1);
	driver_unregister(&smsg_driver);
}

static int __init smsg_init(void)
{
	int rc;

	if (!MACHINE_IS_VM) {
		rc = -EPROTONOSUPPORT;
		goto out;
	}
	rc = driver_register(&smsg_driver);
	if (rc != 0)
		goto out;
	rc = iucv_register(&smsg_handler, 1);
	if (rc)
		goto out_driver;
	smsg_path = iucv_path_alloc(255, 0, GFP_KERNEL);
	if (!smsg_path) {
		rc = -ENOMEM;
		goto out_register;
	}
	rc = iucv_path_connect(smsg_path, &smsg_handler, "*MSG    ",
			       NULL, NULL, NULL);
	if (rc)
		goto out_free_path;
	else
		iucv_path_connected = 1;
	smsg_dev = kzalloc(sizeof(struct device), GFP_KERNEL);
	if (!smsg_dev) {
		rc = -ENOMEM;
		goto out_free_path;
	}
	dev_set_name(smsg_dev, "smsg_iucv");
	smsg_dev->bus = &iucv_bus;
	smsg_dev->parent = iucv_root;
	smsg_dev->release = (void (*)(struct device *))kfree;
	smsg_dev->driver = &smsg_driver;
	rc = device_register(smsg_dev);
	if (rc)
		goto out_put;

	cpcmd("SET SMSG IUCV", NULL, 0, NULL);
	return 0;

out_put:
	put_device(smsg_dev);
out_free_path:
	iucv_path_free(smsg_path);
	smsg_path = NULL;
out_register:
	iucv_unregister(&smsg_handler, 1);
out_driver:
	driver_unregister(&smsg_driver);
out:
	return rc;
}

module_init(smsg_init);
module_exit(smsg_exit);
MODULE_LICENSE("GPL");

EXPORT_SYMBOL(smsg_register_callback);
EXPORT_SYMBOL(smsg_unregister_callback);
Commit	Line	Data
ab9953ff	1	// SPDX-License-Identifier: GPL-2.0+
1da177e4 LT	2	/*
	3	* IUCV special message driver
	4	*
6a1d96dc MS	5	* Copyright IBM Corp. 2003, 2009
6a1d96dc MS	6	*
1da177e4	7	* Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com)
1da177e4 LT	8	*/
	9
	10	#include <linux/module.h>
	11	#include <linux/init.h>
	12	#include <linux/errno.h>
	13	#include <linux/device.h>
5a0e3ad6	14	#include <linux/slab.h>
5da5e658	15	#include <net/iucv/iucv.h>
1da177e4 LT	16	#include <asm/cpcmd.h>
1da177e4 LT	17	#include <asm/ebcdic.h>
5da5e658	18	#include "smsgiucv.h"
1da177e4 LT	19
	20	struct smsg_callback {
	21	struct list_head list;
09003ed9	22	const char *prefix;
1da177e4	23	int len;
09003ed9	24	void (callback)(const char from, char *str);
1da177e4 LT	25	};
	26
	27	MODULE_AUTHOR
	28	("(C) 2003 IBM Corporation by Martin Schwidefsky (schwidefsky@de.ibm.com)");
	29	MODULE_DESCRIPTION ("Linux for S/390 IUCV special message driver");
	30
5da5e658	31	static struct iucv_path *smsg_path;
6a1d96dc MS	32	/* dummy device used as trigger for PM functions */
6a1d96dc MS	33	static struct device *smsg_dev;
5da5e658	34
1da177e4	35	static DEFINE_SPINLOCK(smsg_list_lock);
c11ca97e	36	static LIST_HEAD(smsg_list);
59b60e97	37	static int iucv_path_connected;
1da177e4	38
91e60eb6	39	static int smsg_path_pending(struct iucv_path , u8 , u8 *);
5da5e658 MS	40	static void smsg_message_pending(struct iucv_path , struct iucv_message );
	41
	42	static struct iucv_handler smsg_handler = {
	43	.path_pending = smsg_path_pending,
	44	.message_pending = smsg_message_pending,
	45	};
	46
91e60eb6	47	static int smsg_path_pending(struct iucv_path path, u8 ipvmid, u8 *ipuser)
1da177e4	48	{
08b01832	49	if (strncmp(ipvmid, "*MSG ", 8) != 0)
5da5e658 MS	50	return -EINVAL;
	51	/* Path pending from MSG. /
	52	return iucv_path_accept(path, &smsg_handler, "SMSGIUCV ", NULL);
1da177e4 LT	53	}
1da177e4 LT	54
5da5e658 MS	55	static void smsg_message_pending(struct iucv_path *path,
5da5e658 MS	56	struct iucv_message *msg)
1da177e4 LT	57	{
1da177e4 LT	58	struct smsg_callback *cb;
5da5e658	59	unsigned char *buffer;
15439d74	60	unsigned char sender[9];
15439d74	61	int rc, i;
1da177e4	62
5da5e658 MS	63	buffer = kmalloc(msg->length + 1, GFP_ATOMIC \| GFP_DMA);
	64	if (!buffer) {
	65	iucv_message_reject(path, msg);
1da177e4 LT	66	return;
1da177e4 LT	67	}
5da5e658	68	rc = iucv_message_receive(path, msg, 0, buffer, msg->length, NULL);
1da177e4	69	if (rc == 0) {
5da5e658 MS	70	buffer[msg->length] = 0;
	71	EBCASC(buffer, msg->length);
	72	memcpy(sender, buffer, 8);
15439d74 MS	73	sender[8] = 0;
	74	/* Remove trailing whitespace from the sender name. */
	75	for (i = 7; i >= 0; i--) {
	76	if (sender[i] != ' ' && sender[i] != '\t')
	77	break;
	78	sender[i] = 0;
	79	}
1da177e4 LT	80	spin_lock(&smsg_list_lock);
1da177e4 LT	81	list_for_each_entry(cb, &smsg_list, list)
5da5e658 MS	82	if (strncmp(buffer + 8, cb->prefix, cb->len) == 0) {
5da5e658 MS	83	cb->callback(sender, buffer + 8);
1da177e4 LT	84	break;
	85	}
	86	spin_unlock(&smsg_list_lock);
	87	}
5da5e658	88	kfree(buffer);
1da177e4 LT	89	}
1da177e4 LT	90
09003ed9 HB	91	int smsg_register_callback(const char *prefix,
09003ed9 HB	92	void (callback)(const char from, char *str))
1da177e4 LT	93	{
	94	struct smsg_callback *cb;
	95
	96	cb = kmalloc(sizeof(struct smsg_callback), GFP_KERNEL);
	97	if (!cb)
	98	return -ENOMEM;
	99	cb->prefix = prefix;
	100	cb->len = strlen(prefix);
	101	cb->callback = callback;
5da5e658	102	spin_lock_bh(&smsg_list_lock);
1da177e4	103	list_add_tail(&cb->list, &smsg_list);
5da5e658	104	spin_unlock_bh(&smsg_list_lock);
1da177e4 LT	105	return 0;
	106	}
	107
09003ed9 HB	108	void smsg_unregister_callback(const char *prefix,
	109	void (callback)(const char from,
	110	char *str))
1da177e4 LT	111	{
	112	struct smsg_callback cb, tmp;
	113
5da5e658	114	spin_lock_bh(&smsg_list_lock);
d2c993d8	115	cb = NULL;
1da177e4 LT	116	list_for_each_entry(tmp, &smsg_list, list)
	117	if (tmp->callback == callback &&
	118	strcmp(tmp->prefix, prefix) == 0) {
	119	cb = tmp;
	120	list_del(&cb->list);
	121	break;
	122	}
5da5e658	123	spin_unlock_bh(&smsg_list_lock);
1da177e4 LT	124	kfree(cb);
	125	}
	126
6a1d96dc MS	127	static int smsg_pm_freeze(struct device *dev)
	128	{
	129	#ifdef CONFIG_PM_DEBUG
	130	printk(KERN_WARNING "smsg_pm_freeze\n");
	131	#endif
59b60e97	132	if (smsg_path && iucv_path_connected) {
6a1d96dc	133	iucv_path_sever(smsg_path, NULL);
59b60e97 UB	134	iucv_path_connected = 0;
59b60e97 UB	135	}
6a1d96dc MS	136	return 0;
	137	}
	138
	139	static int smsg_pm_restore_thaw(struct device *dev)
	140	{
	141	int rc;
	142
	143	#ifdef CONFIG_PM_DEBUG
	144	printk(KERN_WARNING "smsg_pm_restore_thaw\n");
	145	#endif
1c8161a8	146	if (smsg_path && !iucv_path_connected) {
6a1d96dc MS	147	memset(smsg_path, 0, sizeof(*smsg_path));
	148	smsg_path->msglim = 255;
	149	smsg_path->flags = 0;
	150	rc = iucv_path_connect(smsg_path, &smsg_handler, "*MSG ",
	151	NULL, NULL, NULL);
8ca45667 MS	152	#ifdef CONFIG_PM_DEBUG
	153	if (rc)
	154	printk(KERN_ERR
	155	"iucv_path_connect returned with rc %i\n", rc);
	156	#endif
59b60e97 UB	157	if (!rc)
59b60e97 UB	158	iucv_path_connected = 1;
8ca45667	159	cpcmd("SET SMSG IUCV", NULL, 0, NULL);
6a1d96dc MS	160	}
	161	return 0;
	162	}
	163
47145210	164	static const struct dev_pm_ops smsg_pm_ops = {
6a1d96dc MS	165	.freeze = smsg_pm_freeze,
	166	.thaw = smsg_pm_restore_thaw,
	167	.restore = smsg_pm_restore_thaw,
	168	};
	169
5da5e658	170	static struct device_driver smsg_driver = {
6a1d96dc	171	.owner = THIS_MODULE,
1ffaa640	172	.name = SMSGIUCV_DRV_NAME,
5da5e658	173	.bus = &iucv_bus,
6a1d96dc	174	.pm = &smsg_pm_ops,
5da5e658 MS	175	};
	176
	177	static void __exit smsg_exit(void)
1da177e4	178	{
760dd0ee	179	cpcmd("SET SMSG OFF", NULL, 0, NULL);
6a1d96dc	180	device_unregister(smsg_dev);
5da5e658 MS	181	iucv_unregister(&smsg_handler, 1);
5da5e658 MS	182	driver_unregister(&smsg_driver);
1da177e4 LT	183	}
1da177e4 LT	184
5da5e658	185	static int __init smsg_init(void)
1da177e4	186	{
1da177e4 LT	187	int rc;
1da177e4 LT	188
0fc3ddd6 CB	189	if (!MACHINE_IS_VM) {
	190	rc = -EPROTONOSUPPORT;
	191	goto out;
	192	}
1da177e4	193	rc = driver_register(&smsg_driver);
5da5e658 MS	194	if (rc != 0)
	195	goto out;
	196	rc = iucv_register(&smsg_handler, 1);
d5ddc809	197	if (rc)
5da5e658	198	goto out_driver;
5da5e658 MS	199	smsg_path = iucv_path_alloc(255, 0, GFP_KERNEL);
	200	if (!smsg_path) {
	201	rc = -ENOMEM;
	202	goto out_register;
1da177e4	203	}
5da5e658 MS	204	rc = iucv_path_connect(smsg_path, &smsg_handler, "*MSG ",
5da5e658 MS	205	NULL, NULL, NULL);
d5ddc809	206	if (rc)
6a1d96dc	207	goto out_free_path;
59b60e97 UB	208	else
59b60e97 UB	209	iucv_path_connected = 1;
6a1d96dc MS	210	smsg_dev = kzalloc(sizeof(struct device), GFP_KERNEL);
	211	if (!smsg_dev) {
	212	rc = -ENOMEM;
	213	goto out_free_path;
	214	}
	215	dev_set_name(smsg_dev, "smsg_iucv");
	216	smsg_dev->bus = &iucv_bus;
	217	smsg_dev->parent = iucv_root;
	218	smsg_dev->release = (void ()(struct device ))kfree;
	219	smsg_dev->driver = &smsg_driver;
	220	rc = device_register(smsg_dev);
	221	if (rc)
c6304933	222	goto out_put;
6a1d96dc	223
6b979de3	224	cpcmd("SET SMSG IUCV", NULL, 0, NULL);
1da177e4	225	return 0;
5da5e658	226
c6304933 SO	227	out_put:
c6304933 SO	228	put_device(smsg_dev);
6a1d96dc	229	out_free_path:
5da5e658	230	iucv_path_free(smsg_path);
6a1d96dc	231	smsg_path = NULL;
5da5e658 MS	232	out_register:
	233	iucv_unregister(&smsg_handler, 1);
	234	out_driver:
	235	driver_unregister(&smsg_driver);
	236	out:
	237	return rc;
1da177e4 LT	238	}
	239
	240	module_init(smsg_init);
	241	module_exit(smsg_exit);
	242	MODULE_LICENSE("GPL");
	243
	244	EXPORT_SYMBOL(smsg_register_callback);
	245	EXPORT_SYMBOL(smsg_unregister_callback);