drivers/leds/leds-da9052.c

0001 // SPDX-License-Identifier: GPL-2.0-or-later
0002 /*
0003  * LED Driver for Dialog DA9052 PMICs.
0004  *
0005  * Copyright(c) 2012 Dialog Semiconductor Ltd.
0006  *
0007  * Author: David Dajun Chen <dchen@diasemi.com>
0008  */
0009
0010 #include <linux/module.h>
0011 #include <linux/kernel.h>
0012 #include <linux/platform_device.h>
0013 #include <linux/leds.h>
0014 #include <linux/slab.h>
0015
0016 #include <linux/mfd/da9052/reg.h>
0017 #include <linux/mfd/da9052/da9052.h>
0018 #include <linux/mfd/da9052/pdata.h>
0019
0020 #define DA9052_OPENDRAIN_OUTPUT 2
0021 #define DA9052_SET_HIGH_LVL_OUTPUT  (1 << 3)
0022 #define DA9052_MASK_UPPER_NIBBLE    0xF0
0023 #define DA9052_MASK_LOWER_NIBBLE    0x0F
0024 #define DA9052_NIBBLE_SHIFT     4
0025 #define DA9052_MAX_BRIGHTNESS       0x5f
0026
0027 struct da9052_led {
0028     struct led_classdev cdev;
0029     struct da9052 *da9052;
0030     unsigned char led_index;
0031     unsigned char id;
0032 };
0033
0034 static unsigned char led_reg[] = {
0035     DA9052_LED_CONT_4_REG,
0036     DA9052_LED_CONT_5_REG,
0037 };
0038
0039 static int da9052_set_led_brightness(struct da9052_led *led,
0040                      enum led_brightness brightness)
0041 {
0042     u8 val;
0043     int error;
0044
0045     val = (brightness & 0x7f) | DA9052_LED_CONT_DIM;
0046
0047     error = da9052_reg_write(led->da9052, led_reg[led->led_index], val);
0048     if (error < 0)
0049         dev_err(led->da9052->dev, "Failed to set led brightness, %d\n",
0050             error);
0051     return error;
0052 }
0053
0054 static int da9052_led_set(struct led_classdev *led_cdev,
0055                enum led_brightness value)
0056 {
0057     struct da9052_led *led =
0058             container_of(led_cdev, struct da9052_led, cdev);
0059
0060     return da9052_set_led_brightness(led, value);
0061 }
0062
0063 static int da9052_configure_leds(struct da9052 *da9052)
0064 {
0065     int error;
0066     unsigned char register_value = DA9052_OPENDRAIN_OUTPUT
0067                        | DA9052_SET_HIGH_LVL_OUTPUT;
0068
0069     error = da9052_reg_update(da9052, DA9052_GPIO_14_15_REG,
0070                   DA9052_MASK_LOWER_NIBBLE,
0071                   register_value);
0072
0073     if (error < 0) {
0074         dev_err(da9052->dev, "Failed to write GPIO 14-15 reg, %d\n",
0075             error);
0076         return error;
0077     }
0078
0079     error = da9052_reg_update(da9052, DA9052_GPIO_14_15_REG,
0080                   DA9052_MASK_UPPER_NIBBLE,
0081                   register_value << DA9052_NIBBLE_SHIFT);
0082     if (error < 0)
0083         dev_err(da9052->dev, "Failed to write GPIO 14-15 reg, %d\n",
0084             error);
0085
0086     return error;
0087 }
0088
0089 static int da9052_led_probe(struct platform_device *pdev)
0090 {
0091     struct da9052_pdata *pdata;
0092     struct da9052 *da9052;
0093     struct led_platform_data *pled;
0094     struct da9052_led *led = NULL;
0095     int error = -ENODEV;
0096     int i;
0097
0098     da9052 = dev_get_drvdata(pdev->dev.parent);
0099     pdata = dev_get_platdata(da9052->dev);
0100     if (pdata == NULL) {
0101         dev_err(&pdev->dev, "No platform data\n");
0102         goto err;
0103     }
0104
0105     pled = pdata->pled;
0106     if (pled == NULL) {
0107         dev_err(&pdev->dev, "No platform data for LED\n");
0108         goto err;
0109     }
0110
0111     led = devm_kcalloc(&pdev->dev,
0112                pled->num_leds, sizeof(struct da9052_led),
0113                GFP_KERNEL);
0114     if (!led) {
0115         error = -ENOMEM;
0116         goto err;
0117     }
0118
0119     for (i = 0; i < pled->num_leds; i++) {
0120         led[i].cdev.name = pled->leds[i].name;
0121         led[i].cdev.brightness_set_blocking = da9052_led_set;
0122         led[i].cdev.brightness = LED_OFF;
0123         led[i].cdev.max_brightness = DA9052_MAX_BRIGHTNESS;
0124         led[i].led_index = pled->leds[i].flags;
0125         led[i].da9052 = dev_get_drvdata(pdev->dev.parent);
0126
0127         error = led_classdev_register(pdev->dev.parent, &led[i].cdev);
0128         if (error) {
0129             dev_err(&pdev->dev, "Failed to register led %d\n",
0130                 led[i].led_index);
0131             goto err_register;
0132         }
0133
0134         error = da9052_set_led_brightness(&led[i],
0135                           led[i].cdev.brightness);
0136         if (error) {
0137             dev_err(&pdev->dev, "Unable to init led %d\n",
0138                 led[i].led_index);
0139             continue;
0140         }
0141     }
0142     error = da9052_configure_leds(led->da9052);
0143     if (error) {
0144         dev_err(&pdev->dev, "Failed to configure GPIO LED%d\n", error);
0145         goto err_register;
0146     }
0147
0148     platform_set_drvdata(pdev, led);
0149
0150     return 0;
0151
0152 err_register:
0153     for (i = i - 1; i >= 0; i--)
0154         led_classdev_unregister(&led[i].cdev);
0155 err:
0156     return error;
0157 }
0158
0159 static int da9052_led_remove(struct platform_device *pdev)
0160 {
0161     struct da9052_led *led = platform_get_drvdata(pdev);
0162     struct da9052_pdata *pdata;
0163     struct da9052 *da9052;
0164     struct led_platform_data *pled;
0165     int i;
0166
0167     da9052 = dev_get_drvdata(pdev->dev.parent);
0168     pdata = dev_get_platdata(da9052->dev);
0169     pled = pdata->pled;
0170
0171     for (i = 0; i < pled->num_leds; i++) {
0172         da9052_set_led_brightness(&led[i], LED_OFF);
0173         led_classdev_unregister(&led[i].cdev);
0174     }
0175
0176     return 0;
0177 }
0178
0179 static struct platform_driver da9052_led_driver = {
0180     .driver     = {
0181         .name   = "da9052-leds",
0182     },
0183     .probe      = da9052_led_probe,
0184     .remove     = da9052_led_remove,
0185 };
0186
0187 module_platform_driver(da9052_led_driver);
0188
0189 MODULE_AUTHOR("Dialog Semiconductor Ltd <dchen@diasemi.com>");
0190 MODULE_DESCRIPTION("LED driver for Dialog DA9052 PMIC");
0191 MODULE_LICENSE("GPL");