[linux-2.6-block.git] / drivers / uio / uio_hv_generic.c

// SPDX-License-Identifier: GPL-2.0
/*
 * uio_hv_generic - generic UIO driver for VMBus
 *
 * Copyright (c) 2013-2016 Brocade Communications Systems, Inc.
 * Copyright (c) 2016, Microsoft Corporation.
 *
 * Since the driver does not declare any device ids, you must allocate
 * id and bind the device to the driver yourself.  For example:
 *
 * Associate Network GUID with UIO device
 * # echo "f8615163-df3e-46c5-913f-f2d2f965ed0e" \
 *    > /sys/bus/vmbus/drivers/uio_hv_generic/new_id
 * Then rebind
 * # echo -n "ed963694-e847-4b2a-85af-bc9cfc11d6f3" \
 *    > /sys/bus/vmbus/drivers/hv_netvsc/unbind
 * # echo -n "ed963694-e847-4b2a-85af-bc9cfc11d6f3" \
 *    > /sys/bus/vmbus/drivers/uio_hv_generic/bind
 */
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <linux/device.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/uio_driver.h>
#include <linux/netdevice.h>
#include <linux/if_ether.h>
#include <linux/skbuff.h>
#include <linux/hyperv.h>
#include <linux/vmalloc.h>
#include <linux/slab.h>

#include "../hv/hyperv_vmbus.h"

#define DRIVER_VERSION	"0.02.1"
#define DRIVER_AUTHOR	"Stephen Hemminger <sthemmin at microsoft.com>"
#define DRIVER_DESC	"Generic UIO driver for VMBus devices"

#define HV_RING_SIZE	 512	/* pages */
#define SEND_BUFFER_SIZE (16 * 1024 * 1024)
#define RECV_BUFFER_SIZE (31 * 1024 * 1024)

/*
 * List of resources to be mapped to user space
 * can be extended up to MAX_UIO_MAPS(5) items
 */
enum hv_uio_map {
	TXRX_RING_MAP = 0,
	INT_PAGE_MAP,
	MON_PAGE_MAP,
	RECV_BUF_MAP,
	SEND_BUF_MAP
};

struct hv_uio_private_data {
	struct uio_info info;
	struct hv_device *device;
	atomic_t refcnt;

	void	*recv_buf;
	struct vmbus_gpadl recv_gpadl;
	char	recv_name[32];	/* "recv_4294967295" */

	void	*send_buf;
	struct vmbus_gpadl send_gpadl;
	char	send_name[32];
};

/*
 * This is the irqcontrol callback to be registered to uio_info.
 * It can be used to disable/enable interrupt from user space processes.
 *
 * @param info
 *  pointer to uio_info.
 * @param irq_state
 *  state value. 1 to enable interrupt, 0 to disable interrupt.
 */
static int
hv_uio_irqcontrol(struct uio_info *info, s32 irq_state)
{
	struct hv_uio_private_data *pdata = info->priv;
	struct hv_device *dev = pdata->device;

	dev->channel->inbound.ring_buffer->interrupt_mask = !irq_state;
	virt_mb();

	return 0;
}

/*
 * Callback from vmbus_event when something is in inbound ring.
 */
static void hv_uio_channel_cb(void *context)
{
	struct vmbus_channel *chan = context;
	struct hv_device *hv_dev = chan->device_obj;
	struct hv_uio_private_data *pdata = hv_get_drvdata(hv_dev);

	chan->inbound.ring_buffer->interrupt_mask = 1;
	virt_mb();

	uio_event_notify(&pdata->info);
}

/*
 * Callback from vmbus_event when channel is rescinded.
 */
static void hv_uio_rescind(struct vmbus_channel *channel)
{
	struct hv_device *hv_dev = channel->primary_channel->device_obj;
	struct hv_uio_private_data *pdata = hv_get_drvdata(hv_dev);

	/*
	 * Turn off the interrupt file handle
	 * Next read for event will return -EIO
	 */
	pdata->info.irq = 0;

	/* Wake up reader */
	uio_event_notify(&pdata->info);
}

/* Sysfs API to allow mmap of the ring buffers
 * The ring buffer is allocated as contiguous memory by vmbus_open
 */
