leds-s3c24xx.c 2.0 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /* drivers/leds/leds-s3c24xx.c
  3. *
  4. * (c) 2006 Simtec Electronics
  5. * http://armlinux.simtec.co.uk/
  6. * Ben Dooks <ben@simtec.co.uk>
  7. *
  8. * S3C24XX - LEDs GPIO driver
  9. */
  10. #include <linux/kernel.h>
  11. #include <linux/platform_device.h>
  12. #include <linux/leds.h>
  13. #include <linux/gpio/consumer.h>
  14. #include <linux/slab.h>
  15. #include <linux/module.h>
  16. #include <linux/platform_data/leds-s3c24xx.h>
  17. /* our context */
  18. struct s3c24xx_gpio_led {
  19. struct led_classdev cdev;
  20. struct s3c24xx_led_platdata *pdata;
  21. struct gpio_desc *gpiod;
  22. };
  23. static inline struct s3c24xx_gpio_led *to_gpio(struct led_classdev *led_cdev)
  24. {
  25. return container_of(led_cdev, struct s3c24xx_gpio_led, cdev);
  26. }
  27. static void s3c24xx_led_set(struct led_classdev *led_cdev,
  28. enum led_brightness value)
  29. {
  30. struct s3c24xx_gpio_led *led = to_gpio(led_cdev);
  31. gpiod_set_value(led->gpiod, !!value);
  32. }
  33. static int s3c24xx_led_probe(struct platform_device *dev)
  34. {
  35. struct s3c24xx_led_platdata *pdata = dev_get_platdata(&dev->dev);
  36. struct s3c24xx_gpio_led *led;
  37. int ret;
  38. led = devm_kzalloc(&dev->dev, sizeof(struct s3c24xx_gpio_led),
  39. GFP_KERNEL);
  40. if (!led)
  41. return -ENOMEM;
  42. led->cdev.brightness_set = s3c24xx_led_set;
  43. led->cdev.default_trigger = pdata->def_trigger;
  44. led->cdev.name = pdata->name;
  45. led->cdev.flags |= LED_CORE_SUSPENDRESUME;
  46. led->pdata = pdata;
  47. /* Default to off */
  48. led->gpiod = devm_gpiod_get(&dev->dev, NULL, GPIOD_OUT_LOW);
  49. if (IS_ERR(led->gpiod))
  50. return PTR_ERR(led->gpiod);
  51. /* register our new led device */
  52. ret = devm_led_classdev_register(&dev->dev, &led->cdev);
  53. if (ret < 0)
  54. dev_err(&dev->dev, "led_classdev_register failed\n");
  55. return ret;
  56. }
  57. static struct platform_driver s3c24xx_led_driver = {
  58. .probe = s3c24xx_led_probe,
  59. .driver = {
  60. .name = "s3c24xx_led",
  61. },
  62. };
  63. module_platform_driver(s3c24xx_led_driver);
  64. MODULE_AUTHOR("Ben Dooks <ben@simtec.co.uk>");
  65. MODULE_DESCRIPTION("S3C24XX LED driver");
  66. MODULE_LICENSE("GPL");
  67. MODULE_ALIAS("platform:s3c24xx_led");