leds-cobalt-qube.c 1.6 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright 2006 - Florian Fainelli <florian@openwrt.org>
  4. *
  5. * Control the Cobalt Qube/RaQ front LED
  6. */
  7. #include <linux/io.h>
  8. #include <linux/ioport.h>
  9. #include <linux/leds.h>
  10. #include <linux/module.h>
  11. #include <linux/platform_device.h>
  12. #include <linux/types.h>
  13. #define LED_FRONT_LEFT 0x01
  14. #define LED_FRONT_RIGHT 0x02
  15. static void __iomem *led_port;
  16. static u8 led_value;
  17. static void qube_front_led_set(struct led_classdev *led_cdev,
  18. enum led_brightness brightness)
  19. {
  20. if (brightness)
  21. led_value = LED_FRONT_LEFT | LED_FRONT_RIGHT;
  22. else
  23. led_value = ~(LED_FRONT_LEFT | LED_FRONT_RIGHT);
  24. writeb(led_value, led_port);
  25. }
  26. static struct led_classdev qube_front_led = {
  27. .name = "qube::front",
  28. .brightness = LED_FULL,
  29. .brightness_set = qube_front_led_set,
  30. .default_trigger = "default-on",
  31. };
  32. static int cobalt_qube_led_probe(struct platform_device *pdev)
  33. {
  34. struct resource *res;
  35. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  36. if (!res)
  37. return -EBUSY;
  38. led_port = devm_ioremap(&pdev->dev, res->start, resource_size(res));
  39. if (!led_port)
  40. return -ENOMEM;
  41. led_value = LED_FRONT_LEFT | LED_FRONT_RIGHT;
  42. writeb(led_value, led_port);
  43. return devm_led_classdev_register(&pdev->dev, &qube_front_led);
  44. }
  45. static struct platform_driver cobalt_qube_led_driver = {
  46. .probe = cobalt_qube_led_probe,
  47. .driver = {
  48. .name = "cobalt-qube-leds",
  49. },
  50. };
  51. module_platform_driver(cobalt_qube_led_driver);
  52. MODULE_LICENSE("GPL");
  53. MODULE_DESCRIPTION("Front LED support for Cobalt Server");
  54. MODULE_AUTHOR("Florian Fainelli <florian@openwrt.org>");
  55. MODULE_ALIAS("platform:cobalt-qube-leds");