stowaway.c 3.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * Stowaway keyboard driver for Linux
  4. */
  5. /*
  6. * Copyright (c) 2006 Marek Vasut
  7. *
  8. * Based on Newton keyboard driver for Linux
  9. * by Justin Cormack
  10. */
  11. /*
  12. */
  13. #include <linux/slab.h>
  14. #include <linux/module.h>
  15. #include <linux/input.h>
  16. #include <linux/serio.h>
  17. #define DRIVER_DESC "Stowaway keyboard driver"
  18. MODULE_AUTHOR("Marek Vasut <marek.vasut@gmail.com>");
  19. MODULE_DESCRIPTION(DRIVER_DESC);
  20. MODULE_LICENSE("GPL");
  21. #define SKBD_KEY_MASK 0x7f
  22. #define SKBD_RELEASE 0x80
  23. static unsigned char skbd_keycode[128] = {
  24. KEY_1, KEY_2, KEY_3, KEY_Z, KEY_4, KEY_5, KEY_6, KEY_7,
  25. 0, KEY_Q, KEY_W, KEY_E, KEY_R, KEY_T, KEY_Y, KEY_GRAVE,
  26. KEY_X, KEY_A, KEY_S, KEY_D, KEY_F, KEY_G, KEY_H, KEY_SPACE,
  27. KEY_CAPSLOCK, KEY_TAB, KEY_LEFTCTRL, 0, 0, 0, 0, 0,
  28. 0, 0, 0, KEY_LEFTALT, 0, 0, 0, 0,
  29. 0, 0, 0, 0, KEY_C, KEY_V, KEY_B, KEY_N,
  30. KEY_MINUS, KEY_EQUAL, KEY_BACKSPACE, KEY_HOME, KEY_8, KEY_9, KEY_0, KEY_ESC,
  31. KEY_LEFTBRACE, KEY_RIGHTBRACE, KEY_BACKSLASH, KEY_END, KEY_U, KEY_I, KEY_O, KEY_P,
  32. KEY_APOSTROPHE, KEY_ENTER, KEY_PAGEUP,0, KEY_J, KEY_K, KEY_L, KEY_SEMICOLON,
  33. KEY_SLASH, KEY_UP, KEY_PAGEDOWN, 0,KEY_M, KEY_COMMA, KEY_DOT, KEY_INSERT,
  34. KEY_DELETE, KEY_LEFT, KEY_DOWN, KEY_RIGHT, 0, 0, 0,
  35. KEY_LEFTSHIFT, KEY_RIGHTSHIFT, 0, 0, 0, 0, 0,
  36. 0, 0, 0, 0, 0, 0, 0, 0,
  37. 0, 0, 0, 0, 0, 0, 0, 0,
  38. 0, KEY_F1, KEY_F2, KEY_F3, KEY_F4, KEY_F5, KEY_F6, KEY_F7,
  39. KEY_F8, KEY_F9, KEY_F10, KEY_F11, KEY_F12, 0, 0, 0
  40. };
  41. struct skbd {
  42. unsigned char keycode[128];
  43. struct input_dev *dev;
  44. struct serio *serio;
  45. char phys[32];
  46. };
  47. static irqreturn_t skbd_interrupt(struct serio *serio, unsigned char data,
  48. unsigned int flags)
  49. {
  50. struct skbd *skbd = serio_get_drvdata(serio);
  51. struct input_dev *dev = skbd->dev;
  52. if (skbd->keycode[data & SKBD_KEY_MASK]) {
  53. input_report_key(dev, skbd->keycode[data & SKBD_KEY_MASK],
  54. !(data & SKBD_RELEASE));
  55. input_sync(dev);
  56. }
  57. return IRQ_HANDLED;
  58. }
  59. static int skbd_connect(struct serio *serio, struct serio_driver *drv)
  60. {
  61. struct skbd *skbd;
  62. struct input_dev *input_dev;
  63. int err = -ENOMEM;
  64. int i;
  65. skbd = kzalloc(sizeof(struct skbd), GFP_KERNEL);
  66. input_dev = input_allocate_device();
  67. if (!skbd || !input_dev)
  68. goto fail1;
  69. skbd->serio = serio;
  70. skbd->dev = input_dev;
  71. snprintf(skbd->phys, sizeof(skbd->phys), "%s/input0", serio->phys);
  72. memcpy(skbd->keycode, skbd_keycode, sizeof(skbd->keycode));
  73. input_dev->name = "Stowaway Keyboard";
  74. input_dev->phys = skbd->phys;
  75. input_dev->id.bustype = BUS_RS232;
  76. input_dev->id.vendor = SERIO_STOWAWAY;
  77. input_dev->id.product = 0x0001;
  78. input_dev->id.version = 0x0100;
  79. input_dev->dev.parent = &serio->dev;
  80. input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP);
  81. input_dev->keycode = skbd->keycode;
  82. input_dev->keycodesize = sizeof(unsigned char);
  83. input_dev->keycodemax = ARRAY_SIZE(skbd_keycode);
  84. for (i = 0; i < ARRAY_SIZE(skbd_keycode); i++)
  85. set_bit(skbd_keycode[i], input_dev->keybit);
  86. clear_bit(0, input_dev->keybit);
  87. serio_set_drvdata(serio, skbd);
  88. err = serio_open(serio, drv);
  89. if (err)
  90. goto fail2;
  91. err = input_register_device(skbd->dev);
  92. if (err)
  93. goto fail3;
  94. return 0;
  95. fail3: serio_close(serio);
  96. fail2: serio_set_drvdata(serio, NULL);
  97. fail1: input_free_device(input_dev);
  98. kfree(skbd);
  99. return err;
  100. }
  101. static void skbd_disconnect(struct serio *serio)
  102. {
  103. struct skbd *skbd = serio_get_drvdata(serio);
  104. serio_close(serio);
  105. serio_set_drvdata(serio, NULL);
  106. input_unregister_device(skbd->dev);
  107. kfree(skbd);
  108. }
  109. static const struct serio_device_id skbd_serio_ids[] = {
  110. {
  111. .type = SERIO_RS232,
  112. .proto = SERIO_STOWAWAY,
  113. .id = SERIO_ANY,
  114. .extra = SERIO_ANY,
  115. },
  116. { 0 }
  117. };
  118. MODULE_DEVICE_TABLE(serio, skbd_serio_ids);
  119. static struct serio_driver skbd_drv = {
  120. .driver = {
  121. .name = "stowaway",
  122. },
  123. .description = DRIVER_DESC,
  124. .id_table = skbd_serio_ids,
  125. .interrupt = skbd_interrupt,
  126. .connect = skbd_connect,
  127. .disconnect = skbd_disconnect,
  128. };
  129. module_serio_driver(skbd_drv);