leds-cobalt-raq.c 2.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * LEDs driver for the Cobalt Raq series.
  4. *
  5. * Copyright (C) 2007 Yoichi Yuasa <yuasa@linux-mips.org>
  6. */
  7. #include <linux/init.h>
  8. #include <linux/io.h>
  9. #include <linux/ioport.h>
  10. #include <linux/leds.h>
  11. #include <linux/platform_device.h>
  12. #include <linux/spinlock.h>
  13. #include <linux/types.h>
  14. #include <linux/export.h>
  15. #define LED_WEB 0x04
  16. #define LED_POWER_OFF 0x08
  17. static void __iomem *led_port;
  18. static u8 led_value;
  19. static DEFINE_SPINLOCK(led_value_lock);
  20. static void raq_web_led_set(struct led_classdev *led_cdev,
  21. enum led_brightness brightness)
  22. {
  23. unsigned long flags;
  24. spin_lock_irqsave(&led_value_lock, flags);
  25. if (brightness)
  26. led_value |= LED_WEB;
  27. else
  28. led_value &= ~LED_WEB;
  29. writeb(led_value, led_port);
  30. spin_unlock_irqrestore(&led_value_lock, flags);
  31. }
  32. static struct led_classdev raq_web_led = {
  33. .name = "raq::web",
  34. .brightness_set = raq_web_led_set,
  35. };
  36. static void raq_power_off_led_set(struct led_classdev *led_cdev,
  37. enum led_brightness brightness)
  38. {
  39. unsigned long flags;
  40. spin_lock_irqsave(&led_value_lock, flags);
  41. if (brightness)
  42. led_value |= LED_POWER_OFF;
  43. else
  44. led_value &= ~LED_POWER_OFF;
  45. writeb(led_value, led_port);
  46. spin_unlock_irqrestore(&led_value_lock, flags);
  47. }
  48. static struct led_classdev raq_power_off_led = {
  49. .name = "raq::power-off",
  50. .brightness_set = raq_power_off_led_set,
  51. .default_trigger = "power-off",
  52. };
  53. static int cobalt_raq_led_probe(struct platform_device *pdev)
  54. {
  55. struct resource *res;
  56. int retval;
  57. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  58. if (!res)
  59. return -EBUSY;
  60. led_port = devm_ioremap(&pdev->dev, res->start, resource_size(res));
  61. if (!led_port)
  62. return -ENOMEM;
  63. retval = led_classdev_register(&pdev->dev, &raq_power_off_led);
  64. if (retval)
  65. goto err_null;
  66. retval = led_classdev_register(&pdev->dev, &raq_web_led);
  67. if (retval)
  68. goto err_unregister;
  69. return 0;
  70. err_unregister:
  71. led_classdev_unregister(&raq_power_off_led);
  72. err_null:
  73. led_port = NULL;
  74. return retval;
  75. }
  76. static struct platform_driver cobalt_raq_led_driver = {
  77. .probe = cobalt_raq_led_probe,
  78. .driver = {
  79. .name = "cobalt-raq-leds",
  80. },
  81. };
  82. builtin_platform_driver(cobalt_raq_led_driver);