Loading drivers/input/keyboard/hil_kbd.c +78 −78 Original line number Diff line number Diff line Loading @@ -49,7 +49,7 @@ MODULE_DESCRIPTION(HIL_GENERIC_NAME " driver"); MODULE_LICENSE("Dual BSD/GPL"); MODULE_ALIAS("serio:ty03pr25id00ex*"); #define HIL_KBD_MAX_LENGTH 16 #define HIL_PACKET_MAX_LENGTH 16 #define HIL_KBD_SET1_UPBIT 0x01 #define HIL_KBD_SET1_SHIFT 1 Loading @@ -67,24 +67,24 @@ static unsigned int hil_kbd_set3[HIL_KEYCODES_SET3_TBLSIZE] __read_mostly = static const char hil_language[][16] = { HIL_LOCALE_MAP }; struct hil_kbd { struct hil_dev { struct input_dev *dev; struct serio *serio; /* Input buffer and index for packets from HIL bus. */ hil_packet data[HIL_KBD_MAX_LENGTH]; 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_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. */ 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; }; static bool hil_kbd_is_command_response(hil_packet p) 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; Loading @@ -95,31 +95,31 @@ static bool hil_kbd_is_command_response(hil_packet p) return true; } static void hil_kbd_handle_command_response(struct hil_kbd *kbd) static void hil_dev_handle_command_response(struct hil_dev *dev) { hil_packet p; char *buf; int i, idx; idx = kbd->idx4 / 4; p = kbd->data[idx - 1]; idx = dev->idx4 / 4; p = dev->data[idx - 1]; switch (p & HIL_PKT_DATA_MASK) { case HIL_CMD_IDD: buf = kbd->idd; buf = dev->idd; break; case HIL_CMD_RSC: buf = kbd->rsc; buf = dev->rsc; break; case HIL_CMD_EXD: buf = kbd->exd; buf = dev->exd; break; case HIL_CMD_RNM: kbd->rnm[HIL_KBD_MAX_LENGTH] = 0; buf = kbd->rnm; dev->rnm[HIL_PACKET_MAX_LENGTH] = 0; buf = dev->rnm; break; default: Loading @@ -132,14 +132,14 @@ static void hil_kbd_handle_command_response(struct hil_kbd *kbd) } for (i = 0; i < idx; i++) buf[i] = kbd->data[i] & HIL_PKT_DATA_MASK; for (; i < HIL_KBD_MAX_LENGTH; i++) buf[i] = dev->data[i] & HIL_PKT_DATA_MASK; for (; i < HIL_PACKET_MAX_LENGTH; i++) buf[i] = 0; out: complete(&kbd->cmd_done); complete(&dev->cmd_done); } static void hil_kbd_handle_key_events(struct hil_kbd *kbd) static void hil_dev_handle_key_events(struct hil_dev *kbd) { struct input_dev *dev = kbd->dev; int idx = kbd->idx4 / 4; Loading Loading @@ -198,125 +198,125 @@ static void hil_kbd_handle_key_events(struct hil_kbd *kbd) input_sync(dev); } static void hil_kbd_process_err(struct hil_kbd *kbd) static void hil_dev_process_err(struct hil_dev *dev) { printk(KERN_WARNING PREFIX "errored HIL packet\n"); kbd->idx4 = 0; complete(&kbd->cmd_done); /* just in case somebody is waiting */ dev->idx4 = 0; complete(&dev->cmd_done); /* just in case somebody is waiting */ } static irqreturn_t hil_kbd_interrupt(struct serio *serio, static irqreturn_t hil_dev_interrupt(struct serio *serio, unsigned char data, unsigned int flags) { struct hil_kbd *kbd; struct hil_dev *dev; hil_packet packet; int idx; kbd = serio_get_drvdata(serio); BUG_ON(kbd == NULL); dev = serio_get_drvdata(serio); BUG_ON(dev == NULL); if (kbd->idx4 >= HIL_KBD_MAX_LENGTH * sizeof(hil_packet)) { hil_kbd_process_err(kbd); if (dev->idx4 >= HIL_PACKET_MAX_LENGTH * sizeof(hil_packet)) { hil_dev_process_err(dev); goto out; } 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; 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 ((++kbd->idx4 % 4) == 0) { if ((++dev->idx4 % 4) == 0) { if ((packet & 0xffff0000) != HIL_ERR_INT) { hil_kbd_process_err(kbd); hil_dev_process_err(dev); } else if (packet & HIL_PKT_CMD) { if (hil_kbd_is_command_response(packet)) hil_kbd_handle_command_response(kbd); if (hil_dev_is_command_response(packet)) hil_dev_handle_command_response(dev); else hil_kbd_handle_key_events(kbd); kbd->idx4 = 0; hil_dev_handle_key_events(dev); dev->idx4 = 0; } } out: return IRQ_HANDLED; } static void hil_kbd_disconnect(struct serio *serio) static void hil_dev_disconnect(struct serio *serio) { struct hil_kbd *kbd = serio_get_drvdata(serio); struct hil_dev *dev = serio_get_drvdata(serio); BUG_ON(kbd == NULL); BUG_ON(dev == NULL); serio_close(serio); input_unregister_device(kbd->dev); kfree(kbd); input_unregister_device(dev->dev); kfree(dev); } static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) static int hil_dev_connect(struct serio *serio, struct serio_driver *drv) { struct hil_kbd *kbd; struct hil_dev *dev; struct input_dev *input_dev; uint8_t did, *idd; int i; int error; kbd = kzalloc(sizeof(*kbd), GFP_KERNEL); dev = kzalloc(sizeof(*dev), GFP_KERNEL); input_dev = input_allocate_device(); if (!kbd || !input_dev) { if (!dev || !input_dev) { error = -ENOMEM; goto bail0; } kbd->serio = serio; kbd->dev = input_dev; dev->serio = serio; dev->dev = input_dev; error = serio_open(serio, drv); if (error) goto bail0; serio_set_drvdata(serio, kbd); serio_set_drvdata(serio, dev); /* Get device info. MLC driver supplies devid/status/etc. */ init_completion(&kbd->cmd_done); 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(&kbd->cmd_done); error = wait_for_completion_killable(&dev->cmd_done); if (error) goto bail1; init_completion(&kbd->cmd_done); 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_RSC); error = wait_for_completion_killable(&kbd->cmd_done); error = wait_for_completion_killable(&dev->cmd_done); if (error) goto bail1; init_completion(&kbd->cmd_done); 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_RNM); error = wait_for_completion_killable(&kbd->cmd_done); error = wait_for_completion_killable(&dev->cmd_done); if (error) goto bail1; init_completion(&kbd->cmd_done); 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_EXD); error = wait_for_completion_killable(&kbd->cmd_done); error = wait_for_completion_killable(&dev->cmd_done); if (error) goto bail1; did = kbd->idd[0]; idd = kbd->idd + 1; 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: Loading @@ -340,7 +340,7 @@ static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) 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_GENERIC_NAME; input_dev->name = strlen(dev->rnm) ? dev->rnm : HIL_GENERIC_NAME; input_dev->phys = "hpkbd/input0"; /* XXX */ input_dev->id.bustype = BUS_HIL; Loading @@ -361,7 +361,7 @@ static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) serio_write(serio, HIL_CMD_EK1); /* Enable Keyswitch Autorepeat 1 */ /* No need to wait for completion */ error = input_register_device(kbd->dev); error = input_register_device(input_dev); if (error) goto bail1; Loading @@ -372,11 +372,11 @@ static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) serio_set_drvdata(serio, NULL); bail0: input_free_device(input_dev); kfree(kbd); kfree(dev); return error; } static struct serio_device_id hil_kbd_ids[] = { static struct serio_device_id hil_dev_ids[] = { { .type = SERIO_HIL_MLC, .proto = SERIO_HIL, Loading @@ -386,26 +386,26 @@ static struct serio_device_id hil_kbd_ids[] = { { 0 } }; static struct serio_driver hil_kbd_serio_drv = { static struct serio_driver hil_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 .id_table = hil_dev_ids, .connect = hil_dev_connect, .disconnect = hil_dev_disconnect, .interrupt = hil_dev_interrupt }; static int __init hil_kbd_init(void) static int __init hil_dev_init(void) { return serio_register_driver(&hil_kbd_serio_drv); return serio_register_driver(&hil_serio_drv); } static void __exit hil_kbd_exit(void) static void __exit hil_dev_exit(void) { serio_unregister_driver(&hil_kbd_serio_drv); serio_unregister_driver(&hil_serio_drv); } module_init(hil_kbd_init); module_exit(hil_kbd_exit); module_init(hil_dev_init); module_exit(hil_dev_exit); Loading
drivers/input/keyboard/hil_kbd.c +78 −78 Original line number Diff line number Diff line Loading @@ -49,7 +49,7 @@ MODULE_DESCRIPTION(HIL_GENERIC_NAME " driver"); MODULE_LICENSE("Dual BSD/GPL"); MODULE_ALIAS("serio:ty03pr25id00ex*"); #define HIL_KBD_MAX_LENGTH 16 #define HIL_PACKET_MAX_LENGTH 16 #define HIL_KBD_SET1_UPBIT 0x01 #define HIL_KBD_SET1_SHIFT 1 Loading @@ -67,24 +67,24 @@ static unsigned int hil_kbd_set3[HIL_KEYCODES_SET3_TBLSIZE] __read_mostly = static const char hil_language[][16] = { HIL_LOCALE_MAP }; struct hil_kbd { struct hil_dev { struct input_dev *dev; struct serio *serio; /* Input buffer and index for packets from HIL bus. */ hil_packet data[HIL_KBD_MAX_LENGTH]; 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_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. */ 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; }; static bool hil_kbd_is_command_response(hil_packet p) 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; Loading @@ -95,31 +95,31 @@ static bool hil_kbd_is_command_response(hil_packet p) return true; } static void hil_kbd_handle_command_response(struct hil_kbd *kbd) static void hil_dev_handle_command_response(struct hil_dev *dev) { hil_packet p; char *buf; int i, idx; idx = kbd->idx4 / 4; p = kbd->data[idx - 1]; idx = dev->idx4 / 4; p = dev->data[idx - 1]; switch (p & HIL_PKT_DATA_MASK) { case HIL_CMD_IDD: buf = kbd->idd; buf = dev->idd; break; case HIL_CMD_RSC: buf = kbd->rsc; buf = dev->rsc; break; case HIL_CMD_EXD: buf = kbd->exd; buf = dev->exd; break; case HIL_CMD_RNM: kbd->rnm[HIL_KBD_MAX_LENGTH] = 0; buf = kbd->rnm; dev->rnm[HIL_PACKET_MAX_LENGTH] = 0; buf = dev->rnm; break; default: Loading @@ -132,14 +132,14 @@ static void hil_kbd_handle_command_response(struct hil_kbd *kbd) } for (i = 0; i < idx; i++) buf[i] = kbd->data[i] & HIL_PKT_DATA_MASK; for (; i < HIL_KBD_MAX_LENGTH; i++) buf[i] = dev->data[i] & HIL_PKT_DATA_MASK; for (; i < HIL_PACKET_MAX_LENGTH; i++) buf[i] = 0; out: complete(&kbd->cmd_done); complete(&dev->cmd_done); } static void hil_kbd_handle_key_events(struct hil_kbd *kbd) static void hil_dev_handle_key_events(struct hil_dev *kbd) { struct input_dev *dev = kbd->dev; int idx = kbd->idx4 / 4; Loading Loading @@ -198,125 +198,125 @@ static void hil_kbd_handle_key_events(struct hil_kbd *kbd) input_sync(dev); } static void hil_kbd_process_err(struct hil_kbd *kbd) static void hil_dev_process_err(struct hil_dev *dev) { printk(KERN_WARNING PREFIX "errored HIL packet\n"); kbd->idx4 = 0; complete(&kbd->cmd_done); /* just in case somebody is waiting */ dev->idx4 = 0; complete(&dev->cmd_done); /* just in case somebody is waiting */ } static irqreturn_t hil_kbd_interrupt(struct serio *serio, static irqreturn_t hil_dev_interrupt(struct serio *serio, unsigned char data, unsigned int flags) { struct hil_kbd *kbd; struct hil_dev *dev; hil_packet packet; int idx; kbd = serio_get_drvdata(serio); BUG_ON(kbd == NULL); dev = serio_get_drvdata(serio); BUG_ON(dev == NULL); if (kbd->idx4 >= HIL_KBD_MAX_LENGTH * sizeof(hil_packet)) { hil_kbd_process_err(kbd); if (dev->idx4 >= HIL_PACKET_MAX_LENGTH * sizeof(hil_packet)) { hil_dev_process_err(dev); goto out; } 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; 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 ((++kbd->idx4 % 4) == 0) { if ((++dev->idx4 % 4) == 0) { if ((packet & 0xffff0000) != HIL_ERR_INT) { hil_kbd_process_err(kbd); hil_dev_process_err(dev); } else if (packet & HIL_PKT_CMD) { if (hil_kbd_is_command_response(packet)) hil_kbd_handle_command_response(kbd); if (hil_dev_is_command_response(packet)) hil_dev_handle_command_response(dev); else hil_kbd_handle_key_events(kbd); kbd->idx4 = 0; hil_dev_handle_key_events(dev); dev->idx4 = 0; } } out: return IRQ_HANDLED; } static void hil_kbd_disconnect(struct serio *serio) static void hil_dev_disconnect(struct serio *serio) { struct hil_kbd *kbd = serio_get_drvdata(serio); struct hil_dev *dev = serio_get_drvdata(serio); BUG_ON(kbd == NULL); BUG_ON(dev == NULL); serio_close(serio); input_unregister_device(kbd->dev); kfree(kbd); input_unregister_device(dev->dev); kfree(dev); } static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) static int hil_dev_connect(struct serio *serio, struct serio_driver *drv) { struct hil_kbd *kbd; struct hil_dev *dev; struct input_dev *input_dev; uint8_t did, *idd; int i; int error; kbd = kzalloc(sizeof(*kbd), GFP_KERNEL); dev = kzalloc(sizeof(*dev), GFP_KERNEL); input_dev = input_allocate_device(); if (!kbd || !input_dev) { if (!dev || !input_dev) { error = -ENOMEM; goto bail0; } kbd->serio = serio; kbd->dev = input_dev; dev->serio = serio; dev->dev = input_dev; error = serio_open(serio, drv); if (error) goto bail0; serio_set_drvdata(serio, kbd); serio_set_drvdata(serio, dev); /* Get device info. MLC driver supplies devid/status/etc. */ init_completion(&kbd->cmd_done); 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(&kbd->cmd_done); error = wait_for_completion_killable(&dev->cmd_done); if (error) goto bail1; init_completion(&kbd->cmd_done); 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_RSC); error = wait_for_completion_killable(&kbd->cmd_done); error = wait_for_completion_killable(&dev->cmd_done); if (error) goto bail1; init_completion(&kbd->cmd_done); 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_RNM); error = wait_for_completion_killable(&kbd->cmd_done); error = wait_for_completion_killable(&dev->cmd_done); if (error) goto bail1; init_completion(&kbd->cmd_done); 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_EXD); error = wait_for_completion_killable(&kbd->cmd_done); error = wait_for_completion_killable(&dev->cmd_done); if (error) goto bail1; did = kbd->idd[0]; idd = kbd->idd + 1; 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: Loading @@ -340,7 +340,7 @@ static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) 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_GENERIC_NAME; input_dev->name = strlen(dev->rnm) ? dev->rnm : HIL_GENERIC_NAME; input_dev->phys = "hpkbd/input0"; /* XXX */ input_dev->id.bustype = BUS_HIL; Loading @@ -361,7 +361,7 @@ static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) serio_write(serio, HIL_CMD_EK1); /* Enable Keyswitch Autorepeat 1 */ /* No need to wait for completion */ error = input_register_device(kbd->dev); error = input_register_device(input_dev); if (error) goto bail1; Loading @@ -372,11 +372,11 @@ static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) serio_set_drvdata(serio, NULL); bail0: input_free_device(input_dev); kfree(kbd); kfree(dev); return error; } static struct serio_device_id hil_kbd_ids[] = { static struct serio_device_id hil_dev_ids[] = { { .type = SERIO_HIL_MLC, .proto = SERIO_HIL, Loading @@ -386,26 +386,26 @@ static struct serio_device_id hil_kbd_ids[] = { { 0 } }; static struct serio_driver hil_kbd_serio_drv = { static struct serio_driver hil_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 .id_table = hil_dev_ids, .connect = hil_dev_connect, .disconnect = hil_dev_disconnect, .interrupt = hil_dev_interrupt }; static int __init hil_kbd_init(void) static int __init hil_dev_init(void) { return serio_register_driver(&hil_kbd_serio_drv); return serio_register_driver(&hil_serio_drv); } static void __exit hil_kbd_exit(void) static void __exit hil_dev_exit(void) { serio_unregister_driver(&hil_kbd_serio_drv); serio_unregister_driver(&hil_serio_drv); } module_init(hil_kbd_init); module_exit(hil_kbd_exit); module_init(hil_dev_init); module_exit(hil_dev_exit);