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> 401da177e4SLinus Torvalds #include <linux/slab.h> 411da177e4SLinus Torvalds #include <linux/pci_ids.h> 421da177e4SLinus Torvalds 431da177e4SLinus Torvalds #define PREFIX "HIL KEYB: " 441da177e4SLinus Torvalds #define HIL_GENERIC_NAME "HIL keyboard" 451da177e4SLinus Torvalds 461da177e4SLinus Torvalds MODULE_AUTHOR("Brian S. Julin <bri@calyx.com>"); 471da177e4SLinus Torvalds MODULE_DESCRIPTION(HIL_GENERIC_NAME " driver"); 481da177e4SLinus Torvalds MODULE_LICENSE("Dual BSD/GPL"); 491da177e4SLinus Torvalds 501da177e4SLinus Torvalds #define HIL_KBD_MAX_LENGTH 16 511da177e4SLinus Torvalds 521da177e4SLinus Torvalds #define HIL_KBD_SET1_UPBIT 0x01 531da177e4SLinus Torvalds #define HIL_KBD_SET1_SHIFT 1 541da177e4SLinus Torvalds static unsigned int hil_kbd_set1[HIL_KEYCODES_SET1_TBLSIZE] = 551da177e4SLinus Torvalds { HIL_KEYCODES_SET1 }; 561da177e4SLinus Torvalds 571da177e4SLinus Torvalds #define HIL_KBD_SET2_UPBIT 0x01 581da177e4SLinus Torvalds #define HIL_KBD_SET2_SHIFT 1 591da177e4SLinus Torvalds /* Set2 is user defined */ 601da177e4SLinus Torvalds 611da177e4SLinus Torvalds #define HIL_KBD_SET3_UPBIT 0x80 621da177e4SLinus Torvalds #define HIL_KBD_SET3_SHIFT 0 631da177e4SLinus Torvalds static unsigned int hil_kbd_set3[HIL_KEYCODES_SET3_TBLSIZE] = 641da177e4SLinus Torvalds { HIL_KEYCODES_SET3 }; 651da177e4SLinus Torvalds 661da177e4SLinus Torvalds static char hil_language[][16] = { HIL_LOCALE_MAP }; 671da177e4SLinus Torvalds 681da177e4SLinus Torvalds struct hil_kbd { 69102c8c76SHelge Deller struct input_dev *dev; 701da177e4SLinus Torvalds struct serio *serio; 711da177e4SLinus Torvalds 721da177e4SLinus Torvalds /* Input buffer and index for packets from HIL bus. */ 731da177e4SLinus Torvalds hil_packet data[HIL_KBD_MAX_LENGTH]; 741da177e4SLinus Torvalds int idx4; /* four counts per packet */ 751da177e4SLinus Torvalds 761da177e4SLinus Torvalds /* Raw device info records from HIL bus, see hil.h for fields. */ 771da177e4SLinus Torvalds char idd[HIL_KBD_MAX_LENGTH]; /* DID byte and IDD record */ 781da177e4SLinus Torvalds char rsc[HIL_KBD_MAX_LENGTH]; /* RSC record */ 791da177e4SLinus Torvalds char exd[HIL_KBD_MAX_LENGTH]; /* EXD record */ 801da177e4SLinus Torvalds char rnm[HIL_KBD_MAX_LENGTH + 1]; /* RNM record + NULL term. */ 811da177e4SLinus Torvalds 821da177e4SLinus Torvalds /* Something to sleep around with. */ 831da177e4SLinus Torvalds struct semaphore sem; 841da177e4SLinus Torvalds }; 851da177e4SLinus Torvalds 861da177e4SLinus Torvalds /* Process a complete packet after transfer from the HIL */ 871da177e4SLinus Torvalds static void hil_kbd_process_record(struct hil_kbd *kbd) 881da177e4SLinus Torvalds { 89102c8c76SHelge Deller struct input_dev *dev = kbd->dev; 901da177e4SLinus Torvalds hil_packet *data = kbd->data; 911da177e4SLinus Torvalds hil_packet p; 921da177e4SLinus Torvalds int idx, i, cnt; 931da177e4SLinus Torvalds 941da177e4SLinus Torvalds idx = kbd->idx4/4; 951da177e4SLinus Torvalds p = data[idx - 1]; 961da177e4SLinus Torvalds 971da177e4SLinus Torvalds if ((p & ~HIL_CMDCT_POL) == 981da177e4SLinus Torvalds (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_POL)) goto report; 991da177e4SLinus Torvalds if ((p & ~HIL_CMDCT_RPL) == 1001da177e4SLinus Torvalds (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_RPL)) goto report; 1011da177e4SLinus Torvalds 1021da177e4SLinus Torvalds /* Not a poll response. See if we are loading config records. */ 1031da177e4SLinus Torvalds switch (p & HIL_PKT_DATA_MASK) { 1041da177e4SLinus Torvalds case HIL_CMD_IDD: 1051da177e4SLinus Torvalds for (i = 0; i < idx; i++) 1061da177e4SLinus Torvalds kbd->idd[i] = kbd->data[i] & HIL_PKT_DATA_MASK; 1071da177e4SLinus Torvalds for (; i < HIL_KBD_MAX_LENGTH; i++) 1081da177e4SLinus Torvalds kbd->idd[i] = 0; 1091da177e4SLinus Torvalds break; 1101da177e4SLinus Torvalds case HIL_CMD_RSC: 1111da177e4SLinus Torvalds for (i = 0; i < idx; i++) 1121da177e4SLinus Torvalds kbd->rsc[i] = kbd->data[i] & HIL_PKT_DATA_MASK; 1131da177e4SLinus Torvalds for (; i < HIL_KBD_MAX_LENGTH; i++) 1141da177e4SLinus Torvalds kbd->rsc[i] = 0; 1151da177e4SLinus Torvalds break; 1161da177e4SLinus Torvalds case HIL_CMD_EXD: 1171da177e4SLinus Torvalds for (i = 0; i < idx; i++) 1181da177e4SLinus Torvalds kbd->exd[i] = kbd->data[i] & HIL_PKT_DATA_MASK; 1191da177e4SLinus Torvalds for (; i < HIL_KBD_MAX_LENGTH; i++) 1201da177e4SLinus Torvalds kbd->exd[i] = 0; 1211da177e4SLinus Torvalds break; 1221da177e4SLinus Torvalds case HIL_CMD_RNM: 1231da177e4SLinus Torvalds for (i = 0; i < idx; i++) 1241da177e4SLinus Torvalds kbd->rnm[i] = kbd->data[i] & HIL_PKT_DATA_MASK; 1251da177e4SLinus Torvalds for (; i < HIL_KBD_MAX_LENGTH + 1; i++) 1261da177e4SLinus Torvalds kbd->rnm[i] = '\0'; 1271da177e4SLinus Torvalds break; 1281da177e4SLinus Torvalds default: 1291da177e4SLinus Torvalds /* These occur when device isn't present */ 1301da177e4SLinus Torvalds if (p == (HIL_ERR_INT | HIL_PKT_CMD)) break; 1311da177e4SLinus Torvalds /* Anything else we'd like to know about. */ 1321da177e4SLinus Torvalds printk(KERN_WARNING PREFIX "Device sent unknown record %x\n", p); 1331da177e4SLinus Torvalds break; 1341da177e4SLinus Torvalds } 1351da177e4SLinus Torvalds goto out; 1361da177e4SLinus Torvalds 1371da177e4SLinus Torvalds report: 1381da177e4SLinus Torvalds cnt = 1; 1391da177e4SLinus Torvalds switch (kbd->data[0] & HIL_POL_CHARTYPE_MASK) { 1401da177e4SLinus Torvalds case HIL_POL_CHARTYPE_NONE: 1411da177e4SLinus Torvalds break; 1421da177e4SLinus Torvalds case HIL_POL_CHARTYPE_ASCII: 1431da177e4SLinus Torvalds while (cnt < idx - 1) 1441da177e4SLinus Torvalds input_report_key(dev, kbd->data[cnt++] & 0x7f, 1); 1451da177e4SLinus Torvalds break; 1461da177e4SLinus Torvalds case HIL_POL_CHARTYPE_RSVD1: 1471da177e4SLinus Torvalds case HIL_POL_CHARTYPE_RSVD2: 1481da177e4SLinus Torvalds case HIL_POL_CHARTYPE_BINARY: 1491da177e4SLinus Torvalds while (cnt < idx - 1) 1501da177e4SLinus Torvalds input_report_key(dev, kbd->data[cnt++], 1); 1511da177e4SLinus Torvalds break; 1521da177e4SLinus Torvalds case HIL_POL_CHARTYPE_SET1: 1531da177e4SLinus Torvalds while (cnt < idx - 1) { 1541da177e4SLinus Torvalds unsigned int key; 1551da177e4SLinus Torvalds int up; 1561da177e4SLinus Torvalds key = kbd->data[cnt++]; 1571da177e4SLinus Torvalds up = key & HIL_KBD_SET1_UPBIT; 1581da177e4SLinus Torvalds key &= (~HIL_KBD_SET1_UPBIT & 0xff); 1591da177e4SLinus Torvalds key = hil_kbd_set1[key >> HIL_KBD_SET1_SHIFT]; 1601da177e4SLinus Torvalds if (key != KEY_RESERVED) 1611da177e4SLinus Torvalds input_report_key(dev, key, !up); 1621da177e4SLinus Torvalds } 1631da177e4SLinus Torvalds break; 1641da177e4SLinus Torvalds case HIL_POL_CHARTYPE_SET2: 1651da177e4SLinus Torvalds while (cnt < idx - 1) { 1661da177e4SLinus Torvalds unsigned int key; 1671da177e4SLinus Torvalds int up; 1681da177e4SLinus Torvalds key = kbd->data[cnt++]; 1691da177e4SLinus Torvalds up = key & HIL_KBD_SET2_UPBIT; 1701da177e4SLinus Torvalds key &= (~HIL_KBD_SET1_UPBIT & 0xff); 1711da177e4SLinus Torvalds key = key >> HIL_KBD_SET2_SHIFT; 1721da177e4SLinus Torvalds if (key != KEY_RESERVED) 1731da177e4SLinus Torvalds input_report_key(dev, key, !up); 1741da177e4SLinus Torvalds } 1751da177e4SLinus Torvalds break; 1761da177e4SLinus Torvalds case HIL_POL_CHARTYPE_SET3: 1771da177e4SLinus Torvalds while (cnt < idx - 1) { 1781da177e4SLinus Torvalds unsigned int key; 1791da177e4SLinus Torvalds int up; 1801da177e4SLinus Torvalds key = kbd->data[cnt++]; 1811da177e4SLinus Torvalds up = key & HIL_KBD_SET3_UPBIT; 1821da177e4SLinus Torvalds key &= (~HIL_KBD_SET1_UPBIT & 0xff); 1831da177e4SLinus Torvalds key = hil_kbd_set3[key >> HIL_KBD_SET3_SHIFT]; 1841da177e4SLinus Torvalds if (key != KEY_RESERVED) 1851da177e4SLinus Torvalds input_report_key(dev, key, !up); 1861da177e4SLinus Torvalds } 1871da177e4SLinus Torvalds break; 1881da177e4SLinus Torvalds } 1891da177e4SLinus Torvalds out: 1901da177e4SLinus Torvalds kbd->idx4 = 0; 1911da177e4SLinus Torvalds up(&kbd->sem); 1921da177e4SLinus Torvalds } 1931da177e4SLinus Torvalds 1941da177e4SLinus Torvalds static void hil_kbd_process_err(struct hil_kbd *kbd) { 1951da177e4SLinus Torvalds printk(KERN_WARNING PREFIX "errored HIL packet\n"); 1961da177e4SLinus Torvalds kbd->idx4 = 0; 1971da177e4SLinus Torvalds up(&kbd->sem); 1981da177e4SLinus Torvalds } 1991da177e4SLinus Torvalds 2001da177e4SLinus Torvalds static irqreturn_t hil_kbd_interrupt(struct serio *serio, 2017d12e780SDavid Howells unsigned char data, unsigned int flags) 2021da177e4SLinus Torvalds { 2031da177e4SLinus Torvalds struct hil_kbd *kbd; 2041da177e4SLinus Torvalds hil_packet packet; 2051da177e4SLinus Torvalds int idx; 2061da177e4SLinus Torvalds 2076ab0f5cdSMatthew Wilcox kbd = serio_get_drvdata(serio); 2081da177e4SLinus Torvalds if (kbd == NULL) { 2091da177e4SLinus Torvalds BUG(); 2101da177e4SLinus Torvalds return IRQ_HANDLED; 2111da177e4SLinus Torvalds } 2121da177e4SLinus Torvalds 2131da177e4SLinus Torvalds if (kbd->idx4 >= (HIL_KBD_MAX_LENGTH * sizeof(hil_packet))) { 2141da177e4SLinus Torvalds hil_kbd_process_err(kbd); 2151da177e4SLinus Torvalds return IRQ_HANDLED; 2161da177e4SLinus Torvalds } 2171da177e4SLinus Torvalds idx = kbd->idx4/4; 2181da177e4SLinus Torvalds if (!(kbd->idx4 % 4)) kbd->data[idx] = 0; 2191da177e4SLinus Torvalds packet = kbd->data[idx]; 2201da177e4SLinus Torvalds packet |= ((hil_packet)data) << ((3 - (kbd->idx4 % 4)) * 8); 2211da177e4SLinus Torvalds kbd->data[idx] = packet; 2221da177e4SLinus Torvalds 2231da177e4SLinus Torvalds /* Records of N 4-byte hil_packets must terminate with a command. */ 2241da177e4SLinus Torvalds if ((++(kbd->idx4)) % 4) return IRQ_HANDLED; 2251da177e4SLinus Torvalds if ((packet & 0xffff0000) != HIL_ERR_INT) { 2261da177e4SLinus Torvalds hil_kbd_process_err(kbd); 2271da177e4SLinus Torvalds return IRQ_HANDLED; 2281da177e4SLinus Torvalds } 2291da177e4SLinus Torvalds if (packet & HIL_PKT_CMD) hil_kbd_process_record(kbd); 2301da177e4SLinus Torvalds return IRQ_HANDLED; 2311da177e4SLinus Torvalds } 2321da177e4SLinus Torvalds 2331da177e4SLinus Torvalds static void hil_kbd_disconnect(struct serio *serio) 2341da177e4SLinus Torvalds { 2351da177e4SLinus Torvalds struct hil_kbd *kbd; 2361da177e4SLinus Torvalds 2376ab0f5cdSMatthew Wilcox kbd = serio_get_drvdata(serio); 2381da177e4SLinus Torvalds if (kbd == NULL) { 2391da177e4SLinus Torvalds BUG(); 2401da177e4SLinus Torvalds return; 2411da177e4SLinus Torvalds } 2421da177e4SLinus Torvalds 2431da177e4SLinus Torvalds serio_close(serio); 244cd7a9202SKyle McMartin input_unregister_device(kbd->dev); 2451da177e4SLinus Torvalds kfree(kbd); 2461da177e4SLinus Torvalds } 2471da177e4SLinus Torvalds 2486ab0f5cdSMatthew Wilcox static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) 2491da177e4SLinus Torvalds { 2501da177e4SLinus Torvalds struct hil_kbd *kbd; 2511da177e4SLinus Torvalds uint8_t did, *idd; 2521da177e4SLinus Torvalds int i; 2531da177e4SLinus Torvalds 254b39787a9SEric Sesterhenn kbd = kzalloc(sizeof(*kbd), GFP_KERNEL); 2556ab0f5cdSMatthew Wilcox if (!kbd) 2566ab0f5cdSMatthew Wilcox return -ENOMEM; 2571da177e4SLinus Torvalds 258102c8c76SHelge Deller kbd->dev = input_allocate_device(); 25995d465fdSDmitry Torokhov if (!kbd->dev) 26095d465fdSDmitry Torokhov goto bail0; 26195d465fdSDmitry Torokhov 262102c8c76SHelge Deller kbd->dev->private = kbd; 2631da177e4SLinus Torvalds 26495d465fdSDmitry Torokhov if (serio_open(serio, drv)) 26595d465fdSDmitry Torokhov goto bail1; 2661da177e4SLinus Torvalds 2676ab0f5cdSMatthew Wilcox serio_set_drvdata(serio, kbd); 2681da177e4SLinus Torvalds kbd->serio = serio; 2691da177e4SLinus Torvalds 2701da177e4SLinus Torvalds init_MUTEX_LOCKED(&(kbd->sem)); 2711da177e4SLinus Torvalds 2721da177e4SLinus Torvalds /* Get device info. MLC driver supplies devid/status/etc. */ 2731da177e4SLinus Torvalds serio->write(serio, 0); 2741da177e4SLinus Torvalds serio->write(serio, 0); 2751da177e4SLinus Torvalds serio->write(serio, HIL_PKT_CMD >> 8); 2761da177e4SLinus Torvalds serio->write(serio, HIL_CMD_IDD); 2771da177e4SLinus Torvalds down(&(kbd->sem)); 2781da177e4SLinus Torvalds 2791da177e4SLinus Torvalds serio->write(serio, 0); 2801da177e4SLinus Torvalds serio->write(serio, 0); 2811da177e4SLinus Torvalds serio->write(serio, HIL_PKT_CMD >> 8); 2821da177e4SLinus Torvalds serio->write(serio, HIL_CMD_RSC); 2831da177e4SLinus Torvalds down(&(kbd->sem)); 2841da177e4SLinus Torvalds 2851da177e4SLinus Torvalds serio->write(serio, 0); 2861da177e4SLinus Torvalds serio->write(serio, 0); 2871da177e4SLinus Torvalds serio->write(serio, HIL_PKT_CMD >> 8); 2881da177e4SLinus Torvalds serio->write(serio, HIL_CMD_RNM); 2891da177e4SLinus Torvalds down(&(kbd->sem)); 2901da177e4SLinus Torvalds 2911da177e4SLinus Torvalds serio->write(serio, 0); 2921da177e4SLinus Torvalds serio->write(serio, 0); 2931da177e4SLinus Torvalds serio->write(serio, HIL_PKT_CMD >> 8); 2941da177e4SLinus Torvalds serio->write(serio, HIL_CMD_EXD); 2951da177e4SLinus Torvalds down(&(kbd->sem)); 2961da177e4SLinus Torvalds 2971da177e4SLinus Torvalds up(&(kbd->sem)); 2981da177e4SLinus Torvalds 2991da177e4SLinus Torvalds did = kbd->idd[0]; 3001da177e4SLinus Torvalds idd = kbd->idd + 1; 3011da177e4SLinus Torvalds switch (did & HIL_IDD_DID_TYPE_MASK) { 3021da177e4SLinus Torvalds case HIL_IDD_DID_TYPE_KB_INTEGRAL: 3031da177e4SLinus Torvalds case HIL_IDD_DID_TYPE_KB_ITF: 3041da177e4SLinus Torvalds case HIL_IDD_DID_TYPE_KB_RSVD: 3051da177e4SLinus Torvalds case HIL_IDD_DID_TYPE_CHAR: 3061da177e4SLinus Torvalds printk(KERN_INFO PREFIX "HIL keyboard found (did = 0x%02x, lang = %s)\n", 3071da177e4SLinus Torvalds did, hil_language[did & HIL_IDD_DID_TYPE_KB_LANG_MASK]); 3081da177e4SLinus Torvalds break; 3091da177e4SLinus Torvalds default: 310102c8c76SHelge Deller goto bail2; 3111da177e4SLinus Torvalds } 3121da177e4SLinus Torvalds 3131da177e4SLinus Torvalds if(HIL_IDD_NUM_BUTTONS(idd) || HIL_IDD_NUM_AXES_PER_SET(*idd)) { 3141da177e4SLinus Torvalds printk(KERN_INFO PREFIX "keyboards only, no combo devices supported.\n"); 315102c8c76SHelge Deller goto bail2; 3161da177e4SLinus Torvalds } 3171da177e4SLinus Torvalds 3181da177e4SLinus Torvalds 319102c8c76SHelge Deller kbd->dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); 320102c8c76SHelge Deller kbd->dev->ledbit[0] = BIT(LED_NUML) | BIT(LED_CAPSL) | BIT(LED_SCROLLL); 321102c8c76SHelge Deller kbd->dev->keycodemax = HIL_KEYCODES_SET1_TBLSIZE; 322102c8c76SHelge Deller kbd->dev->keycodesize = sizeof(hil_kbd_set1[0]); 323102c8c76SHelge Deller kbd->dev->keycode = hil_kbd_set1; 324102c8c76SHelge Deller kbd->dev->name = strlen(kbd->rnm) ? kbd->rnm : HIL_GENERIC_NAME; 325102c8c76SHelge Deller kbd->dev->phys = "hpkbd/input0"; /* XXX */ 3261da177e4SLinus Torvalds 327102c8c76SHelge Deller kbd->dev->id.bustype = BUS_HIL; 328102c8c76SHelge Deller kbd->dev->id.vendor = PCI_VENDOR_ID_HP; 329102c8c76SHelge Deller kbd->dev->id.product = 0x0001; /* TODO: get from kbd->rsc */ 330102c8c76SHelge Deller kbd->dev->id.version = 0x0100; /* TODO: get from kbd->rsc */ 331be577a52SMatthew Wilcox kbd->dev->cdev.dev = &serio->dev; 3321da177e4SLinus Torvalds 3331da177e4SLinus Torvalds for (i = 0; i < 128; i++) { 334102c8c76SHelge Deller set_bit(hil_kbd_set1[i], kbd->dev->keybit); 335102c8c76SHelge Deller set_bit(hil_kbd_set3[i], kbd->dev->keybit); 3361da177e4SLinus Torvalds } 337102c8c76SHelge Deller clear_bit(0, kbd->dev->keybit); 3381da177e4SLinus Torvalds 339102c8c76SHelge Deller input_register_device(kbd->dev); 3401da177e4SLinus Torvalds printk(KERN_INFO "input: %s, ID: %d\n", 341102c8c76SHelge Deller kbd->dev->name, did); 3421da177e4SLinus Torvalds 3431da177e4SLinus Torvalds serio->write(serio, 0); 3441da177e4SLinus Torvalds serio->write(serio, 0); 3451da177e4SLinus Torvalds serio->write(serio, HIL_PKT_CMD >> 8); 3461da177e4SLinus Torvalds serio->write(serio, HIL_CMD_EK1); /* Enable Keyswitch Autorepeat 1 */ 3471da177e4SLinus Torvalds down(&(kbd->sem)); 3481da177e4SLinus Torvalds up(&(kbd->sem)); 3491da177e4SLinus Torvalds 3506ab0f5cdSMatthew Wilcox return 0; 351102c8c76SHelge Deller bail2: 3521da177e4SLinus Torvalds serio_close(serio); 353d668da80SMatthew Wilcox serio_set_drvdata(serio, NULL); 354102c8c76SHelge Deller bail1: 355102c8c76SHelge Deller input_free_device(kbd->dev); 3561da177e4SLinus Torvalds bail0: 3571da177e4SLinus Torvalds kfree(kbd); 3586ab0f5cdSMatthew Wilcox return -EIO; 3591da177e4SLinus Torvalds } 3601da177e4SLinus Torvalds 3616ab0f5cdSMatthew Wilcox static struct serio_device_id hil_kbd_ids[] = { 3626ab0f5cdSMatthew Wilcox { 3636ab0f5cdSMatthew Wilcox .type = SERIO_HIL_MLC, 3646ab0f5cdSMatthew Wilcox .proto = SERIO_HIL, 3656ab0f5cdSMatthew Wilcox .id = SERIO_ANY, 3666ab0f5cdSMatthew Wilcox .extra = SERIO_ANY, 3676ab0f5cdSMatthew Wilcox }, 3686ab0f5cdSMatthew Wilcox { 0 } 3696ab0f5cdSMatthew Wilcox }; 3701da177e4SLinus Torvalds 3711da177e4SLinus Torvalds struct serio_driver hil_kbd_serio_drv = { 3721da177e4SLinus Torvalds .driver = { 3731da177e4SLinus Torvalds .name = "hil_kbd", 3741da177e4SLinus Torvalds }, 3751da177e4SLinus Torvalds .description = "HP HIL keyboard driver", 3766ab0f5cdSMatthew Wilcox .id_table = hil_kbd_ids, 3771da177e4SLinus Torvalds .connect = hil_kbd_connect, 3781da177e4SLinus Torvalds .disconnect = hil_kbd_disconnect, 3791da177e4SLinus Torvalds .interrupt = hil_kbd_interrupt 3801da177e4SLinus Torvalds }; 3811da177e4SLinus Torvalds 3821da177e4SLinus Torvalds static int __init hil_kbd_init(void) 3831da177e4SLinus Torvalds { 384153a9df0SAkinobu Mita return serio_register_driver(&hil_kbd_serio_drv); 3851da177e4SLinus Torvalds } 3861da177e4SLinus Torvalds 3871da177e4SLinus Torvalds static void __exit hil_kbd_exit(void) 3881da177e4SLinus Torvalds { 3891da177e4SLinus Torvalds serio_unregister_driver(&hil_kbd_serio_drv); 3901da177e4SLinus Torvalds } 3911da177e4SLinus Torvalds 3921da177e4SLinus Torvalds module_init(hil_kbd_init); 3931da177e4SLinus Torvalds module_exit(hil_kbd_exit); 394