xref: /openbmc/linux/drivers/input/keyboard/hil_kbd.c (revision 1437dc30)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  * Generic linux-input device driver for keyboard devices
31da177e4SLinus Torvalds  *
41da177e4SLinus Torvalds  * Copyright (c) 2001 Brian S. Julin
51da177e4SLinus Torvalds  * All rights reserved.
61da177e4SLinus Torvalds  *
71da177e4SLinus Torvalds  * Redistribution and use in source and binary forms, with or without
81da177e4SLinus Torvalds  * modification, are permitted provided that the following conditions
91da177e4SLinus Torvalds  * are met:
101da177e4SLinus Torvalds  * 1. Redistributions of source code must retain the above copyright
111da177e4SLinus Torvalds  *    notice, this list of conditions, and the following disclaimer,
121da177e4SLinus Torvalds  *    without modification.
131da177e4SLinus Torvalds  * 2. The name of the author may not be used to endorse or promote products
141da177e4SLinus Torvalds  *    derived from this software without specific prior written permission.
151da177e4SLinus Torvalds  *
161da177e4SLinus Torvalds  * Alternatively, this software may be distributed under the terms of the
171da177e4SLinus Torvalds  * GNU General Public License ("GPL").
181da177e4SLinus Torvalds  *
191da177e4SLinus Torvalds  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
201da177e4SLinus Torvalds  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
211da177e4SLinus Torvalds  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
221da177e4SLinus Torvalds  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
231da177e4SLinus Torvalds  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
241da177e4SLinus Torvalds  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
251da177e4SLinus Torvalds  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
261da177e4SLinus Torvalds  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
271da177e4SLinus Torvalds  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
281da177e4SLinus Torvalds  *
291da177e4SLinus Torvalds  * References:
301da177e4SLinus Torvalds  * HP-HIL Technical Reference Manual.  Hewlett Packard Product No. 45918A
311da177e4SLinus Torvalds  *
321da177e4SLinus Torvalds  */
331da177e4SLinus Torvalds 
341da177e4SLinus Torvalds #include <linux/hil.h>
351da177e4SLinus Torvalds #include <linux/input.h>
361da177e4SLinus Torvalds #include <linux/serio.h>
371da177e4SLinus Torvalds #include <linux/kernel.h>
381da177e4SLinus Torvalds #include <linux/module.h>
391da177e4SLinus Torvalds #include <linux/init.h>
406777f017SDmitry Torokhov #include <linux/completion.h>
411da177e4SLinus Torvalds #include <linux/slab.h>
421da177e4SLinus Torvalds #include <linux/pci_ids.h>
431da177e4SLinus Torvalds 
441da177e4SLinus Torvalds #define PREFIX "HIL KEYB: "
451da177e4SLinus Torvalds #define HIL_GENERIC_NAME "HIL keyboard"
461da177e4SLinus Torvalds 
471da177e4SLinus Torvalds MODULE_AUTHOR("Brian S. Julin <bri@calyx.com>");
481da177e4SLinus Torvalds MODULE_DESCRIPTION(HIL_GENERIC_NAME " driver");
491da177e4SLinus Torvalds MODULE_LICENSE("Dual BSD/GPL");
50c10a93a0SHelge Deller MODULE_ALIAS("serio:ty03pr25id00ex*");
511da177e4SLinus Torvalds 
521437dc30SDmitry Torokhov #define HIL_PACKET_MAX_LENGTH 16
531da177e4SLinus Torvalds 
541da177e4SLinus Torvalds #define HIL_KBD_SET1_UPBIT 0x01
551da177e4SLinus Torvalds #define HIL_KBD_SET1_SHIFT 1
563acaf540SHelge Deller static unsigned int hil_kbd_set1[HIL_KEYCODES_SET1_TBLSIZE] __read_mostly =
571da177e4SLinus Torvalds 	{ HIL_KEYCODES_SET1 };
581da177e4SLinus Torvalds 
591da177e4SLinus Torvalds #define HIL_KBD_SET2_UPBIT 0x01
601da177e4SLinus Torvalds #define HIL_KBD_SET2_SHIFT 1
611da177e4SLinus Torvalds /* Set2 is user defined */
621da177e4SLinus Torvalds 
631da177e4SLinus Torvalds #define HIL_KBD_SET3_UPBIT 0x80
641da177e4SLinus Torvalds #define HIL_KBD_SET3_SHIFT 0
653acaf540SHelge Deller static unsigned int hil_kbd_set3[HIL_KEYCODES_SET3_TBLSIZE] __read_mostly =
661da177e4SLinus Torvalds 	{ HIL_KEYCODES_SET3 };
671da177e4SLinus Torvalds 
683acaf540SHelge Deller static const char hil_language[][16] = { HIL_LOCALE_MAP };
691da177e4SLinus Torvalds 
701437dc30SDmitry Torokhov struct hil_dev {
71102c8c76SHelge Deller 	struct input_dev *dev;
721da177e4SLinus Torvalds 	struct serio *serio;
731da177e4SLinus Torvalds 
741da177e4SLinus Torvalds 	/* Input buffer and index for packets from HIL bus. */
751437dc30SDmitry Torokhov 	hil_packet data[HIL_PACKET_MAX_LENGTH];
761da177e4SLinus Torvalds 	int idx4; /* four counts per packet */
771da177e4SLinus Torvalds 
781da177e4SLinus Torvalds 	/* Raw device info records from HIL bus, see hil.h for fields. */
791437dc30SDmitry Torokhov 	char	idd[HIL_PACKET_MAX_LENGTH];	/* DID byte and IDD record */
801437dc30SDmitry Torokhov 	char	rsc[HIL_PACKET_MAX_LENGTH];	/* RSC record */
811437dc30SDmitry Torokhov 	char	exd[HIL_PACKET_MAX_LENGTH];	/* EXD record */
821437dc30SDmitry Torokhov 	char	rnm[HIL_PACKET_MAX_LENGTH + 1];	/* RNM record + NULL term. */
831da177e4SLinus Torvalds 
846777f017SDmitry Torokhov 	struct completion cmd_done;
851da177e4SLinus Torvalds };
861da177e4SLinus Torvalds 
871437dc30SDmitry Torokhov static bool hil_dev_is_command_response(hil_packet p)
881da177e4SLinus Torvalds {
896777f017SDmitry Torokhov 	if ((p & ~HIL_CMDCT_POL) == (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_POL))
906777f017SDmitry Torokhov 		return false;
916777f017SDmitry Torokhov 
926777f017SDmitry Torokhov 	if ((p & ~HIL_CMDCT_RPL) == (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_RPL))
936777f017SDmitry Torokhov 		return false;
946777f017SDmitry Torokhov 
956777f017SDmitry Torokhov 	return true;
966777f017SDmitry Torokhov }
976777f017SDmitry Torokhov 
981437dc30SDmitry Torokhov static void hil_dev_handle_command_response(struct hil_dev *dev)
996777f017SDmitry Torokhov {
1001da177e4SLinus Torvalds 	hil_packet p;
1016777f017SDmitry Torokhov 	char *buf;
1026777f017SDmitry Torokhov 	int i, idx;
1031da177e4SLinus Torvalds 
1041437dc30SDmitry Torokhov 	idx = dev->idx4 / 4;
1051437dc30SDmitry Torokhov 	p = dev->data[idx - 1];
1061da177e4SLinus Torvalds 
1071da177e4SLinus Torvalds 	switch (p & HIL_PKT_DATA_MASK) {
1081da177e4SLinus Torvalds 	case HIL_CMD_IDD:
1091437dc30SDmitry Torokhov 		buf = dev->idd;
1101da177e4SLinus Torvalds 		break;
111ffd51f46SHelge Deller 
1121da177e4SLinus Torvalds 	case HIL_CMD_RSC:
1131437dc30SDmitry Torokhov 		buf = dev->rsc;
1141da177e4SLinus Torvalds 		break;
115ffd51f46SHelge Deller 
1161da177e4SLinus Torvalds 	case HIL_CMD_EXD:
1171437dc30SDmitry Torokhov 		buf = dev->exd;
1181da177e4SLinus Torvalds 		break;
119ffd51f46SHelge Deller 
1201da177e4SLinus Torvalds 	case HIL_CMD_RNM:
1211437dc30SDmitry Torokhov 		dev->rnm[HIL_PACKET_MAX_LENGTH] = 0;
1221437dc30SDmitry Torokhov 		buf = dev->rnm;
1231da177e4SLinus Torvalds 		break;
124ffd51f46SHelge Deller 
1251da177e4SLinus Torvalds 	default:
1261da177e4SLinus Torvalds 		/* These occur when device isn't present */
1276777f017SDmitry Torokhov 		if (p != (HIL_ERR_INT | HIL_PKT_CMD)) {
1281da177e4SLinus Torvalds 			/* Anything else we'd like to know about. */
1291da177e4SLinus Torvalds 			printk(KERN_WARNING PREFIX "Device sent unknown record %x\n", p);
1301da177e4SLinus Torvalds 		}
1311da177e4SLinus Torvalds 		goto out;
1326777f017SDmitry Torokhov 	}
1331da177e4SLinus Torvalds 
1346777f017SDmitry Torokhov 	for (i = 0; i < idx; i++)
1351437dc30SDmitry Torokhov 		buf[i] = dev->data[i] & HIL_PKT_DATA_MASK;
1361437dc30SDmitry Torokhov 	for (; i < HIL_PACKET_MAX_LENGTH; i++)
1376777f017SDmitry Torokhov 		buf[i] = 0;
1386777f017SDmitry Torokhov  out:
1391437dc30SDmitry Torokhov 	complete(&dev->cmd_done);
1406777f017SDmitry Torokhov }
1416777f017SDmitry Torokhov 
1421437dc30SDmitry Torokhov static void hil_dev_handle_key_events(struct hil_dev *kbd)
1436777f017SDmitry Torokhov {
1446777f017SDmitry Torokhov 	struct input_dev *dev = kbd->dev;
1456777f017SDmitry Torokhov 	int idx = kbd->idx4 / 4;
1466777f017SDmitry Torokhov 	int i;
1476777f017SDmitry Torokhov 
1481da177e4SLinus Torvalds 	switch (kbd->data[0] & HIL_POL_CHARTYPE_MASK) {
1491da177e4SLinus Torvalds 	case HIL_POL_CHARTYPE_NONE:
1506777f017SDmitry Torokhov 		return;
151ffd51f46SHelge Deller 
1521da177e4SLinus Torvalds 	case HIL_POL_CHARTYPE_ASCII:
1536777f017SDmitry Torokhov 		for (i = 1; i < idx - 1; i++)
1546777f017SDmitry Torokhov 			input_report_key(dev, kbd->data[i] & 0x7f, 1);
1551da177e4SLinus Torvalds 		break;
156ffd51f46SHelge Deller 
1571da177e4SLinus Torvalds 	case HIL_POL_CHARTYPE_RSVD1:
1581da177e4SLinus Torvalds 	case HIL_POL_CHARTYPE_RSVD2:
1591da177e4SLinus Torvalds 	case HIL_POL_CHARTYPE_BINARY:
1606777f017SDmitry Torokhov 		for (i = 1; i < idx - 1; i++)
1616777f017SDmitry Torokhov 			input_report_key(dev, kbd->data[i], 1);
1621da177e4SLinus Torvalds 		break;
163ffd51f46SHelge Deller 
1641da177e4SLinus Torvalds 	case HIL_POL_CHARTYPE_SET1:
1656777f017SDmitry Torokhov 		for (i = 1; i < idx - 1; i++) {
1666777f017SDmitry Torokhov 			unsigned int key = kbd->data[i];
1676777f017SDmitry Torokhov 			int up = key & HIL_KBD_SET1_UPBIT;
1686777f017SDmitry Torokhov 
1691da177e4SLinus Torvalds 			key &= (~HIL_KBD_SET1_UPBIT & 0xff);
1701da177e4SLinus Torvalds 			key = hil_kbd_set1[key >> HIL_KBD_SET1_SHIFT];
1711da177e4SLinus Torvalds 			input_report_key(dev, key, !up);
1721da177e4SLinus Torvalds 		}
1731da177e4SLinus Torvalds 		break;
174ffd51f46SHelge Deller 
1751da177e4SLinus Torvalds 	case HIL_POL_CHARTYPE_SET2:
1766777f017SDmitry Torokhov 		for (i = 1; i < idx - 1; i++) {
1776777f017SDmitry Torokhov 			unsigned int key = kbd->data[i];
1786777f017SDmitry Torokhov 			int up = key & HIL_KBD_SET2_UPBIT;
1796777f017SDmitry Torokhov 
1801da177e4SLinus Torvalds 			key &= (~HIL_KBD_SET1_UPBIT & 0xff);
1811da177e4SLinus Torvalds 			key = key >> HIL_KBD_SET2_SHIFT;
1821da177e4SLinus Torvalds 			input_report_key(dev, key, !up);
1831da177e4SLinus Torvalds 		}
1841da177e4SLinus Torvalds 		break;
185ffd51f46SHelge Deller 
1861da177e4SLinus Torvalds 	case HIL_POL_CHARTYPE_SET3:
1876777f017SDmitry Torokhov 		for (i = 1; i < idx - 1; i++) {
1886777f017SDmitry Torokhov 			unsigned int key = kbd->data[i];
1896777f017SDmitry Torokhov 			int up = key & HIL_KBD_SET3_UPBIT;
1906777f017SDmitry Torokhov 
1911da177e4SLinus Torvalds 			key &= (~HIL_KBD_SET1_UPBIT & 0xff);
1921da177e4SLinus Torvalds 			key = hil_kbd_set3[key >> HIL_KBD_SET3_SHIFT];
1931da177e4SLinus Torvalds 			input_report_key(dev, key, !up);
1941da177e4SLinus Torvalds 		}
1951da177e4SLinus Torvalds 		break;
1961da177e4SLinus Torvalds 	}
1976777f017SDmitry Torokhov 
1986777f017SDmitry Torokhov 	input_sync(dev);
1991da177e4SLinus Torvalds }
2001da177e4SLinus Torvalds 
2011437dc30SDmitry Torokhov static void hil_dev_process_err(struct hil_dev *dev)
202ffd51f46SHelge Deller {
2031da177e4SLinus Torvalds 	printk(KERN_WARNING PREFIX "errored HIL packet\n");
2041437dc30SDmitry Torokhov 	dev->idx4 = 0;
2051437dc30SDmitry Torokhov 	complete(&dev->cmd_done); /* just in case somebody is waiting */
2061da177e4SLinus Torvalds }
2071da177e4SLinus Torvalds 
2081437dc30SDmitry Torokhov static irqreturn_t hil_dev_interrupt(struct serio *serio,
2097d12e780SDavid Howells 				unsigned char data, unsigned int flags)
2101da177e4SLinus Torvalds {
2111437dc30SDmitry Torokhov 	struct hil_dev *dev;
2121da177e4SLinus Torvalds 	hil_packet packet;
2131da177e4SLinus Torvalds 	int idx;
2141da177e4SLinus Torvalds 
2151437dc30SDmitry Torokhov 	dev = serio_get_drvdata(serio);
2161437dc30SDmitry Torokhov 	BUG_ON(dev == NULL);
2171da177e4SLinus Torvalds 
2181437dc30SDmitry Torokhov 	if (dev->idx4 >= HIL_PACKET_MAX_LENGTH * sizeof(hil_packet)) {
2191437dc30SDmitry Torokhov 		hil_dev_process_err(dev);
2206777f017SDmitry Torokhov 		goto out;
2211da177e4SLinus Torvalds 	}
2226777f017SDmitry Torokhov 
2231437dc30SDmitry Torokhov 	idx = dev->idx4 / 4;
2241437dc30SDmitry Torokhov 	if (!(dev->idx4 % 4))
2251437dc30SDmitry Torokhov 		dev->data[idx] = 0;
2261437dc30SDmitry Torokhov 	packet = dev->data[idx];
2271437dc30SDmitry Torokhov 	packet |= ((hil_packet)data) << ((3 - (dev->idx4 % 4)) * 8);
2281437dc30SDmitry Torokhov 	dev->data[idx] = packet;
2291da177e4SLinus Torvalds 
2301da177e4SLinus Torvalds 	/* Records of N 4-byte hil_packets must terminate with a command. */
2311437dc30SDmitry Torokhov 	if ((++dev->idx4 % 4) == 0) {
2321da177e4SLinus Torvalds 		if ((packet & 0xffff0000) != HIL_ERR_INT) {
2331437dc30SDmitry Torokhov 			hil_dev_process_err(dev);
2346777f017SDmitry Torokhov 		} else if (packet & HIL_PKT_CMD) {
2351437dc30SDmitry Torokhov 			if (hil_dev_is_command_response(packet))
2361437dc30SDmitry Torokhov 				hil_dev_handle_command_response(dev);
2376777f017SDmitry Torokhov 			else
2381437dc30SDmitry Torokhov 				hil_dev_handle_key_events(dev);
2391437dc30SDmitry Torokhov 			dev->idx4 = 0;
2401da177e4SLinus Torvalds 		}
2416777f017SDmitry Torokhov 	}
2426777f017SDmitry Torokhov  out:
2431da177e4SLinus Torvalds 	return IRQ_HANDLED;
2441da177e4SLinus Torvalds }
2451da177e4SLinus Torvalds 
2461437dc30SDmitry Torokhov static void hil_dev_disconnect(struct serio *serio)
2471da177e4SLinus Torvalds {
2481437dc30SDmitry Torokhov 	struct hil_dev *dev = serio_get_drvdata(serio);
2491da177e4SLinus Torvalds 
2501437dc30SDmitry Torokhov 	BUG_ON(dev == NULL);
2511da177e4SLinus Torvalds 
2521da177e4SLinus Torvalds 	serio_close(serio);
2531437dc30SDmitry Torokhov 	input_unregister_device(dev->dev);
2541437dc30SDmitry Torokhov 	kfree(dev);
2551da177e4SLinus Torvalds }
2561da177e4SLinus Torvalds 
2571437dc30SDmitry Torokhov static int hil_dev_connect(struct serio *serio, struct serio_driver *drv)
2581da177e4SLinus Torvalds {
2591437dc30SDmitry Torokhov 	struct hil_dev *dev;
2606777f017SDmitry Torokhov 	struct input_dev *input_dev;
2611da177e4SLinus Torvalds 	uint8_t did, *idd;
2621da177e4SLinus Torvalds 	int i;
2636777f017SDmitry Torokhov 	int error;
2641da177e4SLinus Torvalds 
2651437dc30SDmitry Torokhov 	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
2666777f017SDmitry Torokhov 	input_dev = input_allocate_device();
2671437dc30SDmitry Torokhov 	if (!dev || !input_dev) {
2686777f017SDmitry Torokhov 		error = -ENOMEM;
2696777f017SDmitry Torokhov 		goto bail0;
2706777f017SDmitry Torokhov 	}
2711da177e4SLinus Torvalds 
2721437dc30SDmitry Torokhov 	dev->serio = serio;
2731437dc30SDmitry Torokhov 	dev->dev = input_dev;
2746777f017SDmitry Torokhov 
2756777f017SDmitry Torokhov 	error = serio_open(serio, drv);
2766777f017SDmitry Torokhov 	if (error)
27795d465fdSDmitry Torokhov 		goto bail0;
27895d465fdSDmitry Torokhov 
2791437dc30SDmitry Torokhov 	serio_set_drvdata(serio, dev);
2801da177e4SLinus Torvalds 
2811da177e4SLinus Torvalds 	/* Get device info.  MLC driver supplies devid/status/etc. */
2821437dc30SDmitry Torokhov 	init_completion(&dev->cmd_done);
283dd0d5443SDmitry Torokhov 	serio_write(serio, 0);
284dd0d5443SDmitry Torokhov 	serio_write(serio, 0);
285dd0d5443SDmitry Torokhov 	serio_write(serio, HIL_PKT_CMD >> 8);
286dd0d5443SDmitry Torokhov 	serio_write(serio, HIL_CMD_IDD);
2871437dc30SDmitry Torokhov 	error = wait_for_completion_killable(&dev->cmd_done);
2886777f017SDmitry Torokhov 	if (error)
2896777f017SDmitry Torokhov 		goto bail1;
2901da177e4SLinus Torvalds 
2911437dc30SDmitry Torokhov 	init_completion(&dev->cmd_done);
292dd0d5443SDmitry Torokhov 	serio_write(serio, 0);
293dd0d5443SDmitry Torokhov 	serio_write(serio, 0);
294dd0d5443SDmitry Torokhov 	serio_write(serio, HIL_PKT_CMD >> 8);
295dd0d5443SDmitry Torokhov 	serio_write(serio, HIL_CMD_RSC);
2961437dc30SDmitry Torokhov 	error = wait_for_completion_killable(&dev->cmd_done);
2976777f017SDmitry Torokhov 	if (error)
2986777f017SDmitry Torokhov 		goto bail1;
2991da177e4SLinus Torvalds 
3001437dc30SDmitry Torokhov 	init_completion(&dev->cmd_done);
301dd0d5443SDmitry Torokhov 	serio_write(serio, 0);
302dd0d5443SDmitry Torokhov 	serio_write(serio, 0);
303dd0d5443SDmitry Torokhov 	serio_write(serio, HIL_PKT_CMD >> 8);
304dd0d5443SDmitry Torokhov 	serio_write(serio, HIL_CMD_RNM);
3051437dc30SDmitry Torokhov 	error = wait_for_completion_killable(&dev->cmd_done);
3066777f017SDmitry Torokhov 	if (error)
3076777f017SDmitry Torokhov 		goto bail1;
3081da177e4SLinus Torvalds 
3091437dc30SDmitry Torokhov 	init_completion(&dev->cmd_done);
310dd0d5443SDmitry Torokhov 	serio_write(serio, 0);
311dd0d5443SDmitry Torokhov 	serio_write(serio, 0);
312dd0d5443SDmitry Torokhov 	serio_write(serio, HIL_PKT_CMD >> 8);
313dd0d5443SDmitry Torokhov 	serio_write(serio, HIL_CMD_EXD);
3141437dc30SDmitry Torokhov 	error = wait_for_completion_killable(&dev->cmd_done);
3156777f017SDmitry Torokhov 	if (error)
3166777f017SDmitry Torokhov 		goto bail1;
3171da177e4SLinus Torvalds 
3181437dc30SDmitry Torokhov 	did = dev->idd[0];
3191437dc30SDmitry Torokhov 	idd = dev->idd + 1;
3201da177e4SLinus Torvalds 	switch (did & HIL_IDD_DID_TYPE_MASK) {
3211da177e4SLinus Torvalds 	case HIL_IDD_DID_TYPE_KB_INTEGRAL:
3221da177e4SLinus Torvalds 	case HIL_IDD_DID_TYPE_KB_ITF:
3231da177e4SLinus Torvalds 	case HIL_IDD_DID_TYPE_KB_RSVD:
3241da177e4SLinus Torvalds 	case HIL_IDD_DID_TYPE_CHAR:
3251da177e4SLinus Torvalds 		printk(KERN_INFO PREFIX "HIL keyboard found (did = 0x%02x, lang = %s)\n",
3261da177e4SLinus Torvalds 			did, hil_language[did & HIL_IDD_DID_TYPE_KB_LANG_MASK]);
3271da177e4SLinus Torvalds 		break;
3281da177e4SLinus Torvalds 	default:
3296777f017SDmitry Torokhov 		goto bail1;
3301da177e4SLinus Torvalds 	}
3311da177e4SLinus Torvalds 
3321da177e4SLinus Torvalds 	if (HIL_IDD_NUM_BUTTONS(idd) || HIL_IDD_NUM_AXES_PER_SET(*idd)) {
3331da177e4SLinus Torvalds 		printk(KERN_INFO PREFIX "keyboards only, no combo devices supported.\n");
3346777f017SDmitry Torokhov 		goto bail1;
3351da177e4SLinus Torvalds 	}
3361da177e4SLinus Torvalds 
3376777f017SDmitry Torokhov 	input_dev->evbit[0]	= BIT_MASK(EV_KEY) | BIT_MASK(EV_REP);
3386777f017SDmitry Torokhov 	input_dev->ledbit[0]	= BIT_MASK(LED_NUML) | BIT_MASK(LED_CAPSL) |
3397b19ada2SJiri Slaby 				  BIT_MASK(LED_SCROLLL);
3406777f017SDmitry Torokhov 	input_dev->keycodemax	= HIL_KEYCODES_SET1_TBLSIZE;
3416777f017SDmitry Torokhov 	input_dev->keycodesize	= sizeof(hil_kbd_set1[0]);
3426777f017SDmitry Torokhov 	input_dev->keycode	= hil_kbd_set1;
3431437dc30SDmitry Torokhov 	input_dev->name		= strlen(dev->rnm) ? dev->rnm : HIL_GENERIC_NAME;
3446777f017SDmitry Torokhov 	input_dev->phys		= "hpkbd/input0";	/* XXX */
3451da177e4SLinus Torvalds 
3466777f017SDmitry Torokhov 	input_dev->id.bustype	= BUS_HIL;
3476777f017SDmitry Torokhov 	input_dev->id.vendor	= PCI_VENDOR_ID_HP;
3486777f017SDmitry Torokhov 	input_dev->id.product	= 0x0001; /* TODO: get from kbd->rsc */
3496777f017SDmitry Torokhov 	input_dev->id.version	= 0x0100; /* TODO: get from kbd->rsc */
3506777f017SDmitry Torokhov 	input_dev->dev.parent	= &serio->dev;
3511da177e4SLinus Torvalds 
3521da177e4SLinus Torvalds 	for (i = 0; i < 128; i++) {
3536777f017SDmitry Torokhov 		__set_bit(hil_kbd_set1[i], input_dev->keybit);
3546777f017SDmitry Torokhov 		__set_bit(hil_kbd_set3[i], input_dev->keybit);
3551da177e4SLinus Torvalds 	}
3566777f017SDmitry Torokhov 	__clear_bit(KEY_RESERVED, input_dev->keybit);
3571da177e4SLinus Torvalds 
358dd0d5443SDmitry Torokhov 	serio_write(serio, 0);
359dd0d5443SDmitry Torokhov 	serio_write(serio, 0);
360dd0d5443SDmitry Torokhov 	serio_write(serio, HIL_PKT_CMD >> 8);
361dd0d5443SDmitry Torokhov 	serio_write(serio, HIL_CMD_EK1); /* Enable Keyswitch Autorepeat 1 */
3626777f017SDmitry Torokhov 	/* No need to wait for completion */
3636777f017SDmitry Torokhov 
3641437dc30SDmitry Torokhov 	error = input_register_device(input_dev);
3656777f017SDmitry Torokhov 	if (error)
3666777f017SDmitry Torokhov 		goto bail1;
3671da177e4SLinus Torvalds 
3686ab0f5cdSMatthew Wilcox 	return 0;
3696777f017SDmitry Torokhov 
3706777f017SDmitry Torokhov  bail1:
3711da177e4SLinus Torvalds 	serio_close(serio);
372d668da80SMatthew Wilcox 	serio_set_drvdata(serio, NULL);
3731da177e4SLinus Torvalds  bail0:
3746777f017SDmitry Torokhov 	input_free_device(input_dev);
3751437dc30SDmitry Torokhov 	kfree(dev);
3766777f017SDmitry Torokhov 	return error;
3771da177e4SLinus Torvalds }
3781da177e4SLinus Torvalds 
3791437dc30SDmitry Torokhov static struct serio_device_id hil_dev_ids[] = {
3806ab0f5cdSMatthew Wilcox 	{
3816ab0f5cdSMatthew Wilcox 		.type = SERIO_HIL_MLC,
3826ab0f5cdSMatthew Wilcox 		.proto = SERIO_HIL,
3836ab0f5cdSMatthew Wilcox 		.id = SERIO_ANY,
3846ab0f5cdSMatthew Wilcox 		.extra = SERIO_ANY,
3856ab0f5cdSMatthew Wilcox 	},
3866ab0f5cdSMatthew Wilcox 	{ 0 }
3876ab0f5cdSMatthew Wilcox };
3881da177e4SLinus Torvalds 
3891437dc30SDmitry Torokhov static struct serio_driver hil_serio_drv = {
3901da177e4SLinus Torvalds 	.driver		= {
3911da177e4SLinus Torvalds 		.name	= "hil_kbd",
3921da177e4SLinus Torvalds 	},
3931da177e4SLinus Torvalds 	.description	= "HP HIL keyboard driver",
3941437dc30SDmitry Torokhov 	.id_table	= hil_dev_ids,
3951437dc30SDmitry Torokhov 	.connect	= hil_dev_connect,
3961437dc30SDmitry Torokhov 	.disconnect	= hil_dev_disconnect,
3971437dc30SDmitry Torokhov 	.interrupt	= hil_dev_interrupt
3981da177e4SLinus Torvalds };
3991da177e4SLinus Torvalds 
4001437dc30SDmitry Torokhov static int __init hil_dev_init(void)
4011da177e4SLinus Torvalds {
4021437dc30SDmitry Torokhov 	return serio_register_driver(&hil_serio_drv);
4031da177e4SLinus Torvalds }
4041da177e4SLinus Torvalds 
4051437dc30SDmitry Torokhov static void __exit hil_dev_exit(void)
4061da177e4SLinus Torvalds {
4071437dc30SDmitry Torokhov 	serio_unregister_driver(&hil_serio_drv);
4081da177e4SLinus Torvalds }
4091da177e4SLinus Torvalds 
4101437dc30SDmitry Torokhov module_init(hil_dev_init);
4111437dc30SDmitry Torokhov module_exit(hil_dev_exit);
412