xen-kbdfront.c 9.6 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13
/*
 * Xen para-virtual input device
 *
 * Copyright (C) 2005 Anthony Liguori <aliguori@us.ibm.com>
 * Copyright (C) 2006-2008 Red Hat, Inc., Markus Armbruster <armbru@redhat.com>
 *
 *  Based on linux/drivers/input/mouse/sermouse.c
 *
 *  This file is subject to the terms and conditions of the GNU General Public
 *  License. See the file COPYING in the main directory of this archive for
 *  more details.
 */

J
Joe Perches 已提交
14 15
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

16 17 18 19
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/module.h>
#include <linux/input.h>
20
#include <linux/slab.h>
21

22
#include <asm/xen/hypervisor.h>
23 24

#include <xen/xen.h>
25 26
#include <xen/events.h>
#include <xen/page.h>
27 28
#include <xen/grant_table.h>
#include <xen/interface/grant_table.h>
29 30 31
#include <xen/interface/io/fbif.h>
#include <xen/interface/io/kbdif.h>
#include <xen/xenbus.h>
32
#include <xen/platform_pci.h>
33 34 35 36 37

struct xenkbd_info {
	struct input_dev *kbd;
	struct input_dev *ptr;
	struct xenkbd_page *page;
38
	int gref;
39 40 41 42 43
	int irq;
	struct xenbus_device *xbdev;
	char phys[32];
};

44 45 46 47 48 49
enum { KPARAM_X, KPARAM_Y, KPARAM_CNT };
static int ptr_size[KPARAM_CNT] = { XENFB_WIDTH, XENFB_HEIGHT };
module_param_array(ptr_size, int, NULL, 0444);
MODULE_PARM_DESC(ptr_size,
	"Pointing device width, height in pixels (default 800,600)");

50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78
static int xenkbd_remove(struct xenbus_device *);
static int xenkbd_connect_backend(struct xenbus_device *, struct xenkbd_info *);
static void xenkbd_disconnect_backend(struct xenkbd_info *);

/*
 * Note: if you need to send out events, see xenfb_do_update() for how
 * to do that.
 */

static irqreturn_t input_handler(int rq, void *dev_id)
{
	struct xenkbd_info *info = dev_id;
	struct xenkbd_page *page = info->page;
	__u32 cons, prod;

	prod = page->in_prod;
	if (prod == page->in_cons)
		return IRQ_HANDLED;
	rmb();			/* ensure we see ring contents up to prod */
	for (cons = page->in_cons; cons != prod; cons++) {
		union xenkbd_in_event *event;
		struct input_dev *dev;
		event = &XENKBD_IN_RING_REF(page, cons);

		dev = info->ptr;
		switch (event->type) {
		case XENKBD_TYPE_MOTION:
			input_report_rel(dev, REL_X, event->motion.rel_x);
			input_report_rel(dev, REL_Y, event->motion.rel_y);
79 80 81
			if (event->motion.rel_z)
				input_report_rel(dev, REL_WHEEL,
						 -event->motion.rel_z);
82 83 84 85 86 87 88 89 90 91 92
			break;
		case XENKBD_TYPE_KEY:
			dev = NULL;
			if (test_bit(event->key.keycode, info->kbd->keybit))
				dev = info->kbd;
			if (test_bit(event->key.keycode, info->ptr->keybit))
				dev = info->ptr;
			if (dev)
				input_report_key(dev, event->key.keycode,
						 event->key.pressed);
			else
93 94
				pr_warn("unhandled keycode 0x%x\n",
					event->key.keycode);
95 96 97 98
			break;
		case XENKBD_TYPE_POS:
			input_report_abs(dev, ABS_X, event->pos.abs_x);
			input_report_abs(dev, ABS_Y, event->pos.abs_y);
99 100 101
			if (event->pos.rel_z)
				input_report_rel(dev, REL_WHEEL,
						 -event->pos.rel_z);
102 103 104 105 106 107 108 109 110 111 112 113
			break;
		}
		if (dev)
			input_sync(dev);
	}
	mb();			/* ensure we got ring contents */
	page->in_cons = cons;
	notify_remote_via_irq(info->irq);

	return IRQ_HANDLED;
}

