[mirror_ubuntu-zesty-kernel.git] / drivers / input / keyboard / hil_kbd.c

/*
 * Generic linux-input device driver for keyboard devices
 *
 * Copyright (c) 2001 Brian S. Julin
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions, and the following disclaimer,
 *    without modification.
 * 2. The name of the author may not be used to endorse or promote products
 *    derived from this software without specific prior written permission.
 *
 * Alternatively, this software may be distributed under the terms of the
 * GNU General Public License ("GPL").
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 *
 * References:
 * HP-HIL Technical Reference Manual.  Hewlett Packard Product No. 45918A
 *
 */

#include <linux/hil.h>
#include <linux/input.h>
#include <linux/serio.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/semaphore.h>
#include <linux/slab.h>
#include <linux/pci_ids.h>

#define PREFIX "HIL KEYB: "
#define HIL_GENERIC_NAME "HIL keyboard"

MODULE_AUTHOR("Brian S. Julin <bri@calyx.com>");
MODULE_DESCRIPTION(HIL_GENERIC_NAME " driver");
MODULE_LICENSE("Dual BSD/GPL");
MODULE_ALIAS("serio:ty03pr25id00ex*");

#define HIL_KBD_MAX_LENGTH 16

#define HIL_KBD_SET1_UPBIT 0x01
#define HIL_KBD_SET1_SHIFT 1
static unsigned int hil_kbd_set1[HIL_KEYCODES_SET1_TBLSIZE] __read_mostly =
	{ HIL_KEYCODES_SET1 };

#define HIL_KBD_SET2_UPBIT 0x01
#define HIL_KBD_SET2_SHIFT 1
/* Set2 is user defined */

#define HIL_KBD_SET3_UPBIT 0x80
#define HIL_KBD_SET3_SHIFT 0
static unsigned int hil_kbd_set3[HIL_KEYCODES_SET3_TBLSIZE] __read_mostly =
	{ HIL_KEYCODES_SET3 };

static const char hil_language[][16] = { HIL_LOCALE_MAP };

struct hil_kbd {
	struct input_dev *dev;
	struct serio *serio;

	/* Input buffer and index for packets from HIL bus. */
	hil_packet data[HIL_KBD_MAX_LENGTH];
	int idx4; /* four counts per packet */

	/* Raw device info records from HIL bus, see hil.h for fields. */
	char	idd[HIL_KBD_MAX_LENGTH];	/* DID byte and IDD record */
	char	rsc[HIL_KBD_MAX_LENGTH];	/* RSC record */
	char	exd[HIL_KBD_MAX_LENGTH];	/* EXD record */
	char	rnm[HIL_KBD_MAX_LENGTH + 1];	/* RNM record + NULL term. */

	/* Something to sleep around with. */
	struct semaphore sem;
};

