led-uclass.c 2.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (c) 2015 Google, Inc
  4. * Written by Simon Glass <sjg@chromium.org>
  5. */
  6. #include <common.h>
  7. #include <dm.h>
  8. #include <errno.h>
  9. #include <led.h>
  10. #include <dm/device-internal.h>
  11. #include <dm/root.h>
  12. #include <dm/uclass-internal.h>
  13. int led_get_by_label(const char *label, struct udevice **devp)
  14. {
  15. struct udevice *dev;
  16. struct uclass *uc;
  17. int ret;
  18. ret = uclass_get(UCLASS_LED, &uc);
  19. if (ret)
  20. return ret;
  21. uclass_foreach_dev(dev, uc) {
  22. struct led_uc_plat *uc_plat = dev_get_uclass_platdata(dev);
  23. /* Ignore the top-level LED node */
  24. if (uc_plat->label && !strcmp(label, uc_plat->label))
  25. return uclass_get_device_tail(dev, 0, devp);
  26. }
  27. return -ENODEV;
  28. }
  29. int led_set_state(struct udevice *dev, enum led_state_t state)
  30. {
  31. struct led_ops *ops = led_get_ops(dev);
  32. if (!ops->set_state)
  33. return -ENOSYS;
  34. return ops->set_state(dev, state);
  35. }
  36. enum led_state_t led_get_state(struct udevice *dev)
  37. {
  38. struct led_ops *ops = led_get_ops(dev);
  39. if (!ops->get_state)
  40. return -ENOSYS;
  41. return ops->get_state(dev);
  42. }
  43. #ifdef CONFIG_LED_BLINK
  44. int led_set_period(struct udevice *dev, int period_ms)
  45. {
  46. struct led_ops *ops = led_get_ops(dev);
  47. if (!ops->set_period)
  48. return -ENOSYS;
  49. return ops->set_period(dev, period_ms);
  50. }
  51. #endif
  52. int led_default_state(void)
  53. {
  54. struct udevice *dev;
  55. struct uclass *uc;
  56. const char *default_state;
  57. int ret;
  58. ret = uclass_get(UCLASS_LED, &uc);
  59. if (ret)
  60. return ret;
  61. for (uclass_find_first_device(UCLASS_LED, &dev);
  62. dev;
  63. uclass_find_next_device(&dev)) {
  64. default_state = dev_read_string(dev, "default-state");
  65. if (!default_state)
  66. continue;
  67. ret = device_probe(dev);
  68. if (ret)
  69. return ret;
  70. if (!strncmp(default_state, "on", 2))
  71. led_set_state(dev, LEDST_ON);
  72. else if (!strncmp(default_state, "off", 3))
  73. led_set_state(dev, LEDST_OFF);
  74. /* default-state = "keep" : device is only probed */
  75. }
  76. return ret;
  77. }
  78. UCLASS_DRIVER(led) = {
  79. .id = UCLASS_LED,
  80. .name = "led",
  81. .per_device_platdata_auto_alloc_size = sizeof(struct led_uc_plat),
  82. };