B
Bill Pemberton 已提交
114
static int xenkbd_probe(struct xenbus_device *dev,
115 116
				  const struct xenbus_device_id *id)
{
117 118
	int ret, i;
	unsigned int abs;
119 120 121 122 123 124 125 126
	struct xenkbd_info *info;
	struct input_dev *kbd, *ptr;

	info = kzalloc(sizeof(*info), GFP_KERNEL);
	if (!info) {
		xenbus_dev_fatal(dev, -ENOMEM, "allocating info structure");
		return -ENOMEM;
	}
127
	dev_set_drvdata(&dev->dev, info);
128 129
	info->xbdev = dev;
	info->irq = -1;
130
	info->gref = -1;
131 132 133 134 135 136
	snprintf(info->phys, sizeof(info->phys), "xenbus/%s", dev->nodename);

	info->page = (void *)__get_free_page(GFP_KERNEL | __GFP_ZERO);
	if (!info->page)
		goto error_nomem;

137
	/* Set input abs params to match backend screen res */
138
	abs = xenbus_read_unsigned(dev->otherend, "feature-abs-pointer", 0);
139 140 141 142
	ptr_size[KPARAM_X] = xenbus_read_unsigned(dev->otherend, "width",
						  ptr_size[KPARAM_X]);
	ptr_size[KPARAM_Y] = xenbus_read_unsigned(dev->otherend, "height",
						  ptr_size[KPARAM_Y]);
143
	if (abs) {
144 145
		ret = xenbus_write(XBT_NIL, dev->nodename,
				   "request-abs-pointer", "1");
146
		if (ret) {
147
			pr_warn("xenkbd: can't request abs-pointer\n");
148 149 150
			abs = 0;
		}
	}
151

152 153 154 155 156 157 158 159 160
	/* keyboard */
	kbd = input_allocate_device();
	if (!kbd)
		goto error_nomem;
	kbd->name = "Xen Virtual Keyboard";
	kbd->phys = info->phys;
	kbd->id.bustype = BUS_PCI;
	kbd->id.vendor = 0x5853;
	kbd->id.product = 0xffff;
161 162

	__set_bit(EV_KEY, kbd->evbit);
163
	for (i = KEY_ESC; i < KEY_UNKNOWN; i++)
164
		__set_bit(i, kbd->keybit);
165
	for (i = KEY_OK; i < KEY_MAX; i++)
166
		__set_bit(i, kbd->keybit);
167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184

	ret = input_register_device(kbd);
	if (ret) {
		input_free_device(kbd);
		xenbus_dev_fatal(dev, ret, "input_register_device(kbd)");
		goto error;
	}
	info->kbd = kbd;

	/* pointing device */
	ptr = input_allocate_device();
	if (!ptr)
		goto error_nomem;
	ptr->name = "Xen Virtual Pointer";
	ptr->phys = info->phys;
	ptr->id.bustype = BUS_PCI;
	ptr->id.vendor = 0x5853;
	ptr->id.product = 0xfffe;
185 186 187

	if (abs) {
		__set_bit(EV_ABS, ptr->evbit);
188 189
		input_set_abs_params(ptr, ABS_X, 0, ptr_size[KPARAM_X], 0, 0);
		input_set_abs_params(ptr, ABS_Y, 0, ptr_size[KPARAM_Y], 0, 0);
190 191 192 193 194 195 196
	} else {
		input_set_capability(ptr, EV_REL, REL_X);
		input_set_capability(ptr, EV_REL, REL_Y);
	}
	input_set_capability(ptr, EV_REL, REL_WHEEL);

	__set_bit(EV_KEY, ptr->evbit);
197
	for (i = BTN_LEFT; i <= BTN_TASK; i++)
198
		__set_bit(i, ptr->keybit);
199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223

	ret = input_register_device(ptr);
	if (ret) {
		input_free_device(ptr);
		xenbus_dev_fatal(dev, ret, "input_register_device(ptr)");
		goto error;
	}
	info->ptr = ptr;

	ret = xenkbd_connect_backend(dev, info);
	if (ret < 0)
		goto error;

	return 0;

 error_nomem:
	ret = -ENOMEM;
	xenbus_dev_fatal(dev, ret, "allocating device memory");
 error:
	xenkbd_remove(dev);
	return ret;
}

static int xenkbd_resume(struct xenbus_device *dev)
{
224
	struct xenkbd_info *info = dev_get_drvdata(&dev->dev);
225 226 227 228 229 230 231 232

	xenkbd_disconnect_backend(info);
	memset(info->page, 0, PAGE_SIZE);
	return xenkbd_connect_backend(dev, info);
}

static int xenkbd_remove(struct xenbus_device *dev)
{
233
	struct xenkbd_info *info = dev_get_drvdata(&dev->dev);
234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250

	xenkbd_disconnect_backend(info);
	if (info->kbd)
		input_unregister_device(info->kbd);
	if (info->ptr)
		input_unregister_device(info->ptr);
	free_page((unsigned long)info->page);
	kfree(info);
	return 0;
}

static int xenkbd_connect_backend(struct xenbus_device *dev,
				  struct xenkbd_info *info)
{
	int ret, evtchn;
	struct xenbus_transaction xbt;

251
	ret = gnttab_grant_foreign_access(dev->otherend_id,
252
	                                  virt_to_gfn(info->page), 0);
253 254 255 256
	if (ret < 0)
		return ret;
	info->gref = ret;

257 258
	ret = xenbus_alloc_evtchn(dev, &evtchn);
	if (ret)
259
		goto error_grant;
260 261 262 263
	ret = bind_evtchn_to_irqhandler(evtchn, input_handler,
					0, dev->devicetype, info);
	if (ret < 0) {
		xenbus_dev_fatal(dev, ret, "bind_evtchn_to_irqhandler");
264
		goto error_evtchan;
265 266 267 268 269 270 271
	}
	info->irq = ret;

