^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * LED Driver for Dialog DA9052 PMICs.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright(c) 2012 Dialog Semiconductor Ltd.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * Author: David Dajun Chen <dchen@diasemi.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/leds.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/mfd/da9052/reg.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/mfd/da9052/da9052.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/mfd/da9052/pdata.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #define DA9052_OPENDRAIN_OUTPUT 2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #define DA9052_SET_HIGH_LVL_OUTPUT (1 << 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #define DA9052_MASK_UPPER_NIBBLE 0xF0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #define DA9052_MASK_LOWER_NIBBLE 0x0F
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #define DA9052_NIBBLE_SHIFT 4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #define DA9052_MAX_BRIGHTNESS 0x5f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) struct da9052_led {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) struct led_classdev cdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) struct da9052 *da9052;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) unsigned char led_index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) unsigned char id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) static unsigned char led_reg[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) DA9052_LED_CONT_4_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) DA9052_LED_CONT_5_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) static int da9052_set_led_brightness(struct da9052_led *led,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) enum led_brightness brightness)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) u8 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) val = (brightness & 0x7f) | DA9052_LED_CONT_DIM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) error = da9052_reg_write(led->da9052, led_reg[led->led_index], val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) if (error < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) dev_err(led->da9052->dev, "Failed to set led brightness, %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) static int da9052_led_set(struct led_classdev *led_cdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) enum led_brightness value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) struct da9052_led *led =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) container_of(led_cdev, struct da9052_led, cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) return da9052_set_led_brightness(led, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) static int da9052_configure_leds(struct da9052 *da9052)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) unsigned char register_value = DA9052_OPENDRAIN_OUTPUT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) | DA9052_SET_HIGH_LVL_OUTPUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) error = da9052_reg_update(da9052, DA9052_GPIO_14_15_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) DA9052_MASK_LOWER_NIBBLE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) register_value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) if (error < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) dev_err(da9052->dev, "Failed to write GPIO 14-15 reg, %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) error = da9052_reg_update(da9052, DA9052_GPIO_14_15_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) DA9052_MASK_UPPER_NIBBLE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) register_value << DA9052_NIBBLE_SHIFT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) if (error < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) dev_err(da9052->dev, "Failed to write GPIO 14-15 reg, %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) static int da9052_led_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) struct da9052_pdata *pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) struct da9052 *da9052;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) struct led_platform_data *pled;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) struct da9052_led *led = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) int error = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) da9052 = dev_get_drvdata(pdev->dev.parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) pdata = dev_get_platdata(da9052->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) if (pdata == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) dev_err(&pdev->dev, "No platform data\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) pled = pdata->pled;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) if (pled == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) dev_err(&pdev->dev, "No platform data for LED\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) led = devm_kcalloc(&pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) pled->num_leds, sizeof(struct da9052_led),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) if (!led) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) error = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) for (i = 0; i < pled->num_leds; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) led[i].cdev.name = pled->leds[i].name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) led[i].cdev.brightness_set_blocking = da9052_led_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) led[i].cdev.brightness = LED_OFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) led[i].cdev.max_brightness = DA9052_MAX_BRIGHTNESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) led[i].led_index = pled->leds[i].flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) led[i].da9052 = dev_get_drvdata(pdev->dev.parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) error = led_classdev_register(pdev->dev.parent, &led[i].cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) dev_err(&pdev->dev, "Failed to register led %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) led[i].led_index);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) goto err_register;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) error = da9052_set_led_brightness(&led[i],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) led[i].cdev.brightness);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) dev_err(&pdev->dev, "Unable to init led %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) led[i].led_index);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) error = da9052_configure_leds(led->da9052);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) dev_err(&pdev->dev, "Failed to configure GPIO LED%d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) goto err_register;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) platform_set_drvdata(pdev, led);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) err_register:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) for (i = i - 1; i >= 0; i--)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) led_classdev_unregister(&led[i].cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) static int da9052_led_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) struct da9052_led *led = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) struct da9052_pdata *pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) struct da9052 *da9052;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) struct led_platform_data *pled;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) da9052 = dev_get_drvdata(pdev->dev.parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) pdata = dev_get_platdata(da9052->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) pled = pdata->pled;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) for (i = 0; i < pled->num_leds; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) da9052_set_led_brightness(&led[i], LED_OFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) led_classdev_unregister(&led[i].cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) static struct platform_driver da9052_led_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) .name = "da9052-leds",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) .probe = da9052_led_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) .remove = da9052_led_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) module_platform_driver(da9052_led_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) MODULE_AUTHOR("Dialog Semiconductor Ltd <dchen@diasemi.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) MODULE_DESCRIPTION("LED driver for Dialog DA9052 PMIC");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) MODULE_LICENSE("GPL");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags