keyboard-uclass.c 2.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (c) 2015 Google, Inc
  4. */
  5. #define LOG_CATEGORY UCLASS_KEYBOARD
  6. #include <common.h>
  7. #include <dm.h>
  8. #include <keyboard.h>
  9. #include <log.h>
  10. static int keyboard_start(struct stdio_dev *sdev)
  11. {
  12. struct udevice *dev = sdev->priv;
  13. struct keyboard_ops *ops = keyboard_get_ops(dev);
  14. if (ops->start)
  15. return ops->start(dev);
  16. return 0;
  17. }
  18. static int keyboard_stop(struct stdio_dev *sdev)
  19. {
  20. struct udevice *dev = sdev->priv;
  21. struct keyboard_ops *ops = keyboard_get_ops(dev);
  22. if (ops->stop)
  23. return ops->stop(dev);
  24. return 0;
  25. }
  26. static int keyboard_tstc(struct stdio_dev *sdev)
  27. {
  28. struct udevice *dev = sdev->priv;
  29. struct keyboard_priv *priv = dev_get_uclass_priv(dev);
  30. struct keyboard_ops *ops = keyboard_get_ops(dev);
  31. /* Just get input to do this for us if we can */
  32. if (priv->input.dev)
  33. return input_tstc(&priv->input);
  34. else if (ops->tstc)
  35. return ops->tstc(dev);
  36. return -ENOSYS;
  37. }
  38. static int keyboard_getc(struct stdio_dev *sdev)
  39. {
  40. struct udevice *dev = sdev->priv;
  41. struct keyboard_priv *priv = dev_get_uclass_priv(dev);
  42. struct keyboard_ops *ops = keyboard_get_ops(dev);
  43. /* Just get input to do this for us if we can */
  44. if (priv->input.dev)
  45. return input_getc(&priv->input);
  46. else if (ops->getc)
  47. return ops->getc(dev);
  48. return -ENOSYS;
  49. }
  50. static int keyboard_pre_probe(struct udevice *dev)
  51. {
  52. struct keyboard_priv *priv = dev_get_uclass_priv(dev);
  53. struct stdio_dev *sdev = &priv->sdev;
  54. int ret;
  55. strlcpy(sdev->name, dev->name, sizeof(sdev->name));
  56. sdev->flags = DEV_FLAGS_INPUT;
  57. sdev->getc = keyboard_getc;
  58. sdev->tstc = keyboard_tstc;
  59. sdev->start = keyboard_start;
  60. sdev->stop = keyboard_stop;
  61. sdev->priv = dev;
  62. ret = input_init(&priv->input, 0);
  63. if (ret) {
  64. debug("%s: Cannot set up input, ret=%d - please add DEBUG to drivers/input/input.c to figure out the cause\n",
  65. __func__, ret);
  66. return ret;
  67. }
  68. return 0;
  69. }
  70. UCLASS_DRIVER(keyboard) = {
  71. .id = UCLASS_KEYBOARD,
  72. .name = "keyboard",
  73. .pre_probe = keyboard_pre_probe,
  74. .per_device_auto = sizeof(struct keyboard_priv),
  75. };