/* Process a complete packet after transfer from the HIL */
static void hil_kbd_process_record(struct hil_kbd *kbd)
{
	struct input_dev *dev = kbd->dev;
	hil_packet *data = kbd->data;
	hil_packet p;
	int idx, i, cnt;

	idx = kbd->idx4/4;
	p = data[idx - 1];

	if ((p & ~HIL_CMDCT_POL) ==
	    (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_POL))
		goto report;
	if ((p & ~HIL_CMDCT_RPL) ==
	    (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_RPL))
		goto report;

	/* Not a poll response.  See if we are loading config records. */
	switch (p & HIL_PKT_DATA_MASK) {
	case HIL_CMD_IDD:
		for (i = 0; i < idx; i++)
			kbd->idd[i] = kbd->data[i] & HIL_PKT_DATA_MASK;
		for (; i < HIL_KBD_MAX_LENGTH; i++)
			kbd->idd[i] = 0;
		break;

	case HIL_CMD_RSC:
		for (i = 0; i < idx; i++)
			kbd->rsc[i] = kbd->data[i] & HIL_PKT_DATA_MASK;
		for (; i < HIL_KBD_MAX_LENGTH; i++)
			kbd->rsc[i] = 0;
		break;

	case HIL_CMD_EXD:
		for (i = 0; i < idx; i++)
			kbd->exd[i] = kbd->data[i] & HIL_PKT_DATA_MASK;
		for (; i < HIL_KBD_MAX_LENGTH; i++)
			kbd->exd[i] = 0;
		break;

	case HIL_CMD_RNM:
		for (i = 0; i < idx; i++)
			kbd->rnm[i] = kbd->data[i] & HIL_PKT_DATA_MASK;
		for (; i < HIL_KBD_MAX_LENGTH + 1; i++)
			kbd->rnm[i] = '\0';
		break;

	default:
		/* These occur when device isn't present */
		if (p == (HIL_ERR_INT | HIL_PKT_CMD))
			break;
		/* Anything else we'd like to know about. */
		printk(KERN_WARNING PREFIX "Device sent unknown record %x\n", p);
		break;
	}
	goto out;

 report:
	cnt = 1;
	switch (kbd->data[0] & HIL_POL_CHARTYPE_MASK) {
	case HIL_POL_CHARTYPE_NONE:
		break;

	case HIL_POL_CHARTYPE_ASCII:
		while (cnt < idx - 1)
			input_report_key(dev, kbd->data[cnt++] & 0x7f, 1);
		break;

	case HIL_POL_CHARTYPE_RSVD1:
	case HIL_POL_CHARTYPE_RSVD2:
	case HIL_POL_CHARTYPE_BINARY:
		while (cnt < idx - 1)
			input_report_key(dev, kbd->data[cnt++], 1);
		break;

	case HIL_POL_CHARTYPE_SET1:
		while (cnt < idx - 1) {
			unsigned int key;
			int up;
			key = kbd->data[cnt++];
			up = key & HIL_KBD_SET1_UPBIT;
			key &= (~HIL_KBD_SET1_UPBIT & 0xff);
			key = hil_kbd_set1[key >> HIL_KBD_SET1_SHIFT];
			if (key != KEY_RESERVED)
				input_report_key(dev, key, !up);
		}
		break;

	case HIL_POL_CHARTYPE_SET2:
		while (cnt < idx - 1) {
			unsigned int key;
			int up;
			key = kbd->data[cnt++];
			up = key & HIL_KBD_SET2_UPBIT;
			key &= (~HIL_KBD_SET1_UPBIT & 0xff);
			key = key >> HIL_KBD_SET2_SHIFT;
			if (key != KEY_RESERVED)
				input_report_key(dev, key, !up);
		}
		break;

	case HIL_POL_CHARTYPE_SET3:
		while (cnt < idx - 1) {
			unsigned int key;
			int up;
			key = kbd->data[cnt++];
			up = key & HIL_KBD_SET3_UPBIT;
			key &= (~HIL_KBD_SET1_UPBIT & 0xff);
			key = hil_kbd_set3[key >> HIL_KBD_SET3_SHIFT];
			if (key != KEY_RESERVED)
				input_report_key(dev, key, !up);
		}
		break;
	}
 out:
	kbd->idx4 = 0;
	up(&kbd->sem);
}

static void hil_kbd_process_err(struct hil_kbd *kbd)
{
	printk(KERN_WARNING PREFIX "errored HIL packet\n");
	kbd->idx4 = 0;
	up(&kbd->sem);
}

static irqreturn_t hil_kbd_interrupt(struct serio *serio,
				unsigned char data, unsigned int flags)
{
	struct hil_kbd *kbd;
	hil_packet packet;
	int idx;

	kbd = serio_get_drvdata(serio);
	BUG_ON(kbd == NULL);

	if (kbd->idx4 >= (HIL_KBD_MAX_LENGTH * sizeof(hil_packet))) {
		hil_kbd_process_err(kbd);
		return IRQ_HANDLED;
	}
	idx = kbd->idx4/4;
	if (!(kbd->idx4 % 4))
		kbd->data[idx] = 0;
	packet = kbd->data[idx];
	packet |= ((hil_packet)data) << ((3 - (kbd->idx4 % 4)) * 8);
	kbd->data[idx] = packet;

	/* Records of N 4-byte hil_packets must terminate with a command. */
	if ((++(kbd->idx4)) % 4)
		return IRQ_HANDLED;
	if ((packet & 0xffff0000) != HIL_ERR_INT) {
		hil_kbd_process_err(kbd);
		return IRQ_HANDLED;
	}
	if (packet & HIL_PKT_CMD)
		hil_kbd_process_record(kbd);
	return IRQ_HANDLED;
}

