rpckbd.c 3.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * Copyright (c) 2000-2001 Vojtech Pavlik
  4. * Copyright (c) 2002 Russell King
  5. */
  6. /*
  7. * Acorn RiscPC PS/2 keyboard controller driver for Linux/ARM
  8. */
  9. /*
  10. */
  11. #include <linux/module.h>
  12. #include <linux/interrupt.h>
  13. #include <linux/serio.h>
  14. #include <linux/err.h>
  15. #include <linux/platform_device.h>
  16. #include <linux/io.h>
  17. #include <linux/slab.h>
  18. #include <mach/hardware.h>
  19. #include <asm/hardware/iomd.h>
  20. MODULE_AUTHOR("Vojtech Pavlik, Russell King");
  21. MODULE_DESCRIPTION("Acorn RiscPC PS/2 keyboard controller driver");
  22. MODULE_LICENSE("GPL");
  23. MODULE_ALIAS("platform:kart");
  24. struct rpckbd_data {
  25. int tx_irq;
  26. int rx_irq;
  27. };
  28. static int rpckbd_write(struct serio *port, unsigned char val)
  29. {
  30. while (!(iomd_readb(IOMD_KCTRL) & (1 << 7)))
  31. cpu_relax();
  32. iomd_writeb(val, IOMD_KARTTX);
  33. return 0;
  34. }
  35. static irqreturn_t rpckbd_rx(int irq, void *dev_id)
  36. {
  37. struct serio *port = dev_id;
  38. unsigned int byte;
  39. int handled = IRQ_NONE;
  40. while (iomd_readb(IOMD_KCTRL) & (1 << 5)) {
  41. byte = iomd_readb(IOMD_KARTRX);
  42. serio_interrupt(port, byte, 0);
  43. handled = IRQ_HANDLED;
  44. }
  45. return handled;
  46. }
  47. static irqreturn_t rpckbd_tx(int irq, void *dev_id)
  48. {
  49. return IRQ_HANDLED;
  50. }
  51. static int rpckbd_open(struct serio *port)
  52. {
  53. struct rpckbd_data *rpckbd = port->port_data;
  54. /* Reset the keyboard state machine. */
  55. iomd_writeb(0, IOMD_KCTRL);
  56. iomd_writeb(8, IOMD_KCTRL);
  57. iomd_readb(IOMD_KARTRX);
  58. if (request_irq(rpckbd->rx_irq, rpckbd_rx, 0, "rpckbd", port) != 0) {
  59. printk(KERN_ERR "rpckbd.c: Could not allocate keyboard receive IRQ\n");
  60. return -EBUSY;
  61. }
  62. if (request_irq(rpckbd->tx_irq, rpckbd_tx, 0, "rpckbd", port) != 0) {
  63. printk(KERN_ERR "rpckbd.c: Could not allocate keyboard transmit IRQ\n");
  64. free_irq(rpckbd->rx_irq, port);
  65. return -EBUSY;
  66. }
  67. return 0;
  68. }
  69. static void rpckbd_close(struct serio *port)
  70. {
  71. struct rpckbd_data *rpckbd = port->port_data;
  72. free_irq(rpckbd->rx_irq, port);
  73. free_irq(rpckbd->tx_irq, port);
  74. }
  75. /*
  76. * Allocate and initialize serio structure for subsequent registration
  77. * with serio core.
  78. */
  79. static int rpckbd_probe(struct platform_device *dev)
  80. {
  81. struct rpckbd_data *rpckbd;
  82. struct serio *serio;
  83. int tx_irq, rx_irq;
  84. rx_irq = platform_get_irq(dev, 0);
  85. if (rx_irq <= 0)
  86. return rx_irq < 0 ? rx_irq : -ENXIO;
  87. tx_irq = platform_get_irq(dev, 1);
  88. if (tx_irq <= 0)
  89. return tx_irq < 0 ? tx_irq : -ENXIO;
  90. serio = kzalloc(sizeof(struct serio), GFP_KERNEL);
  91. rpckbd = kzalloc(sizeof(*rpckbd), GFP_KERNEL);
  92. if (!serio || !rpckbd) {
  93. kfree(rpckbd);
  94. kfree(serio);
  95. return -ENOMEM;
  96. }
  97. rpckbd->rx_irq = rx_irq;
  98. rpckbd->tx_irq = tx_irq;
  99. serio->id.type = SERIO_8042;
  100. serio->write = rpckbd_write;
  101. serio->open = rpckbd_open;
  102. serio->close = rpckbd_close;
  103. serio->dev.parent = &dev->dev;
  104. serio->port_data = rpckbd;
  105. strlcpy(serio->name, "RiscPC PS/2 kbd port", sizeof(serio->name));
  106. strlcpy(serio->phys, "rpckbd/serio0", sizeof(serio->phys));
  107. platform_set_drvdata(dev, serio);
  108. serio_register_port(serio);
  109. return 0;
  110. }
  111. static int rpckbd_remove(struct platform_device *dev)
  112. {
  113. struct serio *serio = platform_get_drvdata(dev);
  114. struct rpckbd_data *rpckbd = serio->port_data;
  115. serio_unregister_port(serio);
  116. kfree(rpckbd);
  117. return 0;
  118. }
  119. static struct platform_driver rpckbd_driver = {
  120. .probe = rpckbd_probe,
  121. .remove = rpckbd_remove,
  122. .driver = {
  123. .name = "kart",
  124. },
  125. };
  126. module_platform_driver(rpckbd_driver);