static int hv_uio_ring_mmap(struct file *filp, struct kobject *kobj,
			    struct bin_attribute *attr,
			    struct vm_area_struct *vma)
{
	struct vmbus_channel *channel
		= container_of(kobj, struct vmbus_channel, kobj);
	void *ring_buffer = page_address(channel->ringbuffer_page);

	if (channel->state != CHANNEL_OPENED_STATE)
		return -ENODEV;

	return vm_iomap_memory(vma, virt_to_phys(ring_buffer),
			       channel->ringbuffer_pagecount << PAGE_SHIFT);
}

static const struct bin_attribute ring_buffer_bin_attr = {
	.attr = {
		.name = "ring",
		.mode = 0600,
	},
	.size = 2 * HV_RING_SIZE * PAGE_SIZE,
	.mmap = hv_uio_ring_mmap,
};

/* Callback from VMBUS subsystem when new channel created. */
static void
hv_uio_new_channel(struct vmbus_channel *new_sc)
{
	struct hv_device *hv_dev = new_sc->primary_channel->device_obj;
	struct device *device = &hv_dev->device;
	const size_t ring_bytes = HV_RING_SIZE * PAGE_SIZE;
	int ret;

	/* Create host communication ring */
	ret = vmbus_open(new_sc, ring_bytes, ring_bytes, NULL, 0,
			 hv_uio_channel_cb, new_sc);
	if (ret) {
		dev_err(device, "vmbus_open subchannel failed: %d\n", ret);
		return;
	}

	/* Disable interrupts on sub channel */
	new_sc->inbound.ring_buffer->interrupt_mask = 1;
	set_channel_read_mode(new_sc, HV_CALL_ISR);

	ret = sysfs_create_bin_file(&new_sc->kobj, &ring_buffer_bin_attr);
	if (ret) {
		dev_err(device, "sysfs create ring bin file failed; %d\n", ret);
		vmbus_close(new_sc);
	}
}

/* free the reserved buffers for send and receive */
static void
hv_uio_cleanup(struct hv_device *dev, struct hv_uio_private_data *pdata)
{
	if (pdata->send_gpadl.gpadl_handle) {
		vmbus_teardown_gpadl(dev->channel, &pdata->send_gpadl);
		vfree(pdata->send_buf);
	}

	if (pdata->recv_gpadl.gpadl_handle) {
		vmbus_teardown_gpadl(dev->channel, &pdata->recv_gpadl);
		vfree(pdata->recv_buf);
	}
}

/* VMBus primary channel is opened on first use */
static int
hv_uio_open(struct uio_info *info, struct inode *inode)
{
	struct hv_uio_private_data *pdata
		= container_of(info, struct hv_uio_private_data, info);
	struct hv_device *dev = pdata->device;
	int ret;

	if (atomic_inc_return(&pdata->refcnt) != 1)
		return 0;

	vmbus_set_chn_rescind_callback(dev->channel, hv_uio_rescind);
	vmbus_set_sc_create_callback(dev->channel, hv_uio_new_channel);

	ret = vmbus_connect_ring(dev->channel,
				 hv_uio_channel_cb, dev->channel);
	if (ret == 0)
		dev->channel->inbound.ring_buffer->interrupt_mask = 1;
	else
		atomic_dec(&pdata->refcnt);

	return ret;
}

/* VMBus primary channel is closed on last close */
static int
hv_uio_release(struct uio_info *info, struct inode *inode)
{
	struct hv_uio_private_data *pdata
		= container_of(info, struct hv_uio_private_data, info);
	struct hv_device *dev = pdata->device;
	int ret = 0;

	if (atomic_dec_and_test(&pdata->refcnt))
		ret = vmbus_disconnect_ring(dev->channel);

	return ret;
}

