Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / drivers / input / keyboard / hil_kbd.c
diff --git a/kernel/drivers/input/keyboard/hil_kbd.c b/kernel/drivers/input/keyboard/hil_kbd.c
new file mode 100644 (file)
index 0000000..5b152f2
--- /dev/null
@@ -0,0 +1,585 @@
+/*
+ * 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/completion.h>
+#include <linux/slab.h>
+#include <linux/pci_ids.h>
+
+#define PREFIX "HIL: "
+
+MODULE_AUTHOR("Brian S. Julin <bri@calyx.com>");
+MODULE_DESCRIPTION("HIL keyboard/mouse driver");
+MODULE_LICENSE("Dual BSD/GPL");
+MODULE_ALIAS("serio:ty03pr25id00ex*"); /* HIL keyboard */
+MODULE_ALIAS("serio:ty03pr25id0Fex*"); /* HIL mouse */
+
+#define HIL_PACKET_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_dev {
+       struct input_dev *dev;
+       struct serio *serio;
+
+       /* Input buffer and index for packets from HIL bus. */
+       hil_packet data[HIL_PACKET_MAX_LENGTH];
+       int idx4; /* four counts per packet */
+
+       /* Raw device info records from HIL bus, see hil.h for fields. */
+       char    idd[HIL_PACKET_MAX_LENGTH];     /* DID byte and IDD record */
+       char    rsc[HIL_PACKET_MAX_LENGTH];     /* RSC record */
+       char    exd[HIL_PACKET_MAX_LENGTH];     /* EXD record */
+       char    rnm[HIL_PACKET_MAX_LENGTH + 1]; /* RNM record + NULL term. */
+
+       struct completion cmd_done;
+
+       bool is_pointer;
+       /* Extra device details needed for pointing devices. */
+       unsigned int nbtn, naxes;
+       unsigned int btnmap[7];
+};
+
+static bool hil_dev_is_command_response(hil_packet p)
+{
+       if ((p & ~HIL_CMDCT_POL) == (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_POL))
+               return false;
+
+       if ((p & ~HIL_CMDCT_RPL) == (HIL_ERR_INT | HIL_PKT_CMD | HIL_CMD_RPL))
+               return false;
+
+       return true;
+}
+
+static void hil_dev_handle_command_response(struct hil_dev *dev)
+{
+       hil_packet p;
+       char *buf;
+       int i, idx;
+
+       idx = dev->idx4 / 4;
+       p = dev->data[idx - 1];
+
+       switch (p & HIL_PKT_DATA_MASK) {
+       case HIL_CMD_IDD:
+               buf = dev->idd;
+               break;
+
+       case HIL_CMD_RSC:
+               buf = dev->rsc;
+               break;
+
+       case HIL_CMD_EXD:
+               buf = dev->exd;
+               break;
+
+       case HIL_CMD_RNM:
+               dev->rnm[HIL_PACKET_MAX_LENGTH] = 0;
+               buf = dev->rnm;
+               break;
+
+       default:
+               /* These occur when device isn't present */
+               if (p != (HIL_ERR_INT | HIL_PKT_CMD)) {
+                       /* Anything else we'd like to know about. */
+                       printk(KERN_WARNING PREFIX "Device sent unknown record %x\n", p);
+               }
+               goto out;
+       }
+
+       for (i = 0; i < idx; i++)
+               buf[i] = dev->data[i] & HIL_PKT_DATA_MASK;
+       for (; i < HIL_PACKET_MAX_LENGTH; i++)
+               buf[i] = 0;
+ out:
+       complete(&dev->cmd_done);
+}
+
+static void hil_dev_handle_kbd_events(struct hil_dev *kbd)
+{
+       struct input_dev *dev = kbd->dev;
+       int idx = kbd->idx4 / 4;
+       int i;
+
+       switch (kbd->data[0] & HIL_POL_CHARTYPE_MASK) {
+       case HIL_POL_CHARTYPE_NONE:
+               return;
+
+       case HIL_POL_CHARTYPE_ASCII:
+               for (i = 1; i < idx - 1; i++)
+                       input_report_key(dev, kbd->data[i] & 0x7f, 1);
+               break;
+
+       case HIL_POL_CHARTYPE_RSVD1:
+       case HIL_POL_CHARTYPE_RSVD2:
+       case HIL_POL_CHARTYPE_BINARY:
+               for (i = 1; i < idx - 1; i++)
+                       input_report_key(dev, kbd->data[i], 1);
+               break;
+
+       case HIL_POL_CHARTYPE_SET1:
+               for (i = 1; i < idx - 1; i++) {
+                       unsigned int key = kbd->data[i];
+                       int up = key & HIL_KBD_SET1_UPBIT;
+
+                       key &= (~HIL_KBD_SET1_UPBIT & 0xff);
+                       key = hil_kbd_set1[key >> HIL_KBD_SET1_SHIFT];
+                       input_report_key(dev, key, !up);
+               }
+               break;
+
+       case HIL_POL_CHARTYPE_SET2:
+               for (i = 1; i < idx - 1; i++) {
+                       unsigned int key = kbd->data[i];
+                       int up = key & HIL_KBD_SET2_UPBIT;
+
+                       key &= (~HIL_KBD_SET1_UPBIT & 0xff);
+                       key = key >> HIL_KBD_SET2_SHIFT;
+                       input_report_key(dev, key, !up);
+               }
+               break;
+
+       case HIL_POL_CHARTYPE_SET3:
+               for (i = 1; i < idx - 1; i++) {
+                       unsigned int key = kbd->data[i];
+                       int up = key & HIL_KBD_SET3_UPBIT;
+
+                       key &= (~HIL_KBD_SET1_UPBIT & 0xff);
+                       key = hil_kbd_set3[key >> HIL_KBD_SET3_SHIFT];
+                       input_report_key(dev, key, !up);
+               }
+               break;
+       }
+
+       input_sync(dev);
+}
+
+static void hil_dev_handle_ptr_events(struct hil_dev *ptr)
+{
+       struct input_dev *dev = ptr->dev;
+       int idx = ptr->idx4 / 4;
+       hil_packet p = ptr->data[idx - 1];
+       int i, cnt, laxis;
+       bool absdev, ax16;
+
+       if ((p & HIL_CMDCT_POL) != idx - 1) {
+               printk(KERN_WARNING PREFIX
+                       "Malformed poll packet %x (idx = %i)\n", p, idx);
+               return;
+       }
+
+       i = (p & HIL_POL_AXIS_ALT) ? 3 : 0;
+       laxis = (p & HIL_POL_NUM_AXES_MASK) + i;
+
+       ax16 = ptr->idd[1] & HIL_IDD_HEADER_16BIT; /* 8 or 16bit resolution */
+       absdev = ptr->idd[1] & HIL_IDD_HEADER_ABS;
+
+       for (cnt = 1; i < laxis; i++) {
+               unsigned int lo, hi, val;
+
+               lo = ptr->data[cnt++] & HIL_PKT_DATA_MASK;
+               hi = ax16 ? (ptr->data[cnt++] & HIL_PKT_DATA_MASK) : 0;
+
+               if (absdev) {
+                       val = lo + (hi << 8);
+#ifdef TABLET_AUTOADJUST
+                       if (val < input_abs_get_min(dev, ABS_X + i))
+                               input_abs_set_min(dev, ABS_X + i, val);
+                       if (val > input_abs_get_max(dev, ABS_X + i))
+                               input_abs_set_max(dev, ABS_X + i, val);
+#endif
+                       if (i % 3)
+                               val = input_abs_get_max(dev, ABS_X + i) - val;
+                       input_report_abs(dev, ABS_X + i, val);
+               } else {
+                       val = (int) (((int8_t) lo) | ((int8_t) hi << 8));
+                       if (i % 3)
+                               val *= -1;
+                       input_report_rel(dev, REL_X + i, val);
+               }
+       }
+
+       while (cnt < idx - 1) {
+               unsigned int btn = ptr->data[cnt++];
+               int up = btn & 1;
+
+               btn &= 0xfe;
+               if (btn == 0x8e)
+                       continue; /* TODO: proximity == touch? */
+               if (btn > 0x8c || btn < 0x80)
+                       continue;
+               btn = (btn - 0x80) >> 1;
+               btn = ptr->btnmap[btn];
+               input_report_key(dev, btn, !up);
+       }
+
+       input_sync(dev);
+}
+
+static void hil_dev_process_err(struct hil_dev *dev)
+{
+       printk(KERN_WARNING PREFIX "errored HIL packet\n");
+       dev->idx4 = 0;
+       complete(&dev->cmd_done); /* just in case somebody is waiting */
+}
+
+static irqreturn_t hil_dev_interrupt(struct serio *serio,
+                               unsigned char data, unsigned int flags)
+{
+       struct hil_dev *dev;
+       hil_packet packet;
+       int idx;
+
+       dev = serio_get_drvdata(serio);
+       BUG_ON(dev == NULL);
+
+       if (dev->idx4 >= HIL_PACKET_MAX_LENGTH * sizeof(hil_packet)) {
+               hil_dev_process_err(dev);
+               goto out;
+       }
+
+       idx = dev->idx4 / 4;
+       if (!(dev->idx4 % 4))
+               dev->data[idx] = 0;
+       packet = dev->data[idx];
+       packet |= ((hil_packet)data) << ((3 - (dev->idx4 % 4)) * 8);
+       dev->data[idx] = packet;
+
+       /* Records of N 4-byte hil_packets must terminate with a command. */
+       if ((++dev->idx4 % 4) == 0) {
+               if ((packet & 0xffff0000) != HIL_ERR_INT) {
+                       hil_dev_process_err(dev);
+               } else if (packet & HIL_PKT_CMD) {
+                       if (hil_dev_is_command_response(packet))
+                               hil_dev_handle_command_response(dev);
+                       else if (dev->is_pointer)
+                               hil_dev_handle_ptr_events(dev);
+                       else
+                               hil_dev_handle_kbd_events(dev);
+                       dev->idx4 = 0;
+               }
+       }
+ out:
+       return IRQ_HANDLED;
+}
+
+static void hil_dev_disconnect(struct serio *serio)
+{
+       struct hil_dev *dev = serio_get_drvdata(serio);
+
+       BUG_ON(dev == NULL);
+
+       serio_close(serio);
+       input_unregister_device(dev->dev);
+       serio_set_drvdata(serio, NULL);
+       kfree(dev);
+}
+
+static void hil_dev_keyboard_setup(struct hil_dev *kbd)
+{
+       struct input_dev *input_dev = kbd->dev;
+       uint8_t did = kbd->idd[0];
+       int i;
+
+       input_dev->evbit[0]     = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP);
+       input_dev->ledbit[0]    = BIT_MASK(LED_NUML) | BIT_MASK(LED_CAPSL) |
+                                 BIT_MASK(LED_SCROLLL);
+
+       for (i = 0; i < 128; i++) {
+               __set_bit(hil_kbd_set1[i], input_dev->keybit);
+               __set_bit(hil_kbd_set3[i], input_dev->keybit);
+       }
+       __clear_bit(KEY_RESERVED, input_dev->keybit);
+
+       input_dev->keycodemax   = HIL_KEYCODES_SET1_TBLSIZE;
+       input_dev->keycodesize  = sizeof(hil_kbd_set1[0]);
+       input_dev->keycode      = hil_kbd_set1;
+
+       input_dev->name = strlen(kbd->rnm) ? kbd->rnm : "HIL keyboard";
+       input_dev->phys = "hpkbd/input0";
+
+       printk(KERN_INFO PREFIX "HIL keyboard found (did = 0x%02x, lang = %s)\n",
+               did, hil_language[did & HIL_IDD_DID_TYPE_KB_LANG_MASK]);
+}
+
+static void hil_dev_pointer_setup(struct hil_dev *ptr)
+{
+       struct input_dev *input_dev = ptr->dev;
+       uint8_t did = ptr->idd[0];
+       uint8_t *idd = ptr->idd + 1;
+       unsigned int naxsets = HIL_IDD_NUM_AXSETS(*idd);
+       unsigned int i, btntype;
+       const char *txt;
+
+       ptr->naxes = HIL_IDD_NUM_AXES_PER_SET(*idd);
+
+       switch (did & HIL_IDD_DID_TYPE_MASK) {
+       case HIL_IDD_DID_TYPE_REL:
+               input_dev->evbit[0] = BIT_MASK(EV_REL);
+
+               for (i = 0; i < ptr->naxes; i++)
+                       __set_bit(REL_X + i, input_dev->relbit);
+
+               for (i = 3; naxsets > 1 && i < ptr->naxes + 3; i++)
+                       __set_bit(REL_X + i, input_dev->relbit);
+
+               txt = "relative";
+               break;
+
+       case HIL_IDD_DID_TYPE_ABS:
+               input_dev->evbit[0] = BIT_MASK(EV_ABS);
+
+               for (i = 0; i < ptr->naxes; i++)
+                       input_set_abs_params(input_dev, ABS_X + i,
+                                       0, HIL_IDD_AXIS_MAX(idd, i), 0, 0);
+
+               for (i = 3; naxsets > 1 && i < ptr->naxes + 3; i++)
+                       input_set_abs_params(input_dev, ABS_X + i,
+                                       0, HIL_IDD_AXIS_MAX(idd, i - 3), 0, 0);
+
+#ifdef TABLET_AUTOADJUST
+               for (i = 0; i < ABS_MAX; i++) {
+                       int diff = input_abs_get_max(input_dev, ABS_X + i) / 10;
+                       input_abs_set_min(input_dev, ABS_X + i,
+                               input_abs_get_min(input_dev, ABS_X + i) + diff);
+                       input_abs_set_max(input_dev, ABS_X + i,
+                               input_abs_get_max(input_dev, ABS_X + i) - diff);
+               }
+#endif
+
+               txt = "absolute";
+               break;
+
+       default:
+               BUG();
+       }
+
+       ptr->nbtn = HIL_IDD_NUM_BUTTONS(idd);
+       if (ptr->nbtn)
+               input_dev->evbit[0] |= BIT_MASK(EV_KEY);
+
+       btntype = BTN_MISC;
+       if ((did & HIL_IDD_DID_ABS_TABLET_MASK) == HIL_IDD_DID_ABS_TABLET)
+#ifdef TABLET_SIMULATES_MOUSE
+               btntype = BTN_TOUCH;
+#else
+               btntype = BTN_DIGI;
+#endif
+       if ((did & HIL_IDD_DID_ABS_TSCREEN_MASK) == HIL_IDD_DID_ABS_TSCREEN)
+               btntype = BTN_TOUCH;
+
+       if ((did & HIL_IDD_DID_REL_MOUSE_MASK) == HIL_IDD_DID_REL_MOUSE)
+               btntype = BTN_MOUSE;
+
+       for (i = 0; i < ptr->nbtn; i++) {
+               __set_bit(btntype | i, input_dev->keybit);
+               ptr->btnmap[i] = btntype | i;
+       }
+
+       if (btntype == BTN_MOUSE) {
+               /* Swap buttons 2 and 3 */
+               ptr->btnmap[1] = BTN_MIDDLE;
+               ptr->btnmap[2] = BTN_RIGHT;
+       }
+
+       input_dev->name = strlen(ptr->rnm) ? ptr->rnm : "HIL pointer device";
+
+       printk(KERN_INFO PREFIX
+               "HIL pointer device found (did: 0x%02x, axis: %s)\n",
+               did, txt);
+       printk(KERN_INFO PREFIX
+               "HIL pointer has %i buttons and %i sets of %i axes\n",
+               ptr->nbtn, naxsets, ptr->naxes);
+}
+
+static int hil_dev_connect(struct serio *serio, struct serio_driver *drv)
+{
+       struct hil_dev *dev;
+       struct input_dev *input_dev;
+       uint8_t did, *idd;
+       int error;
+
+       dev = kzalloc(sizeof(*dev), GFP_KERNEL);
+       input_dev = input_allocate_device();
+       if (!dev || !input_dev) {
+               error = -ENOMEM;
+               goto bail0;
+       }
+
+       dev->serio = serio;
+       dev->dev = input_dev;
+
+       error = serio_open(serio, drv);
+       if (error)
+               goto bail0;
+
+       serio_set_drvdata(serio, dev);
+
+       /* Get device info.  MLC driver supplies devid/status/etc. */
+       init_completion(&dev->cmd_done);
+       serio_write(serio, 0);
+       serio_write(serio, 0);
+       serio_write(serio, HIL_PKT_CMD >> 8);
+       serio_write(serio, HIL_CMD_IDD);
+       error = wait_for_completion_killable(&dev->cmd_done);
+       if (error)
+               goto bail1;
+
+       reinit_completion(&dev->cmd_done);
+       serio_write(serio, 0);
+       serio_write(serio, 0);
+       serio_write(serio, HIL_PKT_CMD >> 8);
+       serio_write(serio, HIL_CMD_RSC);
+       error = wait_for_completion_killable(&dev->cmd_done);
+       if (error)
+               goto bail1;
+
+       reinit_completion(&dev->cmd_done);
+       serio_write(serio, 0);
+       serio_write(serio, 0);
+       serio_write(serio, HIL_PKT_CMD >> 8);
+       serio_write(serio, HIL_CMD_RNM);
+       error = wait_for_completion_killable(&dev->cmd_done);
+       if (error)
+               goto bail1;
+
+       reinit_completion(&dev->cmd_done);
+       serio_write(serio, 0);
+       serio_write(serio, 0);
+       serio_write(serio, HIL_PKT_CMD >> 8);
+       serio_write(serio, HIL_CMD_EXD);
+       error = wait_for_completion_killable(&dev->cmd_done);
+       if (error)
+               goto bail1;
+
+       did = dev->idd[0];
+       idd = dev->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:
+               if (HIL_IDD_NUM_BUTTONS(idd) ||
+                   HIL_IDD_NUM_AXES_PER_SET(*idd)) {
+                       printk(KERN_INFO PREFIX
+                               "combo devices are not supported.\n");
+                       goto bail1;
+               }
+
+               dev->is_pointer = false;
+               hil_dev_keyboard_setup(dev);
+               break;
+
+       case HIL_IDD_DID_TYPE_REL:
+       case HIL_IDD_DID_TYPE_ABS:
+               dev->is_pointer = true;
+               hil_dev_pointer_setup(dev);
+               break;
+
+       default:
+               goto bail1;
+       }
+
+       input_dev->id.bustype   = BUS_HIL;
+       input_dev->id.vendor    = PCI_VENDOR_ID_HP;
+       input_dev->id.product   = 0x0001; /* TODO: get from kbd->rsc */
+       input_dev->id.version   = 0x0100; /* TODO: get from kbd->rsc */
+       input_dev->dev.parent   = &serio->dev;
+
+       if (!dev->is_pointer) {
+               serio_write(serio, 0);
+               serio_write(serio, 0);
+               serio_write(serio, HIL_PKT_CMD >> 8);
+               /* Enable Keyswitch Autorepeat 1 */
+               serio_write(serio, HIL_CMD_EK1);
+               /* No need to wait for completion */
+       }
+
+       error = input_register_device(input_dev);
+       if (error)
+               goto bail1;
+
+       return 0;
+
+ bail1:
+       serio_close(serio);
+       serio_set_drvdata(serio, NULL);
+ bail0:
+       input_free_device(input_dev);
+       kfree(dev);
+       return error;
+}
+
+static struct serio_device_id hil_dev_ids[] = {
+       {
+               .type = SERIO_HIL_MLC,
+               .proto = SERIO_HIL,
+               .id = SERIO_ANY,
+               .extra = SERIO_ANY,
+       },
+       { 0 }
+};
+
+MODULE_DEVICE_TABLE(serio, hil_dev_ids);
+
+static struct serio_driver hil_serio_drv = {
+       .driver         = {
+               .name   = "hil_dev",
+       },
+       .description    = "HP HIL keyboard/mouse/tablet driver",
+       .id_table       = hil_dev_ids,
+       .connect        = hil_dev_connect,
+       .disconnect     = hil_dev_disconnect,
+       .interrupt      = hil_dev_interrupt
+};
+
+module_serio_driver(hil_serio_drv);