leds-adp5520.c 4.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * LEDs driver for Analog Devices ADP5520/ADP5501 MFD PMICs
  4. *
  5. * Copyright 2009 Analog Devices Inc.
  6. *
  7. * Loosely derived from leds-da903x:
  8. * Copyright (C) 2008 Compulab, Ltd.
  9. * Mike Rapoport <mike@compulab.co.il>
  10. *
  11. * Copyright (C) 2006-2008 Marvell International Ltd.
  12. * Eric Miao <eric.miao@marvell.com>
  13. */
  14. #include <linux/module.h>
  15. #include <linux/kernel.h>
  16. #include <linux/platform_device.h>
  17. #include <linux/leds.h>
  18. #include <linux/mfd/adp5520.h>
  19. #include <linux/slab.h>
  20. struct adp5520_led {
  21. struct led_classdev cdev;
  22. struct device *master;
  23. int id;
  24. int flags;
  25. };
  26. static int adp5520_led_set(struct led_classdev *led_cdev,
  27. enum led_brightness value)
  28. {
  29. struct adp5520_led *led;
  30. led = container_of(led_cdev, struct adp5520_led, cdev);
  31. return adp5520_write(led->master, ADP5520_LED1_CURRENT + led->id - 1,
  32. value >> 2);
  33. }
  34. static int adp5520_led_setup(struct adp5520_led *led)
  35. {
  36. struct device *dev = led->master;
  37. int flags = led->flags;
  38. int ret = 0;
  39. switch (led->id) {
  40. case FLAG_ID_ADP5520_LED1_ADP5501_LED0:
  41. ret |= adp5520_set_bits(dev, ADP5520_LED_TIME,
  42. (flags >> ADP5520_FLAG_OFFT_SHIFT) &
  43. ADP5520_FLAG_OFFT_MASK);
  44. ret |= adp5520_set_bits(dev, ADP5520_LED_CONTROL,
  45. ADP5520_LED1_EN);
  46. break;
  47. case FLAG_ID_ADP5520_LED2_ADP5501_LED1:
  48. ret |= adp5520_set_bits(dev, ADP5520_LED_TIME,
  49. ((flags >> ADP5520_FLAG_OFFT_SHIFT) &
  50. ADP5520_FLAG_OFFT_MASK) << 2);
  51. ret |= adp5520_clr_bits(dev, ADP5520_LED_CONTROL,
  52. ADP5520_R3_MODE);
  53. ret |= adp5520_set_bits(dev, ADP5520_LED_CONTROL,
  54. ADP5520_LED2_EN);
  55. break;
  56. case FLAG_ID_ADP5520_LED3_ADP5501_LED2:
  57. ret |= adp5520_set_bits(dev, ADP5520_LED_TIME,
  58. ((flags >> ADP5520_FLAG_OFFT_SHIFT) &
  59. ADP5520_FLAG_OFFT_MASK) << 4);
  60. ret |= adp5520_clr_bits(dev, ADP5520_LED_CONTROL,
  61. ADP5520_C3_MODE);
  62. ret |= adp5520_set_bits(dev, ADP5520_LED_CONTROL,
  63. ADP5520_LED3_EN);
  64. break;
  65. }
  66. return ret;
  67. }
  68. static int adp5520_led_prepare(struct platform_device *pdev)
  69. {
  70. struct adp5520_leds_platform_data *pdata = dev_get_platdata(&pdev->dev);
  71. struct device *dev = pdev->dev.parent;
  72. int ret = 0;
  73. ret |= adp5520_write(dev, ADP5520_LED1_CURRENT, 0);
  74. ret |= adp5520_write(dev, ADP5520_LED2_CURRENT, 0);
  75. ret |= adp5520_write(dev, ADP5520_LED3_CURRENT, 0);
  76. ret |= adp5520_write(dev, ADP5520_LED_TIME, pdata->led_on_time << 6);
  77. ret |= adp5520_write(dev, ADP5520_LED_FADE, FADE_VAL(pdata->fade_in,
  78. pdata->fade_out));
  79. return ret;
  80. }
  81. static int adp5520_led_probe(struct platform_device *pdev)
  82. {
  83. struct adp5520_leds_platform_data *pdata = dev_get_platdata(&pdev->dev);
  84. struct adp5520_led *led, *led_dat;
  85. struct led_info *cur_led;
  86. int ret, i;
  87. if (pdata == NULL) {
  88. dev_err(&pdev->dev, "missing platform data\n");
  89. return -ENODEV;
  90. }
  91. if (pdata->num_leds > ADP5520_01_MAXLEDS) {
  92. dev_err(&pdev->dev, "can't handle more than %d LEDS\n",
  93. ADP5520_01_MAXLEDS);
  94. return -EFAULT;
  95. }
  96. led = devm_kcalloc(&pdev->dev, pdata->num_leds, sizeof(*led),
  97. GFP_KERNEL);
  98. if (!led)
  99. return -ENOMEM;
  100. ret = adp5520_led_prepare(pdev);
  101. if (ret) {
  102. dev_err(&pdev->dev, "failed to write\n");
  103. return ret;
  104. }
  105. for (i = 0; i < pdata->num_leds; ++i) {
  106. cur_led = &pdata->leds[i];
  107. led_dat = &led[i];
  108. led_dat->cdev.name = cur_led->name;
  109. led_dat->cdev.default_trigger = cur_led->default_trigger;
  110. led_dat->cdev.brightness_set_blocking = adp5520_led_set;
  111. led_dat->cdev.brightness = LED_OFF;
  112. if (cur_led->flags & ADP5520_FLAG_LED_MASK)
  113. led_dat->flags = cur_led->flags;
  114. else
  115. led_dat->flags = i + 1;
  116. led_dat->id = led_dat->flags & ADP5520_FLAG_LED_MASK;
  117. led_dat->master = pdev->dev.parent;
  118. ret = led_classdev_register(led_dat->master, &led_dat->cdev);
  119. if (ret) {
  120. dev_err(&pdev->dev, "failed to register LED %d\n",
  121. led_dat->id);
  122. goto err;
  123. }
  124. ret = adp5520_led_setup(led_dat);
  125. if (ret) {
  126. dev_err(&pdev->dev, "failed to write\n");
  127. i++;
  128. goto err;
  129. }
  130. }
  131. platform_set_drvdata(pdev, led);
  132. return 0;
  133. err:
  134. if (i > 0) {
  135. for (i = i - 1; i >= 0; i--)
  136. led_classdev_unregister(&led[i].cdev);
  137. }
  138. return ret;
  139. }
  140. static int adp5520_led_remove(struct platform_device *pdev)
  141. {
  142. struct adp5520_leds_platform_data *pdata = dev_get_platdata(&pdev->dev);
  143. struct adp5520_led *led;
  144. int i;
  145. led = platform_get_drvdata(pdev);
  146. adp5520_clr_bits(led->master, ADP5520_LED_CONTROL,
  147. ADP5520_LED1_EN | ADP5520_LED2_EN | ADP5520_LED3_EN);
  148. for (i = 0; i < pdata->num_leds; i++) {
  149. led_classdev_unregister(&led[i].cdev);
  150. }
  151. return 0;
  152. }
  153. static struct platform_driver adp5520_led_driver = {
  154. .driver = {
  155. .name = "adp5520-led",
  156. },
  157. .probe = adp5520_led_probe,
  158. .remove = adp5520_led_remove,
  159. };
  160. module_platform_driver(adp5520_led_driver);
  161. MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
  162. MODULE_DESCRIPTION("LEDS ADP5520(01) Driver");
  163. MODULE_LICENSE("GPL");
  164. MODULE_ALIAS("platform:adp5520-led");