static void hil_kbd_disconnect(struct serio *serio)
{
	struct hil_kbd *kbd;

	kbd = serio_get_drvdata(serio);
	BUG_ON(kbd == NULL);

	serio_close(serio);
	input_unregister_device(kbd->dev);
	kfree(kbd);
}

static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv)
{
	struct hil_kbd	*kbd;
	uint8_t		did, *idd;
	int		i;

	kbd = kzalloc(sizeof(*kbd), GFP_KERNEL);
	if (!kbd)
		return -ENOMEM;

	kbd->dev = input_allocate_device();
	if (!kbd->dev)
		goto bail0;

	if (serio_open(serio, drv))
		goto bail1;

	serio_set_drvdata(serio, kbd);
	kbd->serio = serio;

	init_MUTEX_LOCKED(&kbd->sem);

	/* Get device info.  MLC driver supplies devid/status/etc. */
	serio_write(serio, 0);
	serio_write(serio, 0);
	serio_write(serio, HIL_PKT_CMD >> 8);
	serio_write(serio, HIL_CMD_IDD);
	down(&kbd->sem);

	serio_write(serio, 0);
	serio_write(serio, 0);
	serio_write(serio, HIL_PKT_CMD >> 8);
	serio_write(serio, HIL_CMD_RSC);
	down(&kbd->sem);

	serio_write(serio, 0);
	serio_write(serio, 0);
	serio_write(serio, HIL_PKT_CMD >> 8);
	serio_write(serio, HIL_CMD_RNM);
	down(&kbd->sem);

	serio_write(serio, 0);
	serio_write(serio, 0);
	serio_write(serio, HIL_PKT_CMD >> 8);
	serio_write(serio, HIL_CMD_EXD);
	down(&kbd->sem);

	up(&kbd->sem);

	did = kbd->idd[0];
	idd = kbd->idd + 1;
	switch (did & HIL_IDD_DID_TYPE_MASK) {
	case HIL_IDD_DID_TYPE_KB_INTEGRAL:
	case HIL_IDD_DID_TYPE_KB_ITF:
	case HIL_IDD_DID_TYPE_KB_RSVD:
	case HIL_IDD_DID_TYPE_CHAR:
		printk(KERN_INFO PREFIX "HIL keyboard found (did = 0x%02x, lang = %s)\n",
			did, hil_language[did & HIL_IDD_DID_TYPE_KB_LANG_MASK]);
		break;
	default:
		goto bail2;
	}

	if (HIL_IDD_NUM_BUTTONS(idd) || HIL_IDD_NUM_AXES_PER_SET(*idd)) {
		printk(KERN_INFO PREFIX "keyboards only, no combo devices supported.\n");
		goto bail2;
	}

	kbd->dev->evbit[0]	= BIT_MASK(EV_KEY) | BIT_MASK(EV_REP);
	kbd->dev->ledbit[0]	= BIT_MASK(LED_NUML) | BIT_MASK(LED_CAPSL) |
		BIT_MASK(LED_SCROLLL);
	kbd->dev->keycodemax	= HIL_KEYCODES_SET1_TBLSIZE;
	kbd->dev->keycodesize	= sizeof(hil_kbd_set1[0]);
	kbd->dev->keycode	= hil_kbd_set1;
	kbd->dev->name		= strlen(kbd->rnm) ? kbd->rnm : HIL_GENERIC_NAME;
	kbd->dev->phys		= "hpkbd/input0";	/* XXX */

	kbd->dev->id.bustype	= BUS_HIL;
	kbd->dev->id.vendor	= PCI_VENDOR_ID_HP;
	kbd->dev->id.product	= 0x0001; /* TODO: get from kbd->rsc */
	kbd->dev->id.version	= 0x0100; /* TODO: get from kbd->rsc */
	kbd->dev->dev.parent	= &serio->dev;

	for (i = 0; i < 128; i++) {
		set_bit(hil_kbd_set1[i], kbd->dev->keybit);
		set_bit(hil_kbd_set3[i], kbd->dev->keybit);
	}
	clear_bit(0, kbd->dev->keybit);

	input_register_device(kbd->dev);
	printk(KERN_INFO "input: %s, ID: %d\n",
		kbd->dev->name, did);

	serio_write(serio, 0);
	serio_write(serio, 0);
	serio_write(serio, HIL_PKT_CMD >> 8);
	serio_write(serio, HIL_CMD_EK1); /* Enable Keyswitch Autorepeat 1 */
	down(&kbd->sem);
	up(&kbd->sem);

	return 0;
 bail2:
	serio_close(serio);
	serio_set_drvdata(serio, NULL);
 bail1:
	input_free_device(kbd->dev);
 bail0:
	kfree(kbd);
	return -EIO;
}