static int
hv_uio_probe(struct hv_device *dev,
	     const struct hv_vmbus_device_id *dev_id)
{
	struct vmbus_channel *channel = dev->channel;
	struct hv_uio_private_data *pdata;
	void *ring_buffer;
	int ret;

	/* Communicating with host has to be via shared memory not hypercall */
	if (!channel->offermsg.monitor_allocated) {
		dev_err(&dev->device, "vmbus channel requires hypercall\n");
		return -ENOTSUPP;
	}

	pdata = devm_kzalloc(&dev->device, sizeof(*pdata), GFP_KERNEL);
	if (!pdata)
		return -ENOMEM;

	ret = vmbus_alloc_ring(channel, HV_RING_SIZE * PAGE_SIZE,
			       HV_RING_SIZE * PAGE_SIZE);
	if (ret)
		return ret;

	set_channel_read_mode(channel, HV_CALL_ISR);

	/* Fill general uio info */
	pdata->info.name = "uio_hv_generic";
	pdata->info.version = DRIVER_VERSION;
	pdata->info.irqcontrol = hv_uio_irqcontrol;
	pdata->info.open = hv_uio_open;
	pdata->info.release = hv_uio_release;
	pdata->info.irq = UIO_IRQ_CUSTOM;
	atomic_set(&pdata->refcnt, 0);

	/* mem resources */
	pdata->info.mem[TXRX_RING_MAP].name = "txrx_rings";
	ring_buffer = page_address(channel->ringbuffer_page);
	pdata->info.mem[TXRX_RING_MAP].addr
		= (uintptr_t)virt_to_phys(ring_buffer);
	pdata->info.mem[TXRX_RING_MAP].size
		= channel->ringbuffer_pagecount << PAGE_SHIFT;
	pdata->info.mem[TXRX_RING_MAP].memtype = UIO_MEM_IOVA;

	pdata->info.mem[INT_PAGE_MAP].name = "int_page";
	pdata->info.mem[INT_PAGE_MAP].addr
		= (uintptr_t)vmbus_connection.int_page;
	pdata->info.mem[INT_PAGE_MAP].size = PAGE_SIZE;
	pdata->info.mem[INT_PAGE_MAP].memtype = UIO_MEM_LOGICAL;

	pdata->info.mem[MON_PAGE_MAP].name = "monitor_page";
	pdata->info.mem[MON_PAGE_MAP].addr
		= (uintptr_t)vmbus_connection.monitor_pages[1];
	pdata->info.mem[MON_PAGE_MAP].size = PAGE_SIZE;
	pdata->info.mem[MON_PAGE_MAP].memtype = UIO_MEM_LOGICAL;

	pdata->recv_buf = vzalloc(RECV_BUFFER_SIZE);
	if (pdata->recv_buf == NULL) {
		ret = -ENOMEM;
		goto fail_free_ring;
	}

	ret = vmbus_establish_gpadl(channel, pdata->recv_buf,
				    RECV_BUFFER_SIZE, &pdata->recv_gpadl);
	if (ret) {
		vfree(pdata->recv_buf);
		goto fail_close;
	}

	/* put Global Physical Address Label in name */
	snprintf(pdata->recv_name, sizeof(pdata->recv_name),
		 "recv:%u", pdata->recv_gpadl.gpadl_handle);
	pdata->info.mem[RECV_BUF_MAP].name = pdata->recv_name;
	pdata->info.mem[RECV_BUF_MAP].addr
		= (uintptr_t)pdata->recv_buf;
	pdata->info.mem[RECV_BUF_MAP].size = RECV_BUFFER_SIZE;
	pdata->info.mem[RECV_BUF_MAP].memtype = UIO_MEM_VIRTUAL;

	pdata->send_buf = vzalloc(SEND_BUFFER_SIZE);
	if (pdata->send_buf == NULL) {
		ret = -ENOMEM;
		goto fail_close;
	}

	ret = vmbus_establish_gpadl(channel, pdata->send_buf,
				    SEND_BUFFER_SIZE, &pdata->send_gpadl);
	if (ret) {
		vfree(pdata->send_buf);
		goto fail_close;
	}

	snprintf(pdata->send_name, sizeof(pdata->send_name),
		 "send:%u", pdata->send_gpadl.gpadl_handle);
	pdata->info.mem[SEND_BUF_MAP].name = pdata->send_name;
	pdata->info.mem[SEND_BUF_MAP].addr
		= (uintptr_t)pdata->send_buf;
	pdata->info.mem[SEND_BUF_MAP].size = SEND_BUFFER_SIZE;
	pdata->info.mem[SEND_BUF_MAP].memtype = UIO_MEM_VIRTUAL;

	pdata->info.priv = pdata;
	pdata->device = dev;

	ret = uio_register_device(&dev->device, &pdata->info);
	if (ret) {
		dev_err(&dev->device, "hv_uio register failed\n");
		goto fail_close;
	}

	ret = sysfs_create_bin_file(&channel->kobj, &ring_buffer_bin_attr);
	if (ret)
		dev_notice(&dev->device,
			   "sysfs create ring bin file failed; %d\n", ret);

	hv_set_drvdata(dev, pdata);

	return 0;

fail_close:
	hv_uio_cleanup(dev, pdata);
fail_free_ring:
	vmbus_free_ring(dev->channel);

	return ret;
}

