ledtrig-timer.c 3.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * LED Kernel Timer Trigger
  4. *
  5. * Copyright 2005-2006 Openedhand Ltd.
  6. *
  7. * Author: Richard Purdie <[email protected]>
  8. */
  9. #include <linux/module.h>
  10. #include <linux/kernel.h>
  11. #include <linux/init.h>
  12. #include <linux/device.h>
  13. #include <linux/ctype.h>
  14. #include <linux/slab.h>
  15. #include <linux/leds.h>
  16. static ssize_t led_delay_on_show(struct device *dev,
  17. struct device_attribute *attr, char *buf)
  18. {
  19. struct led_classdev *led_cdev = led_trigger_get_led(dev);
  20. return sprintf(buf, "%lu\n", led_cdev->blink_delay_on);
  21. }
  22. static ssize_t led_delay_on_store(struct device *dev,
  23. struct device_attribute *attr, const char *buf, size_t size)
  24. {
  25. struct led_classdev *led_cdev = led_trigger_get_led(dev);
  26. unsigned long state;
  27. ssize_t ret;
  28. ret = kstrtoul(buf, 10, &state);
  29. if (ret)
  30. return ret;
  31. led_blink_set(led_cdev, &state, &led_cdev->blink_delay_off);
  32. led_cdev->blink_delay_on = state;
  33. return size;
  34. }
  35. static ssize_t led_delay_off_show(struct device *dev,
  36. struct device_attribute *attr, char *buf)
  37. {
  38. struct led_classdev *led_cdev = led_trigger_get_led(dev);
  39. return sprintf(buf, "%lu\n", led_cdev->blink_delay_off);
  40. }
  41. static ssize_t led_delay_off_store(struct device *dev,
  42. struct device_attribute *attr, const char *buf, size_t size)
  43. {
  44. struct led_classdev *led_cdev = led_trigger_get_led(dev);
  45. unsigned long state;
  46. ssize_t ret;
  47. ret = kstrtoul(buf, 10, &state);
  48. if (ret)
  49. return ret;
  50. led_blink_set(led_cdev, &led_cdev->blink_delay_on, &state);
  51. led_cdev->blink_delay_off = state;
  52. return size;
  53. }
  54. static DEVICE_ATTR(delay_on, 0644, led_delay_on_show, led_delay_on_store);
  55. static DEVICE_ATTR(delay_off, 0644, led_delay_off_show, led_delay_off_store);
  56. static struct attribute *timer_trig_attrs[] = {
  57. &dev_attr_delay_on.attr,
  58. &dev_attr_delay_off.attr,
  59. NULL
  60. };
  61. ATTRIBUTE_GROUPS(timer_trig);
  62. static void pattern_init(struct led_classdev *led_cdev)
  63. {
  64. u32 *pattern;
  65. unsigned int size = 0;
  66. pattern = led_get_default_pattern(led_cdev, &size);
  67. if (!pattern)
  68. return;
  69. if (size != 2) {
  70. dev_warn(led_cdev->dev,
  71. "Expected 2 but got %u values for delays pattern\n",
  72. size);
  73. goto out;
  74. }
  75. led_cdev->blink_delay_on = pattern[0];
  76. led_cdev->blink_delay_off = pattern[1];
  77. /* led_blink_set() called by caller */
  78. out:
  79. kfree(pattern);
  80. }
  81. static int timer_trig_activate(struct led_classdev *led_cdev)
  82. {
  83. if (led_cdev->flags & LED_INIT_DEFAULT_TRIGGER) {
  84. pattern_init(led_cdev);
  85. /*
  86. * Mark as initialized even on pattern_init() error because
  87. * any consecutive call to it would produce the same error.
  88. */
  89. led_cdev->flags &= ~LED_INIT_DEFAULT_TRIGGER;
  90. }
  91. /*
  92. * If "set brightness to 0" is pending in workqueue, we don't
  93. * want that to be reordered after blink_set()
  94. */
  95. flush_work(&led_cdev->set_brightness_work);
  96. led_blink_set(led_cdev, &led_cdev->blink_delay_on,
  97. &led_cdev->blink_delay_off);
  98. return 0;
  99. }
  100. static void timer_trig_deactivate(struct led_classdev *led_cdev)
  101. {
  102. /* Stop blinking */
  103. led_set_brightness(led_cdev, LED_OFF);
  104. }
  105. static struct led_trigger timer_led_trigger = {
  106. .name = "timer",
  107. .activate = timer_trig_activate,
  108. .deactivate = timer_trig_deactivate,
  109. .groups = timer_trig_groups,
  110. };
  111. module_led_trigger(timer_led_trigger);
  112. MODULE_AUTHOR("Richard Purdie <[email protected]>");
  113. MODULE_DESCRIPTION("Timer LED trigger");
  114. MODULE_LICENSE("GPL v2");