static struct serio_device_id hil_kbd_ids[] = {
	{
		.type = SERIO_HIL_MLC,
		.proto = SERIO_HIL,
		.id = SERIO_ANY,
		.extra = SERIO_ANY,
	},
	{ 0 }
};

static struct serio_driver hil_kbd_serio_drv = {
	.driver		= {
		.name	= "hil_kbd",
	},
	.description	= "HP HIL keyboard driver",
	.id_table	= hil_kbd_ids,
	.connect	= hil_kbd_connect,
	.disconnect	= hil_kbd_disconnect,
	.interrupt	= hil_kbd_interrupt
};

static int __init hil_kbd_init(void)
{
	return serio_register_driver(&hil_kbd_serio_drv);
}

static void __exit hil_kbd_exit(void)
{
	serio_unregister_driver(&hil_kbd_serio_drv);
}

module_init(hil_kbd_init);
module_exit(hil_kbd_exit);
Commit	Line	Data
1da177e4 LT	1	/*
	2	* Generic linux-input device driver for keyboard devices
	3	*
	4	* Copyright (c) 2001 Brian S. Julin
	5	* All rights reserved.
	6	*
	7	* Redistribution and use in source and binary forms, with or without
	8	* modification, are permitted provided that the following conditions
	9	* are met:
	10	* 1. Redistributions of source code must retain the above copyright
	11	* notice, this list of conditions, and the following disclaimer,
	12	* without modification.
	13	* 2. The name of the author may not be used to endorse or promote products
	14	* derived from this software without specific prior written permission.
	15	*
	16	* Alternatively, this software may be distributed under the terms of the
	17	* GNU General Public License ("GPL").
	18	*
	19	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
	20	* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
	21	* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
	22	* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
	23	* ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
	24	* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
	25	* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
	26	* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
	27	* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
	28	*
	29	* References:
	30	* HP-HIL Technical Reference Manual. Hewlett Packard Product No. 45918A
	31	*
	32	*/
	33
	34	#include <linux/hil.h>
	35	#include <linux/input.h>
	36	#include <linux/serio.h>
	37	#include <linux/kernel.h>
	38	#include <linux/module.h>
	39	#include <linux/init.h>
0f17e4c7	40	#include <linux/semaphore.h>
1da177e4 LT	41	#include <linux/slab.h>
	42	#include <linux/pci_ids.h>
	43
	44	#define PREFIX "HIL KEYB: "
	45	#define HIL_GENERIC_NAME "HIL keyboard"
	46
	47	MODULE_AUTHOR("Brian S. Julin <bri@calyx.com>");
	48	MODULE_DESCRIPTION(HIL_GENERIC_NAME " driver");
	49	MODULE_LICENSE("Dual BSD/GPL");
c10a93a0	50	MODULE_ALIAS("serio:ty03pr25id00ex*");
1da177e4 LT	51
	52	#define HIL_KBD_MAX_LENGTH 16
	53
	54	#define HIL_KBD_SET1_UPBIT 0x01
	55	#define HIL_KBD_SET1_SHIFT 1
3acaf540	56	static unsigned int hil_kbd_set1[HIL_KEYCODES_SET1_TBLSIZE] __read_mostly =
1da177e4 LT	57	{ HIL_KEYCODES_SET1 };
	58
	59	#define HIL_KBD_SET2_UPBIT 0x01
	60	#define HIL_KBD_SET2_SHIFT 1
	61	/* Set2 is user defined */
	62
	63	#define HIL_KBD_SET3_UPBIT 0x80
	64	#define HIL_KBD_SET3_SHIFT 0
