leds-locomo.c 1.9 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * linux/drivers/leds/leds-locomo.c
  4. *
  5. * Copyright (C) 2005 John Lenz <lenz@cs.wisc.edu>
  6. */
  7. #include <linux/kernel.h>
  8. #include <linux/init.h>
  9. #include <linux/module.h>
  10. #include <linux/device.h>
  11. #include <linux/leds.h>
  12. #include <mach/hardware.h>
  13. #include <asm/hardware/locomo.h>
  14. static void locomoled_brightness_set(struct led_classdev *led_cdev,
  15. enum led_brightness value, int offset)
  16. {
  17. struct locomo_dev *locomo_dev = LOCOMO_DEV(led_cdev->dev->parent);
  18. unsigned long flags;
  19. local_irq_save(flags);
  20. if (value)
  21. locomo_writel(LOCOMO_LPT_TOFH, locomo_dev->mapbase + offset);
  22. else
  23. locomo_writel(LOCOMO_LPT_TOFL, locomo_dev->mapbase + offset);
  24. local_irq_restore(flags);
  25. }
  26. static void locomoled_brightness_set0(struct led_classdev *led_cdev,
  27. enum led_brightness value)
  28. {
  29. locomoled_brightness_set(led_cdev, value, LOCOMO_LPT0);
  30. }
  31. static void locomoled_brightness_set1(struct led_classdev *led_cdev,
  32. enum led_brightness value)
  33. {
  34. locomoled_brightness_set(led_cdev, value, LOCOMO_LPT1);
  35. }
  36. static struct led_classdev locomo_led0 = {
  37. .name = "locomo:amber:charge",
  38. .default_trigger = "main-battery-charging",
  39. .brightness_set = locomoled_brightness_set0,
  40. };
  41. static struct led_classdev locomo_led1 = {
  42. .name = "locomo:green:mail",
  43. .default_trigger = "nand-disk",
  44. .brightness_set = locomoled_brightness_set1,
  45. };
  46. static int locomoled_probe(struct locomo_dev *ldev)
  47. {
  48. int ret;
  49. ret = devm_led_classdev_register(&ldev->dev, &locomo_led0);
  50. if (ret < 0)
  51. return ret;
  52. return devm_led_classdev_register(&ldev->dev, &locomo_led1);
  53. }
  54. static struct locomo_driver locomoled_driver = {
  55. .drv = {
  56. .name = "locomoled"
  57. },
  58. .devid = LOCOMO_DEVID_LED,
  59. .probe = locomoled_probe,
  60. };
  61. static int __init locomoled_init(void)
  62. {
  63. return locomo_driver_register(&locomoled_driver);
  64. }
  65. module_init(locomoled_init);
  66. MODULE_AUTHOR("John Lenz <lenz@cs.wisc.edu>");
  67. MODULE_DESCRIPTION("Locomo LED driver");
  68. MODULE_LICENSE("GPL");