static void
hv_uio_remove(struct hv_device *dev)
{
	struct hv_uio_private_data *pdata = hv_get_drvdata(dev);

	if (!pdata)
		return;

	sysfs_remove_bin_file(&dev->channel->kobj, &ring_buffer_bin_attr);
	uio_unregister_device(&pdata->info);
	hv_uio_cleanup(dev, pdata);

	vmbus_free_ring(dev->channel);
}

static struct hv_driver hv_uio_drv = {
	.name = "uio_hv_generic",
	.id_table = NULL, /* only dynamic id's */
	.probe = hv_uio_probe,
	.remove = hv_uio_remove,
};

static int __init
hyperv_module_init(void)
{
	return vmbus_driver_register(&hv_uio_drv);
}

static void __exit
hyperv_module_exit(void)
{
	vmbus_driver_unregister(&hv_uio_drv);
}

module_init(hyperv_module_init);
module_exit(hyperv_module_exit);

MODULE_VERSION(DRIVER_VERSION);
MODULE_LICENSE("GPL v2");
MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
Commit	Line	Data
bce5c2ea	1	// SPDX-License-Identifier: GPL-2.0
95096f2f SH	2	/*
	3	* uio_hv_generic - generic UIO driver for VMBus
	4	*
	5	* Copyright (c) 2013-2016 Brocade Communications Systems, Inc.
	6	* Copyright (c) 2016, Microsoft Corporation.
	7	*
95096f2f SH	8	* Since the driver does not declare any device ids, you must allocate
	9	* id and bind the device to the driver yourself. For example:
	10	*
42896968	11	* Associate Network GUID with UIO device
95096f2f	12	* # echo "f8615163-df3e-46c5-913f-f2d2f965ed0e" \
42896968 SH	13	* > /sys/bus/vmbus/drivers/uio_hv_generic/new_id
	14	* Then rebind
	15	* # echo -n "ed963694-e847-4b2a-85af-bc9cfc11d6f3" \
95096f2f	16	* > /sys/bus/vmbus/drivers/hv_netvsc/unbind
42896968	17	* # echo -n "ed963694-e847-4b2a-85af-bc9cfc11d6f3" \
95096f2f SH	18	* > /sys/bus/vmbus/drivers/uio_hv_generic/bind
95096f2f SH	19	*/
95096f2f SH	20	#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
	21
	22	#include <linux/device.h>
	23	#include <linux/kernel.h>
	24	#include <linux/module.h>
	25	#include <linux/uio_driver.h>
	26	#include <linux/netdevice.h>
	27	#include <linux/if_ether.h>
	28	#include <linux/skbuff.h>
	29	#include <linux/hyperv.h>
	30	#include <linux/vmalloc.h>
	31	#include <linux/slab.h>
	32
	33	#include "../hv/hyperv_vmbus.h"
	34
108ddb8f	35	#define DRIVER_VERSION "0.02.1"
95096f2f SH	36	#define DRIVER_AUTHOR "Stephen Hemminger <sthemmin at microsoft.com>"
	37	#define DRIVER_DESC "Generic UIO driver for VMBus devices"
	38