3acaf540	65	static unsigned int hil_kbd_set3[HIL_KEYCODES_SET3_TBLSIZE] __read_mostly =
1da177e4 LT	66	{ HIL_KEYCODES_SET3 };
1da177e4 LT	67
3acaf540	68	static const char hil_language[][16] = { HIL_LOCALE_MAP };
1da177e4 LT	69
1da177e4 LT	70	struct hil_kbd {
102c8c76	71	struct input_dev *dev;
1da177e4 LT	72	struct serio *serio;
	73
	74	/* Input buffer and index for packets from HIL bus. */
	75	hil_packet data[HIL_KBD_MAX_LENGTH];
	76	int idx4; /* four counts per packet */
	77
	78	/* Raw device info records from HIL bus, see hil.h for fields. */
	79	char idd[HIL_KBD_MAX_LENGTH]; /* DID byte and IDD record */
	80	char rsc[HIL_KBD_MAX_LENGTH]; /* RSC record */
	81	char exd[HIL_KBD_MAX_LENGTH]; /* EXD record */
	82	char rnm[HIL_KBD_MAX_LENGTH + 1]; /* RNM record + NULL term. */
	83
	84	/* Something to sleep around with. */
	85	struct semaphore sem;
	86	};
	87
	88	/* Process a complete packet after transfer from the HIL */
	89	static void hil_kbd_process_record(struct hil_kbd *kbd)
	90	{
102c8c76	91	struct input_dev *dev = kbd->dev;
1da177e4 LT	92	hil_packet *data = kbd->data;
	93	hil_packet p;
	94	int idx, i, cnt;
	95
	96	idx = kbd->idx4/4;
	97	p = data[idx - 1];
	98
ffd51f46 HD	99	if ((p & ~HIL_CMDCT_POL) ==
	100	(HIL_ERR_INT \| HIL_PKT_CMD \| HIL_CMD_POL))
	101	goto report;
	102	if ((p & ~HIL_CMDCT_RPL) ==
	103	(HIL_ERR_INT \| HIL_PKT_CMD \| HIL_CMD_RPL))
	104	goto report;
1da177e4 LT	105
	106	/* Not a poll response. See if we are loading config records. */
	107	switch (p & HIL_PKT_DATA_MASK) {
	108	case HIL_CMD_IDD:
	109	for (i = 0; i < idx; i++)
	110	kbd->idd[i] = kbd->data[i] & HIL_PKT_DATA_MASK;
	111	for (; i < HIL_KBD_MAX_LENGTH; i++)
	112	kbd->idd[i] = 0;
	113	break;
ffd51f46	114
1da177e4 LT	115	case HIL_CMD_RSC:
	116	for (i = 0; i < idx; i++)
	117	kbd->rsc[i] = kbd->data[i] & HIL_PKT_DATA_MASK;
	118	for (; i < HIL_KBD_MAX_LENGTH; i++)
	119	kbd->rsc[i] = 0;
	120	break;
ffd51f46	121
1da177e4 LT	122	case HIL_CMD_EXD:
	123	for (i = 0; i < idx; i++)
	124	kbd->exd[i] = kbd->data[i] & HIL_PKT_DATA_MASK;
	125	for (; i < HIL_KBD_MAX_LENGTH; i++)
	126	kbd->exd[i] = 0;
	127	break;
ffd51f46	128
1da177e4 LT	129	case HIL_CMD_RNM:
	130	for (i = 0; i < idx; i++)
	131	kbd->rnm[i] = kbd->data[i] & HIL_PKT_DATA_MASK;
	132	for (; i < HIL_KBD_MAX_LENGTH + 1; i++)
	133	kbd->rnm[i] = '\0';
	134	break;
ffd51f46	135
1da177e4 LT	136	default:
1da177e4 LT	137	/* These occur when device isn't present */
ffd51f46 HD	138	if (p == (HIL_ERR_INT \| HIL_PKT_CMD))
ffd51f46 HD	139	break;
1da177e4 LT	140	/* Anything else we'd like to know about. */
	141	printk(KERN_WARNING PREFIX "Device sent unknown record %x\n", p);
	142	break;
	143	}
	144	goto out;
	145
	146	report:
	147	cnt = 1;
	148	switch (kbd->data[0] & HIL_POL_CHARTYPE_MASK) {
	149	case HIL_POL_CHARTYPE_NONE:
	150	break;
ffd51f46	151
1da177e4 LT	152	case HIL_POL_CHARTYPE_ASCII:
	153	while (cnt < idx - 1)
	154	input_report_key(dev, kbd->data[cnt++] & 0x7f, 1);
	155	break;
ffd51f46	156
1da177e4 LT	157	case HIL_POL_CHARTYPE_RSVD1:
	158	case HIL_POL_CHARTYPE_RSVD2:
	159	case HIL_POL_CHARTYPE_BINARY:
	160	while (cnt < idx - 1)
	161	input_report_key(dev, kbd->data[cnt++], 1);
	162	break;
ffd51f46	163
1da177e4 LT	164	case HIL_POL_CHARTYPE_SET1:
	165	while (cnt < idx - 1) {
	166	unsigned int key;
	167	int up;
	168	key = kbd->data[cnt++];
	169	up = key & HIL_KBD_SET1_UPBIT;
	170	key &= (~HIL_KBD_SET1_UPBIT & 0xff);
	171	key = hil_kbd_set1[key >> HIL_KBD_SET1_SHIFT];
	172	if (key != KEY_RESERVED)
	173	input_report_key(dev, key, !up);
	174	}
	175	break;
ffd51f46	176
1da177e4 LT	177	case HIL_POL_CHARTYPE_SET2:
	178	while (cnt < idx - 1) {
	179	unsigned int key;
	180	int up;
	181	key = kbd->data[cnt++];
	182	up = key & HIL_KBD_SET2_UPBIT;
	183	key &= (~HIL_KBD_SET1_UPBIT & 0xff);
	184	key = key >> HIL_KBD_SET2_SHIFT;
	185	if (key != KEY_RESERVED)
	186	input_report_key(dev, key, !up);
	187	}
	188	break;
ffd51f46	189
1da177e4 LT	190	case HIL_POL_CHARTYPE_SET3:
	191	while (cnt < idx - 1) {
	192	unsigned int key;
	193	int up;
	194	key = kbd->data[cnt++];
	195	up = key & HIL_KBD_SET3_UPBIT;
	196	key &= (~HIL_KBD_SET1_UPBIT & 0xff);
	197	key = hil_kbd_set3[key >> HIL_KBD_SET3_SHIFT];
	198	if (key != KEY_RESERVED)
	199	input_report_key(dev, key, !up);
	200	}
	201	break;
	202	}
	203	out:
	204	kbd->idx4 = 0;
	205	up(&kbd->sem);
	206	}
	207
