opencores-kbd.c 3.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * OpenCores Keyboard Controller Driver
  4. * http://www.opencores.org/project,keyboardcontroller
  5. *
  6. * Copyright 2007-2009 HV Sistemas S.L.
  7. */
  8. #include <linux/input.h>
  9. #include <linux/interrupt.h>
  10. #include <linux/io.h>
  11. #include <linux/ioport.h>
  12. #include <linux/kernel.h>
  13. #include <linux/module.h>
  14. #include <linux/platform_device.h>
  15. #include <linux/slab.h>
  16. struct opencores_kbd {
  17. struct input_dev *input;
  18. void __iomem *addr;
  19. int irq;
  20. unsigned short keycodes[128];
  21. };
  22. static irqreturn_t opencores_kbd_isr(int irq, void *dev_id)
  23. {
  24. struct opencores_kbd *opencores_kbd = dev_id;
  25. struct input_dev *input = opencores_kbd->input;
  26. unsigned char c;
  27. c = readb(opencores_kbd->addr);
  28. input_report_key(input, c & 0x7f, c & 0x80 ? 0 : 1);
  29. input_sync(input);
  30. return IRQ_HANDLED;
  31. }
  32. static int opencores_kbd_probe(struct platform_device *pdev)
  33. {
  34. struct input_dev *input;
  35. struct opencores_kbd *opencores_kbd;
  36. struct resource *res;
  37. int irq, i, error;
  38. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  39. if (!res) {
  40. dev_err(&pdev->dev, "missing board memory resource\n");
  41. return -EINVAL;
  42. }
  43. irq = platform_get_irq(pdev, 0);
  44. if (irq < 0)
  45. return -EINVAL;
  46. opencores_kbd = devm_kzalloc(&pdev->dev, sizeof(*opencores_kbd),
  47. GFP_KERNEL);
  48. if (!opencores_kbd)
  49. return -ENOMEM;
  50. input = devm_input_allocate_device(&pdev->dev);
  51. if (!input) {
  52. dev_err(&pdev->dev, "failed to allocate input device\n");
  53. return -ENOMEM;
  54. }
  55. opencores_kbd->input = input;
  56. opencores_kbd->addr = devm_ioremap_resource(&pdev->dev, res);
  57. if (IS_ERR(opencores_kbd->addr))
  58. return PTR_ERR(opencores_kbd->addr);
  59. input->name = pdev->name;
  60. input->phys = "opencores-kbd/input0";
  61. input->id.bustype = BUS_HOST;
  62. input->id.vendor = 0x0001;
  63. input->id.product = 0x0001;
  64. input->id.version = 0x0100;
  65. input->keycode = opencores_kbd->keycodes;
  66. input->keycodesize = sizeof(opencores_kbd->keycodes[0]);
  67. input->keycodemax = ARRAY_SIZE(opencores_kbd->keycodes);
  68. __set_bit(EV_KEY, input->evbit);
  69. for (i = 0; i < ARRAY_SIZE(opencores_kbd->keycodes); i++) {
  70. /*
  71. * OpenCores controller happens to have scancodes match
  72. * our KEY_* definitions.
  73. */
  74. opencores_kbd->keycodes[i] = i;
  75. __set_bit(opencores_kbd->keycodes[i], input->keybit);
  76. }
  77. __clear_bit(KEY_RESERVED, input->keybit);
  78. error = devm_request_irq(&pdev->dev, irq, &opencores_kbd_isr,
  79. IRQF_TRIGGER_RISING,
  80. pdev->name, opencores_kbd);
  81. if (error) {
  82. dev_err(&pdev->dev, "unable to claim irq %d\n", irq);
  83. return error;
  84. }
  85. error = input_register_device(input);
  86. if (error) {
  87. dev_err(&pdev->dev, "unable to register input device\n");
  88. return error;
  89. }
  90. return 0;
  91. }
  92. static struct platform_driver opencores_kbd_device_driver = {
  93. .probe = opencores_kbd_probe,
  94. .driver = {
  95. .name = "opencores-kbd",
  96. },
  97. };
  98. module_platform_driver(opencores_kbd_device_driver);
  99. MODULE_LICENSE("GPL");
  100. MODULE_AUTHOR("Javier Herrero <jherrero@hvsistemas.es>");
  101. MODULE_DESCRIPTION("Keyboard driver for OpenCores Keyboard Controller");