 again:
	ret = xenbus_transaction_start(&xbt);
	if (ret) {
		xenbus_dev_fatal(dev, ret, "starting transaction");
272
		goto error_irqh;
273 274
	}
	ret = xenbus_printf(xbt, dev->nodename, "page-ref", "%lu",
275
			    virt_to_gfn(info->page));
276 277 278
	if (ret)
		goto error_xenbus;
	ret = xenbus_printf(xbt, dev->nodename, "page-gref", "%u", info->gref);
279 280 281 282 283 284 285 286 287 288 289
	if (ret)
		goto error_xenbus;
	ret = xenbus_printf(xbt, dev->nodename, "event-channel", "%u",
			    evtchn);
	if (ret)
		goto error_xenbus;
	ret = xenbus_transaction_end(xbt, 0);
	if (ret) {
		if (ret == -EAGAIN)
			goto again;
		xenbus_dev_fatal(dev, ret, "completing transaction");
290
		goto error_irqh;
291 292 293 294 295 296 297 298
	}

	xenbus_switch_state(dev, XenbusStateInitialised);
	return 0;

 error_xenbus:
	xenbus_transaction_end(xbt, 1);
	xenbus_dev_fatal(dev, ret, "writing xenstore");
299 300 301 302 303 304
 error_irqh:
	unbind_from_irqhandler(info->irq, info);
	info->irq = -1;
 error_evtchan:
	xenbus_free_evtchn(dev, evtchn);
 error_grant:
305
	gnttab_end_foreign_access(info->gref, 0, 0UL);
306
	info->gref = -1;
307 308 309 310 311 312 313 314
	return ret;
}

static void xenkbd_disconnect_backend(struct xenkbd_info *info)
{
	if (info->irq >= 0)
		unbind_from_irqhandler(info->irq, info);
	info->irq = -1;
315
	if (info->gref >= 0)
316
		gnttab_end_foreign_access(info->gref, 0, 0UL);
317
	info->gref = -1;
318 319 320 321 322 323 324 325
}

static void xenkbd_backend_changed(struct xenbus_device *dev,
				   enum xenbus_state backend_state)
{
	switch (backend_state) {
	case XenbusStateInitialising:
	case XenbusStateInitialised:
326 327
	case XenbusStateReconfiguring:
	case XenbusStateReconfigured:
328 329 330 331 332 333 334 335 336 337 338 339 340 341
	case XenbusStateUnknown:
		break;

	case XenbusStateInitWait:
		xenbus_switch_state(dev, XenbusStateConnected);
		break;

	case XenbusStateConnected:
		/*
		 * Work around xenbus race condition: If backend goes
		 * through InitWait to Connected fast enough, we can
		 * get Connected twice here.
		 */
		if (dev->state != XenbusStateConnected)
342
			xenbus_switch_state(dev, XenbusStateConnected);
343 344
		break;

345 346 347 348
	case XenbusStateClosed:
		if (dev->state == XenbusStateClosed)
			break;
		/* Missed the backend's CLOSING state -- fallthrough */
349 350 351 352 353 354
	case XenbusStateClosing:
		xenbus_frontend_closed(dev);
		break;
	}
}

355
static const struct xenbus_device_id xenkbd_ids[] = {
356 357 358 359
	{ "vkbd" },
	{ "" }
};

360 361
static struct xenbus_driver xenkbd_driver = {
	.ids = xenkbd_ids,
362 363 364 365
	.probe = xenkbd_probe,
	.remove = xenkbd_remove,
	.resume = xenkbd_resume,
	.otherend_changed = xenkbd_backend_changed,
366
};
367 368 369

static int __init xenkbd_init(void)
{
370
	if (!xen_domain())
371 372 373
		return -ENODEV;

	/* Nothing to do if running in dom0. */
374
	if (xen_initial_domain())
375 376
		return -ENODEV;

377 378 379
	if (!xen_has_pv_devices())
		return -ENODEV;

380
	return xenbus_register_frontend(&xenkbd_driver);
381 382 383 384
}

static void __exit xenkbd_cleanup(void)
{
385
	xenbus_unregister_driver(&xenkbd_driver);
386 387 388 389 390
}

module_init(xenkbd_init);
module_exit(xenkbd_cleanup);

391
MODULE_DESCRIPTION("Xen virtual keyboard/pointer device frontend");
392
MODULE_LICENSE("GPL");
393
MODULE_ALIAS("xen:vkbd");