ffd51f46 HD	208	static void hil_kbd_process_err(struct hil_kbd *kbd)
ffd51f46 HD	209	{
1da177e4 LT	210	printk(KERN_WARNING PREFIX "errored HIL packet\n");
	211	kbd->idx4 = 0;
	212	up(&kbd->sem);
	213	}
	214
ffd51f46 HD	215	static irqreturn_t hil_kbd_interrupt(struct serio *serio,
ffd51f46 HD	216	unsigned char data, unsigned int flags)
1da177e4 LT	217	{
	218	struct hil_kbd *kbd;
	219	hil_packet packet;
	220	int idx;
	221
6ab0f5cd	222	kbd = serio_get_drvdata(serio);
ffd51f46	223	BUG_ON(kbd == NULL);
1da177e4 LT	224
	225	if (kbd->idx4 >= (HIL_KBD_MAX_LENGTH * sizeof(hil_packet))) {
	226	hil_kbd_process_err(kbd);
	227	return IRQ_HANDLED;
	228	}
	229	idx = kbd->idx4/4;
ffd51f46 HD	230	if (!(kbd->idx4 % 4))
ffd51f46 HD	231	kbd->data[idx] = 0;
1da177e4 LT	232	packet = kbd->data[idx];
	233	packet \|= ((hil_packet)data) << ((3 - (kbd->idx4 % 4)) * 8);
	234	kbd->data[idx] = packet;
	235
	236	/* Records of N 4-byte hil_packets must terminate with a command. */
ffd51f46 HD	237	if ((++(kbd->idx4)) % 4)
ffd51f46 HD	238	return IRQ_HANDLED;
1da177e4 LT	239	if ((packet & 0xffff0000) != HIL_ERR_INT) {
	240	hil_kbd_process_err(kbd);
	241	return IRQ_HANDLED;
	242	}
ffd51f46 HD	243	if (packet & HIL_PKT_CMD)
ffd51f46 HD	244	hil_kbd_process_record(kbd);
1da177e4 LT	245	return IRQ_HANDLED;
	246	}
	247
	248	static void hil_kbd_disconnect(struct serio *serio)
	249	{
	250	struct hil_kbd *kbd;
	251
6ab0f5cd	252	kbd = serio_get_drvdata(serio);
ffd51f46	253	BUG_ON(kbd == NULL);
1da177e4	254
1da177e4	255	serio_close(serio);
cd7a9202	256	input_unregister_device(kbd->dev);
1da177e4 LT	257	kfree(kbd);
	258	}
	259