e7d21464	39	#define HV_RING_SIZE 512 /* pages */
108ddb8f SH	40	#define SEND_BUFFER_SIZE (16 * 1024 * 1024)
108ddb8f SH	41	#define RECV_BUFFER_SIZE (31 * 1024 * 1024)
e7d21464	42
95096f2f SH	43	/*
	44	* List of resources to be mapped to user space
	45	* can be extended up to MAX_UIO_MAPS(5) items
	46	*/
	47	enum hv_uio_map {
	48	TXRX_RING_MAP = 0,
	49	INT_PAGE_MAP,
	50	MON_PAGE_MAP,
e7d21464 SH	51	RECV_BUF_MAP,
e7d21464 SH	52	SEND_BUF_MAP
95096f2f SH	53	};
95096f2f SH	54
95096f2f SH	55	struct hv_uio_private_data {
	56	struct uio_info info;
	57	struct hv_device *device;
cdfa835c	58	atomic_t refcnt;
e7d21464 SH	59
e7d21464 SH	60	void *recv_buf;
d4dccf35	61	struct vmbus_gpadl recv_gpadl;
e7d21464 SH	62	char recv_name[32]; /* "recv_4294967295" */
	63
	64	void *send_buf;
d4dccf35	65	struct vmbus_gpadl send_gpadl;
e7d21464	66	char send_name[32];
95096f2f SH	67	};
95096f2f SH	68
95096f2f SH	69	/*
	70	* This is the irqcontrol callback to be registered to uio_info.
	71	* It can be used to disable/enable interrupt from user space processes.
	72	*
	73	* @param info
	74	* pointer to uio_info.
	75	* @param irq_state
	76	* state value. 1 to enable interrupt, 0 to disable interrupt.
	77	*/
	78	static int
	79	hv_uio_irqcontrol(struct uio_info *info, s32 irq_state)
	80	{
	81	struct hv_uio_private_data *pdata = info->priv;
	82	struct hv_device *dev = pdata->device;
	83
	84	dev->channel->inbound.ring_buffer->interrupt_mask = !irq_state;
	85	virt_mb();
	86
	87	return 0;
	88	}
	89
	90	/*
	91	* Callback from vmbus_event when something is in inbound ring.
	92	*/
	93	static void hv_uio_channel_cb(void *context)
	94	{
135db384 SH	95	struct vmbus_channel *chan = context;
	96	struct hv_device *hv_dev = chan->device_obj;
	97	struct hv_uio_private_data *pdata = hv_get_drvdata(hv_dev);
95096f2f	98
135db384	99	chan->inbound.ring_buffer->interrupt_mask = 1;
95096f2f SH	100	virt_mb();
	101
	102	uio_event_notify(&pdata->info);
	103	}
	104
ca3cda6f SH	105	/*
	106	* Callback from vmbus_event when channel is rescinded.
	107	*/
	108	static void hv_uio_rescind(struct vmbus_channel *channel)
	109	{
	110	struct hv_device *hv_dev = channel->primary_channel->device_obj;
	111	struct hv_uio_private_data *pdata = hv_get_drvdata(hv_dev);
	112
	113	/*
	114	* Turn off the interrupt file handle
	115	* Next read for event will return -EIO
	116	*/
	117	pdata->info.irq = 0;
	118
	119	/* Wake up reader */
	120	uio_event_notify(&pdata->info);
	121	}
e7d21464	122
ce3d1536 SH	123	/* Sysfs API to allow mmap of the ring buffers
ce3d1536 SH	124	* The ring buffer is allocated as contiguous memory by vmbus_open
37b96a49	125	*/
37b96a49 SH	126	static int hv_uio_ring_mmap(struct file filp, struct kobject kobj,
	127	struct bin_attribute *attr,
	128	struct vm_area_struct *vma)
	129	{
	130	struct vmbus_channel *channel
	131	= container_of(kobj, struct vmbus_channel, kobj);
52a42c2a	132	void *ring_buffer = page_address(channel->ringbuffer_page);
37b96a49	133
cdfa835c SH	134	if (channel->state != CHANNEL_OPENED_STATE)
cdfa835c SH	135	return -ENODEV;
37b96a49	136
52a42c2a	137	return vm_iomap_memory(vma, virt_to_phys(ring_buffer),
ce3d1536	138	channel->ringbuffer_pagecount << PAGE_SHIFT);
37b96a49 SH	139	}
37b96a49 SH	140
6e3d66b8	141	static const struct bin_attribute ring_buffer_bin_attr = {
37b96a49 SH	142	.attr = {
	143	.name = "ring",
	144	.mode = 0600,
37b96a49	145	},
6e3d66b8	146	.size = 2 * HV_RING_SIZE * PAGE_SIZE,
37b96a49 SH	147	.mmap = hv_uio_ring_mmap,
	148	};
	149
