leds-da903x.c 3.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * LEDs driver for Dialog Semiconductor DA9030/DA9034
  4. *
  5. * Copyright (C) 2008 Compulab, Ltd.
  6. * Mike Rapoport <mike@compulab.co.il>
  7. *
  8. * Copyright (C) 2006-2008 Marvell International Ltd.
  9. * Eric Miao <eric.miao@marvell.com>
  10. */
  11. #include <linux/module.h>
  12. #include <linux/kernel.h>
  13. #include <linux/platform_device.h>
  14. #include <linux/leds.h>
  15. #include <linux/mfd/da903x.h>
  16. #include <linux/slab.h>
  17. #define DA9030_LED1_CONTROL 0x20
  18. #define DA9030_LED2_CONTROL 0x21
  19. #define DA9030_LED3_CONTROL 0x22
  20. #define DA9030_LED4_CONTROL 0x23
  21. #define DA9030_LEDPC_CONTROL 0x24
  22. #define DA9030_MISC_CONTROL_A 0x26 /* Vibrator Control */
  23. #define DA9034_LED1_CONTROL 0x35
  24. #define DA9034_LED2_CONTROL 0x36
  25. #define DA9034_VIBRA 0x40
  26. struct da903x_led {
  27. struct led_classdev cdev;
  28. struct device *master;
  29. int id;
  30. int flags;
  31. };
  32. #define DA9030_LED_OFFSET(id) ((id) - DA9030_ID_LED_1)
  33. #define DA9034_LED_OFFSET(id) ((id) - DA9034_ID_LED_1)
  34. static int da903x_led_set(struct led_classdev *led_cdev,
  35. enum led_brightness value)
  36. {
  37. struct da903x_led *led =
  38. container_of(led_cdev, struct da903x_led, cdev);
  39. uint8_t val;
  40. int offset, ret = -EINVAL;
  41. switch (led->id) {
  42. case DA9030_ID_LED_1:
  43. case DA9030_ID_LED_2:
  44. case DA9030_ID_LED_3:
  45. case DA9030_ID_LED_4:
  46. case DA9030_ID_LED_PC:
  47. offset = DA9030_LED_OFFSET(led->id);
  48. val = led->flags & ~0x87;
  49. val |= value ? 0x80 : 0; /* EN bit */
  50. val |= (0x7 - (value >> 5)) & 0x7; /* PWM<2:0> */
  51. ret = da903x_write(led->master, DA9030_LED1_CONTROL + offset,
  52. val);
  53. break;
  54. case DA9030_ID_VIBRA:
  55. val = led->flags & ~0x80;
  56. val |= value ? 0x80 : 0; /* EN bit */
  57. ret = da903x_write(led->master, DA9030_MISC_CONTROL_A, val);
  58. break;
  59. case DA9034_ID_LED_1:
  60. case DA9034_ID_LED_2:
  61. offset = DA9034_LED_OFFSET(led->id);
  62. val = (value * 0x5f / LED_FULL) & 0x7f;
  63. val |= (led->flags & DA9034_LED_RAMP) ? 0x80 : 0;
  64. ret = da903x_write(led->master, DA9034_LED1_CONTROL + offset,
  65. val);
  66. break;
  67. case DA9034_ID_VIBRA:
  68. val = value & 0xfe;
  69. ret = da903x_write(led->master, DA9034_VIBRA, val);
  70. break;
  71. }
  72. return ret;
  73. }
  74. static int da903x_led_probe(struct platform_device *pdev)
  75. {
  76. struct led_info *pdata = dev_get_platdata(&pdev->dev);
  77. struct da903x_led *led;
  78. int id, ret;
  79. if (pdata == NULL)
  80. return 0;
  81. id = pdev->id;
  82. if (!((id >= DA9030_ID_LED_1 && id <= DA9030_ID_VIBRA) ||
  83. (id >= DA9034_ID_LED_1 && id <= DA9034_ID_VIBRA))) {
  84. dev_err(&pdev->dev, "invalid LED ID (%d) specified\n", id);
  85. return -EINVAL;
  86. }
  87. led = devm_kzalloc(&pdev->dev, sizeof(struct da903x_led), GFP_KERNEL);
  88. if (!led)
  89. return -ENOMEM;
  90. led->cdev.name = pdata->name;
  91. led->cdev.default_trigger = pdata->default_trigger;
  92. led->cdev.brightness_set_blocking = da903x_led_set;
  93. led->cdev.brightness = LED_OFF;
  94. led->id = id;
  95. led->flags = pdata->flags;
  96. led->master = pdev->dev.parent;
  97. ret = led_classdev_register(led->master, &led->cdev);
  98. if (ret) {
  99. dev_err(&pdev->dev, "failed to register LED %d\n", id);
  100. return ret;
  101. }
  102. platform_set_drvdata(pdev, led);
  103. return 0;
  104. }
  105. static int da903x_led_remove(struct platform_device *pdev)
  106. {
  107. struct da903x_led *led = platform_get_drvdata(pdev);
  108. led_classdev_unregister(&led->cdev);
  109. return 0;
  110. }
  111. static struct platform_driver da903x_led_driver = {
  112. .driver = {
  113. .name = "da903x-led",
  114. },
  115. .probe = da903x_led_probe,
  116. .remove = da903x_led_remove,
  117. };
  118. module_platform_driver(da903x_led_driver);
  119. MODULE_DESCRIPTION("LEDs driver for Dialog Semiconductor DA9030/DA9034");
  120. MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>");
  121. MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
  122. MODULE_LICENSE("GPL");
  123. MODULE_ALIAS("platform:da903x-led");