6ab0f5cd	260	static int hil_kbd_connect(struct serio serio, struct serio_driver drv)
1da177e4 LT	261	{
	262	struct hil_kbd *kbd;
	263	uint8_t did, *idd;
	264	int i;
95d465fd	265
b39787a9	266	kbd = kzalloc(sizeof(*kbd), GFP_KERNEL);
6ab0f5cd MW	267	if (!kbd)
6ab0f5cd MW	268	return -ENOMEM;
1da177e4	269
102c8c76	270	kbd->dev = input_allocate_device();
95d465fd DT	271	if (!kbd->dev)
	272	goto bail0;
	273
95d465fd DT	274	if (serio_open(serio, drv))
95d465fd DT	275	goto bail1;
1da177e4	276
6ab0f5cd	277	serio_set_drvdata(serio, kbd);
1da177e4	278	kbd->serio = serio;
1da177e4	279
ffd51f46	280	init_MUTEX_LOCKED(&kbd->sem);
1da177e4 LT	281
1da177e4 LT	282	/* Get device info. MLC driver supplies devid/status/etc. */
dd0d5443 DT	283	serio_write(serio, 0);
	284	serio_write(serio, 0);
	285	serio_write(serio, HIL_PKT_CMD >> 8);
	286	serio_write(serio, HIL_CMD_IDD);
ffd51f46	287	down(&kbd->sem);
1da177e4	288
dd0d5443 DT	289	serio_write(serio, 0);
	290	serio_write(serio, 0);
	291	serio_write(serio, HIL_PKT_CMD >> 8);
	292	serio_write(serio, HIL_CMD_RSC);
ffd51f46	293	down(&kbd->sem);
1da177e4	294
dd0d5443 DT	295	serio_write(serio, 0);
	296	serio_write(serio, 0);
	297	serio_write(serio, HIL_PKT_CMD >> 8);
	298	serio_write(serio, HIL_CMD_RNM);
ffd51f46	299	down(&kbd->sem);
1da177e4	300
dd0d5443 DT	301	serio_write(serio, 0);
	302	serio_write(serio, 0);
	303	serio_write(serio, HIL_PKT_CMD >> 8);
	304	serio_write(serio, HIL_CMD_EXD);
ffd51f46	305	down(&kbd->sem);
1da177e4	306
ffd51f46	307	up(&kbd->sem);
1da177e4 LT	308
	309	did = kbd->idd[0];
	310	idd = kbd->idd + 1;
	311	switch (did & HIL_IDD_DID_TYPE_MASK) {
	312	case HIL_IDD_DID_TYPE_KB_INTEGRAL:
	313	case HIL_IDD_DID_TYPE_KB_ITF:
	314	case HIL_IDD_DID_TYPE_KB_RSVD:
	315	case HIL_IDD_DID_TYPE_CHAR:
	316	printk(KERN_INFO PREFIX "HIL keyboard found (did = 0x%02x, lang = %s)\n",
	317	did, hil_language[did & HIL_IDD_DID_TYPE_KB_LANG_MASK]);
	318	break;
	319	default:
102c8c76	320	goto bail2;
1da177e4 LT	321	}
1da177e4 LT	322
ffd51f46	323	if (HIL_IDD_NUM_BUTTONS(idd) \|\| HIL_IDD_NUM_AXES_PER_SET(*idd)) {
1da177e4	324	printk(KERN_INFO PREFIX "keyboards only, no combo devices supported.\n");
102c8c76	325	goto bail2;
1da177e4 LT	326	}
1da177e4 LT	327
7b19ada2 JS	328	kbd->dev->evbit[0] = BIT_MASK(EV_KEY) \| BIT_MASK(EV_REP);
	329	kbd->dev->ledbit[0] = BIT_MASK(LED_NUML) \| BIT_MASK(LED_CAPSL) \|
	330	BIT_MASK(LED_SCROLLL);
102c8c76 HD	331	kbd->dev->keycodemax = HIL_KEYCODES_SET1_TBLSIZE;
	332	kbd->dev->keycodesize = sizeof(hil_kbd_set1[0]);
	333	kbd->dev->keycode = hil_kbd_set1;
	334	kbd->dev->name = strlen(kbd->rnm) ? kbd->rnm : HIL_GENERIC_NAME;
	335	kbd->dev->phys = "hpkbd/input0"; /* XXX */
1da177e4	336
102c8c76 HD	337	kbd->dev->id.bustype = BUS_HIL;
	338	kbd->dev->id.vendor = PCI_VENDOR_ID_HP;
	339	kbd->dev->id.product = 0x0001; /* TODO: get from kbd->rsc */
	340	kbd->dev->id.version = 0x0100; /* TODO: get from kbd->rsc */
469ba4df	341	kbd->dev->dev.parent = &serio->dev;
1da177e4 LT	342
1da177e4 LT	343	for (i = 0; i < 128; i++) {
102c8c76 HD	344	set_bit(hil_kbd_set1[i], kbd->dev->keybit);
102c8c76 HD	345	set_bit(hil_kbd_set3[i], kbd->dev->keybit);
1da177e4	346	}
102c8c76	347	clear_bit(0, kbd->dev->keybit);
1da177e4	348
102c8c76	349	input_register_device(kbd->dev);
1da177e4	350	printk(KERN_INFO "input: %s, ID: %d\n",
102c8c76	351	kbd->dev->name, did);
1da177e4	352
dd0d5443 DT	353	serio_write(serio, 0);
	354	serio_write(serio, 0);
	355	serio_write(serio, HIL_PKT_CMD >> 8);
	356	serio_write(serio, HIL_CMD_EK1); /* Enable Keyswitch Autorepeat 1 */
ffd51f46 HD	357	down(&kbd->sem);
ffd51f46 HD	358	up(&kbd->sem);
1da177e4	359
6ab0f5cd	360	return 0;
102c8c76	361	bail2:
1da177e4	362	serio_close(serio);
d668da80	363	serio_set_drvdata(serio, NULL);
102c8c76 HD	364	bail1:
102c8c76 HD	365	input_free_device(kbd->dev);
1da177e4 LT	366	bail0:
1da177e4 LT	367	kfree(kbd);
6ab0f5cd	368	return -EIO;
1da177e4 LT	369	}
1da177e4 LT	370
6ab0f5cd MW	371	static struct serio_device_id hil_kbd_ids[] = {
	372	{
	373	.type = SERIO_HIL_MLC,
	374	.proto = SERIO_HIL,
	375	.id = SERIO_ANY,
	376	.extra = SERIO_ANY,
	377	},
	378	{ 0 }
	379	};
1da177e4	380
3acaf540	381	static struct serio_driver hil_kbd_serio_drv = {
1da177e4 LT	382	.driver = {
	383	.name = "hil_kbd",
	384	},
	385	.description = "HP HIL keyboard driver",
6ab0f5cd	386	.id_table = hil_kbd_ids,
ffd51f46 HD	387	.connect = hil_kbd_connect,
	388	.disconnect = hil_kbd_disconnect,
	389	.interrupt = hil_kbd_interrupt
1da177e4 LT	390	};
	391
	392	static int __init hil_kbd_init(void)
	393	{
153a9df0	394	return serio_register_driver(&hil_kbd_serio_drv);
1da177e4	395	}
ffd51f46	396
1da177e4 LT	397	static void __exit hil_kbd_exit(void)
	398	{
	399	serio_unregister_driver(&hil_kbd_serio_drv);
	400	}
ffd51f46	401
1da177e4 LT	402	module_init(hil_kbd_init);
1da177e4 LT	403	module_exit(hil_kbd_exit);