135db384	150	/* Callback from VMBUS subsystem when new channel created. */
37b96a49 SH	151	static void
	152	hv_uio_new_channel(struct vmbus_channel *new_sc)
	153	{
	154	struct hv_device *hv_dev = new_sc->primary_channel->device_obj;
	155	struct device *device = &hv_dev->device;
37b96a49 SH	156	const size_t ring_bytes = HV_RING_SIZE * PAGE_SIZE;
	157	int ret;
	158
	159	/* Create host communication ring */
	160	ret = vmbus_open(new_sc, ring_bytes, ring_bytes, NULL, 0,
135db384	161	hv_uio_channel_cb, new_sc);
37b96a49 SH	162	if (ret) {
	163	dev_err(device, "vmbus_open subchannel failed: %d\n", ret);
	164	return;
	165	}
	166
	167	/* Disable interrupts on sub channel */
	168	new_sc->inbound.ring_buffer->interrupt_mask = 1;
	169	set_channel_read_mode(new_sc, HV_CALL_ISR);
	170
	171	ret = sysfs_create_bin_file(&new_sc->kobj, &ring_buffer_bin_attr);
	172	if (ret) {
	173	dev_err(device, "sysfs create ring bin file failed; %d\n", ret);
	174	vmbus_close(new_sc);
	175	}
	176	}
	177
