ioc3kbd.c 4.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * SGI IOC3 PS/2 controller driver for linux
  4. *
  5. * Copyright (C) 2019 Thomas Bogendoerfer <tbogendoerfer@suse.de>
  6. *
  7. * Based on code Copyright (C) 2005 Stanislaw Skowronek <skylark@unaligned.org>
  8. * Copyright (C) 2009 Johannes Dickgreber <tanzy@gmx.de>
  9. */
  10. #include <linux/delay.h>
  11. #include <linux/init.h>
  12. #include <linux/io.h>
  13. #include <linux/serio.h>
  14. #include <linux/module.h>
  15. #include <linux/platform_device.h>
  16. #include <asm/sn/ioc3.h>
  17. struct ioc3kbd_data {
  18. struct ioc3_serioregs __iomem *regs;
  19. struct serio *kbd, *aux;
  20. bool kbd_exists, aux_exists;
  21. int irq;
  22. };
  23. static int ioc3kbd_wait(struct ioc3_serioregs __iomem *regs, u32 mask)
  24. {
  25. unsigned long timeout = 0;
  26. while ((readl(&regs->km_csr) & mask) && (timeout < 250)) {
  27. udelay(50);
  28. timeout++;
  29. }
  30. return (timeout >= 250) ? -ETIMEDOUT : 0;
  31. }
  32. static int ioc3kbd_write(struct serio *dev, u8 val)
  33. {
  34. struct ioc3kbd_data *d = dev->port_data;
  35. int ret;
  36. ret = ioc3kbd_wait(d->regs, KM_CSR_K_WRT_PEND);
  37. if (ret)
  38. return ret;
  39. writel(val, &d->regs->k_wd);
  40. return 0;
  41. }
  42. static int ioc3kbd_start(struct serio *dev)
  43. {
  44. struct ioc3kbd_data *d = dev->port_data;
  45. d->kbd_exists = true;
  46. return 0;
  47. }
  48. static void ioc3kbd_stop(struct serio *dev)
  49. {
  50. struct ioc3kbd_data *d = dev->port_data;
  51. d->kbd_exists = false;
  52. }
  53. static int ioc3aux_write(struct serio *dev, u8 val)
  54. {
  55. struct ioc3kbd_data *d = dev->port_data;
  56. int ret;
  57. ret = ioc3kbd_wait(d->regs, KM_CSR_M_WRT_PEND);
  58. if (ret)
  59. return ret;
  60. writel(val, &d->regs->m_wd);
  61. return 0;
  62. }
  63. static int ioc3aux_start(struct serio *dev)
  64. {
  65. struct ioc3kbd_data *d = dev->port_data;
  66. d->aux_exists = true;
  67. return 0;
  68. }
  69. static void ioc3aux_stop(struct serio *dev)
  70. {
  71. struct ioc3kbd_data *d = dev->port_data;
  72. d->aux_exists = false;
  73. }
  74. static void ioc3kbd_process_data(struct serio *dev, u32 data)
  75. {
  76. if (data & KM_RD_VALID_0)
  77. serio_interrupt(dev, (data >> KM_RD_DATA_0_SHIFT) & 0xff, 0);
  78. if (data & KM_RD_VALID_1)
  79. serio_interrupt(dev, (data >> KM_RD_DATA_1_SHIFT) & 0xff, 0);
  80. if (data & KM_RD_VALID_2)
  81. serio_interrupt(dev, (data >> KM_RD_DATA_2_SHIFT) & 0xff, 0);
  82. }
  83. static irqreturn_t ioc3kbd_intr(int itq, void *dev_id)
  84. {
  85. struct ioc3kbd_data *d = dev_id;
  86. u32 data_k, data_m;
  87. data_k = readl(&d->regs->k_rd);
  88. if (d->kbd_exists)
  89. ioc3kbd_process_data(d->kbd, data_k);
  90. data_m = readl(&d->regs->m_rd);
  91. if (d->aux_exists)
  92. ioc3kbd_process_data(d->aux, data_m);
  93. return IRQ_HANDLED;
  94. }
  95. static int ioc3kbd_probe(struct platform_device *pdev)
  96. {
  97. struct ioc3_serioregs __iomem *regs;
  98. struct device *dev = &pdev->dev;
  99. struct ioc3kbd_data *d;
  100. struct serio *sk, *sa;
  101. int irq, ret;
  102. regs = devm_platform_ioremap_resource(pdev, 0);
  103. if (IS_ERR(regs))
  104. return PTR_ERR(regs);
  105. irq = platform_get_irq(pdev, 0);
  106. if (irq < 0)
  107. return -ENXIO;
  108. d = devm_kzalloc(dev, sizeof(*d), GFP_KERNEL);
  109. if (!d)
  110. return -ENOMEM;
  111. sk = kzalloc(sizeof(*sk), GFP_KERNEL);
  112. if (!sk)
  113. return -ENOMEM;
  114. sa = kzalloc(sizeof(*sa), GFP_KERNEL);
  115. if (!sa) {
  116. kfree(sk);
  117. return -ENOMEM;
  118. }
  119. sk->id.type = SERIO_8042;
  120. sk->write = ioc3kbd_write;
  121. sk->start = ioc3kbd_start;
  122. sk->stop = ioc3kbd_stop;
  123. snprintf(sk->name, sizeof(sk->name), "IOC3 keyboard %d", pdev->id);
  124. snprintf(sk->phys, sizeof(sk->phys), "ioc3/serio%dkbd", pdev->id);
  125. sk->port_data = d;
  126. sk->dev.parent = dev;
  127. sa->id.type = SERIO_8042;
  128. sa->write = ioc3aux_write;
  129. sa->start = ioc3aux_start;
  130. sa->stop = ioc3aux_stop;
  131. snprintf(sa->name, sizeof(sa->name), "IOC3 auxiliary %d", pdev->id);
  132. snprintf(sa->phys, sizeof(sa->phys), "ioc3/serio%daux", pdev->id);
  133. sa->port_data = d;
  134. sa->dev.parent = dev;
  135. d->regs = regs;
  136. d->kbd = sk;
  137. d->aux = sa;
  138. d->irq = irq;
  139. platform_set_drvdata(pdev, d);
  140. serio_register_port(d->kbd);
  141. serio_register_port(d->aux);
  142. ret = request_irq(irq, ioc3kbd_intr, IRQF_SHARED, "ioc3-kbd", d);
  143. if (ret) {
  144. dev_err(dev, "could not request IRQ %d\n", irq);
  145. serio_unregister_port(d->kbd);
  146. serio_unregister_port(d->aux);
  147. return ret;
  148. }
  149. /* enable ports */
  150. writel(KM_CSR_K_CLAMP_3 | KM_CSR_M_CLAMP_3, &regs->km_csr);
  151. return 0;
  152. }
  153. static int ioc3kbd_remove(struct platform_device *pdev)
  154. {
  155. struct ioc3kbd_data *d = platform_get_drvdata(pdev);
  156. free_irq(d->irq, d);
  157. serio_unregister_port(d->kbd);
  158. serio_unregister_port(d->aux);
  159. return 0;
  160. }
  161. static struct platform_driver ioc3kbd_driver = {
  162. .probe = ioc3kbd_probe,
  163. .remove = ioc3kbd_remove,
  164. .driver = {
  165. .name = "ioc3-kbd",
  166. },
  167. };
  168. module_platform_driver(ioc3kbd_driver);
  169. MODULE_AUTHOR("Thomas Bogendoerfer <tbogendoerfer@suse.de>");
  170. MODULE_DESCRIPTION("SGI IOC3 serio driver");
  171. MODULE_LICENSE("GPL");