cdfa835c	178	/* free the reserved buffers for send and receive */
e7d21464 SH	179	static void
	180	hv_uio_cleanup(struct hv_device dev, struct hv_uio_private_data pdata)
	181	{
d4dccf35 TL	182	if (pdata->send_gpadl.gpadl_handle) {
d4dccf35 TL	183	vmbus_teardown_gpadl(dev->channel, &pdata->send_gpadl);
cdfa835c SH	184	vfree(pdata->send_buf);
cdfa835c SH	185	}
e7d21464	186
d4dccf35 TL	187	if (pdata->recv_gpadl.gpadl_handle) {
d4dccf35 TL	188	vmbus_teardown_gpadl(dev->channel, &pdata->recv_gpadl);
cdfa835c SH	189	vfree(pdata->recv_buf);
	190	}
	191	}
	192
	193	/* VMBus primary channel is opened on first use */
	194	static int
	195	hv_uio_open(struct uio_info info, struct inode inode)
	196	{
	197	struct hv_uio_private_data *pdata
	198	= container_of(info, struct hv_uio_private_data, info);
	199	struct hv_device *dev = pdata->device;
	200	int ret;
	201
	202	if (atomic_inc_return(&pdata->refcnt) != 1)
	203	return 0;
	204
5e3c420d SH	205	vmbus_set_chn_rescind_callback(dev->channel, hv_uio_rescind);
	206	vmbus_set_sc_create_callback(dev->channel, hv_uio_new_channel);
	207
cdfa835c SH	208	ret = vmbus_connect_ring(dev->channel,
cdfa835c SH	209	hv_uio_channel_cb, dev->channel);
cdfa835c SH	210	if (ret == 0)
	211	dev->channel->inbound.ring_buffer->interrupt_mask = 1;
	212	else
	213	atomic_dec(&pdata->refcnt);
	214
	215	return ret;
	216	}
	217
	218	/* VMBus primary channel is closed on last close */
	219	static int
	220	hv_uio_release(struct uio_info info, struct inode inode)
	221	{
	222	struct hv_uio_private_data *pdata
	223	= container_of(info, struct hv_uio_private_data, info);
	224	struct hv_device *dev = pdata->device;
	225	int ret = 0;
	226
	227	if (atomic_dec_and_test(&pdata->refcnt))
	228	ret = vmbus_disconnect_ring(dev->channel);
	229
	230	return ret;
e7d21464 SH	231	}
e7d21464 SH	232
95096f2f SH	233	static int
	234	hv_uio_probe(struct hv_device *dev,
	235	const struct hv_vmbus_device_id *dev_id)
	236	{
cdfa835c	237	struct vmbus_channel *channel = dev->channel;
95096f2f	238	struct hv_uio_private_data *pdata;
cdfa835c	239	void *ring_buffer;
95096f2f SH	240	int ret;
95096f2f SH	241
cdfa835c SH	242	/* Communicating with host has to be via shared memory not hypercall */
	243	if (!channel->offermsg.monitor_allocated) {
	244	dev_err(&dev->device, "vmbus channel requires hypercall\n");
	245	return -ENOTSUPP;
	246	}
	247
74e71964	248	pdata = devm_kzalloc(&dev->device, sizeof(*pdata), GFP_KERNEL);
95096f2f SH	249	if (!pdata)
	250	return -ENOMEM;
	251
cdfa835c SH	252	ret = vmbus_alloc_ring(channel, HV_RING_SIZE * PAGE_SIZE,
cdfa835c SH	253	HV_RING_SIZE * PAGE_SIZE);
95096f2f	254	if (ret)
74e71964	255	return ret;
95096f2f	256
cdfa835c	257	set_channel_read_mode(channel, HV_CALL_ISR);
95096f2f SH	258
	259	/* Fill general uio info */
	260	pdata->info.name = "uio_hv_generic";
	261	pdata->info.version = DRIVER_VERSION;
	262	pdata->info.irqcontrol = hv_uio_irqcontrol;
cdfa835c SH	263	pdata->info.open = hv_uio_open;
cdfa835c SH	264	pdata->info.release = hv_uio_release;
95096f2f	265	pdata->info.irq = UIO_IRQ_CUSTOM;
cdfa835c	266	atomic_set(&pdata->refcnt, 0);
95096f2f SH	267
	268	/* mem resources */
	269	pdata->info.mem[TXRX_RING_MAP].name = "txrx_rings";
cdfa835c	270	ring_buffer = page_address(channel->ringbuffer_page);
95096f2f	271	pdata->info.mem[TXRX_RING_MAP].addr
cdfa835c	272	= (uintptr_t)virt_to_phys(ring_buffer);
95096f2f	273	pdata->info.mem[TXRX_RING_MAP].size
cdfa835c	274	= channel->ringbuffer_pagecount << PAGE_SHIFT;
9da197f1	275	pdata->info.mem[TXRX_RING_MAP].memtype = UIO_MEM_IOVA;
95096f2f SH	276
95096f2f SH	277	pdata->info.mem[INT_PAGE_MAP].name = "int_page";
9c40546c	278	pdata->info.mem[INT_PAGE_MAP].addr
72d14657	279	= (uintptr_t)vmbus_connection.int_page;
95096f2f SH	280	pdata->info.mem[INT_PAGE_MAP].size = PAGE_SIZE;
	281	pdata->info.mem[INT_PAGE_MAP].memtype = UIO_MEM_LOGICAL;
	282
9c40546c SH	283	pdata->info.mem[MON_PAGE_MAP].name = "monitor_page";
9c40546c SH	284	pdata->info.mem[MON_PAGE_MAP].addr
72d14657	285	= (uintptr_t)vmbus_connection.monitor_pages[1];
95096f2f SH	286	pdata->info.mem[MON_PAGE_MAP].size = PAGE_SIZE;
	287	pdata->info.mem[MON_PAGE_MAP].memtype = UIO_MEM_LOGICAL;
	288
e7d21464 SH	289	pdata->recv_buf = vzalloc(RECV_BUFFER_SIZE);
	290	if (pdata->recv_buf == NULL) {
	291	ret = -ENOMEM;
0b0226be	292	goto fail_free_ring;
e7d21464 SH	293	}
e7d21464 SH	294
cdfa835c	295	ret = vmbus_establish_gpadl(channel, pdata->recv_buf,
e7d21464	296	RECV_BUFFER_SIZE, &pdata->recv_gpadl);
3ee098f9 CJ	297	if (ret) {
3ee098f9 CJ	298	vfree(pdata->recv_buf);
e7d21464	299	goto fail_close;
3ee098f9	300	}
e7d21464 SH	301
	302	/* put Global Physical Address Label in name */
	303	snprintf(pdata->recv_name, sizeof(pdata->recv_name),
d4dccf35	304	"recv:%u", pdata->recv_gpadl.gpadl_handle);
e7d21464 SH	305	pdata->info.mem[RECV_BUF_MAP].name = pdata->recv_name;
e7d21464 SH	306	pdata->info.mem[RECV_BUF_MAP].addr
d6088e9a	307	= (uintptr_t)pdata->recv_buf;
e7d21464 SH	308	pdata->info.mem[RECV_BUF_MAP].size = RECV_BUFFER_SIZE;
	309	pdata->info.mem[RECV_BUF_MAP].memtype = UIO_MEM_VIRTUAL;
	310
e7d21464 SH	311	pdata->send_buf = vzalloc(SEND_BUFFER_SIZE);
	312	if (pdata->send_buf == NULL) {
	313	ret = -ENOMEM;
	314	goto fail_close;
	315	}
	316
cdfa835c	317	ret = vmbus_establish_gpadl(channel, pdata->send_buf,
e7d21464	318	SEND_BUFFER_SIZE, &pdata->send_gpadl);
3ee098f9 CJ	319	if (ret) {
3ee098f9 CJ	320	vfree(pdata->send_buf);
e7d21464	321	goto fail_close;
3ee098f9	322	}
e7d21464 SH	323
e7d21464 SH	324	snprintf(pdata->send_name, sizeof(pdata->send_name),
d4dccf35	325	"send:%u", pdata->send_gpadl.gpadl_handle);
e7d21464 SH	326	pdata->info.mem[SEND_BUF_MAP].name = pdata->send_name;
e7d21464 SH	327	pdata->info.mem[SEND_BUF_MAP].addr
d6088e9a	328	= (uintptr_t)pdata->send_buf;
e7d21464 SH	329	pdata->info.mem[SEND_BUF_MAP].size = SEND_BUFFER_SIZE;
	330	pdata->info.mem[SEND_BUF_MAP].memtype = UIO_MEM_VIRTUAL;
	331
95096f2f SH	332	pdata->info.priv = pdata;
	333	pdata->device = dev;
	334
	335	ret = uio_register_device(&dev->device, &pdata->info);
	336	if (ret) {
	337	dev_err(&dev->device, "hv_uio register failed\n");
	338	goto fail_close;
	339	}
	340
cdfa835c	341	ret = sysfs_create_bin_file(&channel->kobj, &ring_buffer_bin_attr);
9ab877a6 SH	342	if (ret)
	343	dev_notice(&dev->device,
	344	"sysfs create ring bin file failed; %d\n", ret);
	345
95096f2f SH	346	hv_set_drvdata(dev, pdata);
	347
	348	return 0;
	349
	350	fail_close:
e7d21464	351	hv_uio_cleanup(dev, pdata);
0b0226be CJ	352	fail_free_ring:
0b0226be CJ	353	vmbus_free_ring(dev->channel);
95096f2f SH	354
	355	return ret;
	356	}
	357
96ec2939	358	static void
95096f2f SH	359	hv_uio_remove(struct hv_device *dev)
	360	{
	361	struct hv_uio_private_data *pdata = hv_get_drvdata(dev);
	362
	363	if (!pdata)
96ec2939	364	return;
95096f2f	365
7066c2f6	366	sysfs_remove_bin_file(&dev->channel->kobj, &ring_buffer_bin_attr);
95096f2f	367	uio_unregister_device(&pdata->info);
e7d21464	368	hv_uio_cleanup(dev, pdata);
cdfa835c SH	369
cdfa835c SH	370	vmbus_free_ring(dev->channel);
95096f2f SH	371	}
	372
	373	static struct hv_driver hv_uio_drv = {
	374	.name = "uio_hv_generic",
	375	.id_table = NULL, /* only dynamic id's */
	376	.probe = hv_uio_probe,
	377	.remove = hv_uio_remove,
	378	};
	379
	380	static int __init
	381	hyperv_module_init(void)
	382	{
	383	return vmbus_driver_register(&hv_uio_drv);
	384	}
	385
	386	static void __exit
	387	hyperv_module_exit(void)
	388	{
	389	vmbus_driver_unregister(&hv_uio_drv);
	390	}
	391
	392	module_init(hyperv_module_init);
	393	module_exit(hyperv_module_exit);
	394
	395	MODULE_VERSION(DRIVER_VERSION);
	396	MODULE_LICENSE("GPL v2");
	397	MODULE_AUTHOR(DRIVER_AUTHOR);
	398	MODULE_DESCRIPTION(DRIVER_DESC);