diff --git a/drivers/leds/Android.mk b/drivers/leds/Android.mk new file mode 100755 index 000000000000..131f1cc6dac1 --- /dev/null +++ b/drivers/leds/Android.mk @@ -0,0 +1,8 @@ +DLKM_DIR := motorola/kernel/modules +LOCAL_PATH := $(call my-dir) + +include $(CLEAR_VARS) +LOCAL_MODULE := leds-indicator-pwm.ko +LOCAL_MODULE_TAGS := optional +LOCAL_MODULE_PATH := $(KERNEL_MODULES_OUT) +include $(DLKM_DIR)/AndroidKernelModule.mk diff --git a/drivers/leds/Kbuild b/drivers/leds/Kbuild new file mode 100755 index 000000000000..eb1a7d0ae20c --- /dev/null +++ b/drivers/leds/Kbuild @@ -0,0 +1,6 @@ +# add -Wall to try to catch everything we can. +EXTRA_CFLAGS += -Wall +EXTRA_CFLAGS += -I$(TOP)/motorola/kernel/modules/include + + +obj-m += leds-indicator-pwm.o diff --git a/drivers/leds/leds-indicator-pwm.c b/drivers/leds/leds-indicator-pwm.c new file mode 100644 index 000000000000..bfa2030a4f81 --- /dev/null +++ b/drivers/leds/leds-indicator-pwm.c @@ -0,0 +1,512 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Copyright (c) 2018-2019, 2021, The Linux Foundation. All rights reserved. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define TRILED_NUM_MAX 3 + +#define PWM_PERIOD_DEFAULT_NS 1000000 + +struct pwm_setting { + u64 pre_period_ns; + u64 period_ns; + u64 duty_ns; +}; + +struct led_setting { + u64 on_ms; + u64 off_ms; + enum led_brightness brightness; + bool blink; + bool breath; +}; + +struct qpnp_led_dev { + struct led_classdev cdev; + struct pwm_device *pwm_dev; + struct pwm_setting pwm_setting; + struct led_setting led_setting; + struct indicator_led_chip *chip; + struct mutex lock; + const char *label; + const char *default_trigger; + u8 id; + bool blinking; + bool breathing; +}; + +struct indicator_led_chip { + struct device *dev; + struct qpnp_led_dev *leds; + struct nvmem_device *pbs_nvmem; + struct mutex bus_lock; + int num_leds; + u16 reg_base; + u8 subtype; + u8 bitmap; + struct pinctrl *pinctrl; + struct pinctrl_state *pin_sta_default; +}; + + +static int __indicator_led_config_pwm(struct qpnp_led_dev *led, + struct pwm_setting *pwm) +{ + struct pwm_state pstate; + int rc; + + pwm_get_state(led->pwm_dev, &pstate); + pstate.enabled = !!(pwm->duty_ns != 0); + pstate.period = pwm->period_ns; + pstate.duty_cycle = pwm->duty_ns; + pstate.output_type = led->led_setting.breath ? + PWM_OUTPUT_MODULATED : PWM_OUTPUT_FIXED; + + rc = pwm_apply_state(led->pwm_dev, &pstate); + + if (rc < 0) + dev_err(led->chip->dev, "Apply PWM state for %s led failed, rc=%d\n", + led->cdev.name, rc); + + return rc; +} + +static int __indicator_led_set(struct qpnp_led_dev *led) +{ + int rc = 0; + + rc = __indicator_led_config_pwm(led, &led->pwm_setting); + if (rc < 0) { + dev_err(led->chip->dev, "Configure PWM for %s led failed, rc=%d\n", + led->cdev.name, rc); + return rc; + } + + return rc; +} + +static int indicator_led_set(struct qpnp_led_dev *led) +{ + u64 on_ms, off_ms, period_ns, duty_ns; + enum led_brightness brightness = led->led_setting.brightness; + int rc = 0; + + if (led->led_setting.blink) { + on_ms = led->led_setting.on_ms; + off_ms = led->led_setting.off_ms; + + duty_ns = on_ms * NSEC_PER_MSEC; + period_ns = (on_ms + off_ms) * NSEC_PER_MSEC; + + if (period_ns < duty_ns && duty_ns != 0) + period_ns = duty_ns + 1; + } else { + /* Use initial period if no blinking is required */ + period_ns = led->pwm_setting.pre_period_ns; + + if (brightness == LED_OFF) + duty_ns = 0; + + duty_ns = period_ns * brightness; + do_div(duty_ns, LED_FULL); + + if (period_ns < duty_ns && duty_ns != 0) + period_ns = duty_ns + 1; + } + dev_dbg(led->chip->dev, "PWM settings for %s led: period = %lluns, duty = %lluns\n", + led->cdev.name, period_ns, duty_ns); + + led->pwm_setting.duty_ns = duty_ns; + led->pwm_setting.period_ns = period_ns; + + rc = __indicator_led_set(led); + if (rc < 0) { + dev_err(led->chip->dev, "__indicator_led_set %s failed, rc=%d\n", + led->cdev.name, rc); + return rc; + } + + if (led->led_setting.blink) { + led->cdev.brightness = LED_FULL; + led->blinking = true; + led->breathing = false; + } else if (led->led_setting.breath) { + led->cdev.brightness = LED_FULL; + led->blinking = false; + led->breathing = true; + } else { + led->cdev.brightness = led->led_setting.brightness; + led->blinking = false; + led->breathing = false; + } + + return rc; +} + +static int indicator_led_set_brightness(struct led_classdev *led_cdev, + enum led_brightness brightness) +{ + struct qpnp_led_dev *led = + container_of(led_cdev, struct qpnp_led_dev, cdev); + int rc = 0; + + mutex_lock(&led->lock); + if (brightness > LED_FULL) + brightness = LED_FULL; + + if (brightness == led->led_setting.brightness && + !led->blinking && !led->breathing) { + mutex_unlock(&led->lock); + return 0; + } + + led->led_setting.brightness = brightness; + if (!!brightness) + led->led_setting.off_ms = 0; + else + led->led_setting.on_ms = 0; + led->led_setting.blink = false; + led->led_setting.breath = false; + + rc = indicator_led_set(led); + if (rc) + dev_err(led->chip->dev, "Set led failed for %s, rc=%d\n", + led->label, rc); + + mutex_unlock(&led->lock); + + return rc; +} + +static enum led_brightness indicator_led_get_brightness( + struct led_classdev *led_cdev) +{ + return led_cdev->brightness; +} + +static int indicator_led_set_blink(struct led_classdev *led_cdev, + unsigned long *on_ms, unsigned long *off_ms) +{ + struct qpnp_led_dev *led = + container_of(led_cdev, struct qpnp_led_dev, cdev); + int rc = 0; + + mutex_lock(&led->lock); + if (led->blinking && *on_ms == led->led_setting.on_ms && + *off_ms == led->led_setting.off_ms) { + dev_dbg(led_cdev->dev, "Ignore, on/off setting is not changed: on %lums, off %lums\n", + *on_ms, *off_ms); + mutex_unlock(&led->lock); + return 0; + } + + if (*on_ms == 0) { + led->led_setting.blink = false; + led->led_setting.breath = false; + led->led_setting.brightness = LED_OFF; + } else if (*off_ms == 0) { + led->led_setting.blink = false; + led->led_setting.breath = false; + led->led_setting.brightness = led->cdev.brightness; + } else { + led->led_setting.on_ms = *on_ms; + led->led_setting.off_ms = *off_ms; + led->led_setting.blink = true; + led->led_setting.breath = false; + } + + rc = indicator_led_set(led); + if (rc) + dev_err(led->chip->dev, "Set led failed for %s, rc=%d\n", + led->label, rc); + + mutex_unlock(&led->lock); + return rc; +} + +static ssize_t breath_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + struct led_classdev *led_cdev = dev_get_drvdata(dev); + struct qpnp_led_dev *led = + container_of(led_cdev, struct qpnp_led_dev, cdev); + + return scnprintf(buf, PAGE_SIZE, "%d\n", led->led_setting.breath); +} + +static ssize_t breath_store(struct device *dev, struct device_attribute *attr, + const char *buf, size_t count) +{ + int rc; + bool breath; + struct led_classdev *led_cdev = dev_get_drvdata(dev); + struct qpnp_led_dev *led = + container_of(led_cdev, struct qpnp_led_dev, cdev); + + rc = kstrtobool(buf, &breath); + if (rc < 0) + return rc; + + cancel_work_sync(&led_cdev->set_brightness_work); + + mutex_lock(&led->lock); + if (led->breathing == breath) + goto unlock; + + led->led_setting.blink = false; + led->led_setting.breath = breath; + led->led_setting.brightness = breath ? LED_FULL : LED_OFF; + rc = indicator_led_set(led); + if (rc < 0) + dev_err(led->chip->dev, "Set led failed for %s, rc=%d\n", + led->label, rc); + +unlock: + mutex_unlock(&led->lock); + return (rc < 0) ? rc : count; +} + +static DEVICE_ATTR_RW(breath); +static const struct attribute *breath_attrs[] = { + &dev_attr_breath.attr, + NULL +}; + +static int indicator_led_register(struct indicator_led_chip *chip) +{ + struct qpnp_led_dev *led; + int rc, i, j; + + + for (i = 0; i < chip->num_leds; i++) { + led = &chip->leds[i]; + mutex_init(&led->lock); + led->cdev.name = led->label; + led->cdev.max_brightness = LED_FULL; + led->cdev.brightness_set_blocking = indicator_led_set_brightness; + led->cdev.brightness_get = indicator_led_get_brightness; + led->cdev.blink_set = indicator_led_set_blink; + led->cdev.default_trigger = led->default_trigger; + led->cdev.brightness = LED_OFF; + + rc = devm_led_classdev_register(chip->dev, &led->cdev); + if (rc < 0) { + dev_err(chip->dev, "%s led class device registering failed, rc=%d\n", + led->label, rc); + goto err_out; + } + + if (pwm_get_output_type_supported(led->pwm_dev) + & PWM_OUTPUT_MODULATED) { + rc = sysfs_create_files(&led->cdev.dev->kobj, + breath_attrs); + if (rc < 0) { + dev_err(chip->dev, "Create breath file for %s led failed, rc=%d\n", + led->label, rc); + goto err_out; + } + } + } + + return 0; + +err_out: + for (j = 0; j <= i; j++) { + if (j < i) + sysfs_remove_files(&chip->leds[j].cdev.dev->kobj, + breath_attrs); + mutex_destroy(&chip->leds[j].lock); + } + return rc; +} + +static int indicator_led_parse_dt(struct indicator_led_chip *chip) +{ + struct device_node *node = chip->dev->of_node, *child_node; + struct qpnp_led_dev *led; + struct pwm_args pargs; + int rc = 0, id, i = 0; + + chip->num_leds = of_get_available_child_count(node); + if (chip->num_leds == 0) { + dev_err(chip->dev, "No led child node defined\n"); + return -ENODEV; + } + + if (chip->num_leds > TRILED_NUM_MAX) { + dev_err(chip->dev, "can't support %d leds(max %d)\n", + chip->num_leds, TRILED_NUM_MAX); + return -EINVAL; + } + + chip->leds = devm_kcalloc(chip->dev, chip->num_leds, + sizeof(struct qpnp_led_dev), GFP_KERNEL); + if (!chip->leds) + return -ENOMEM; + + for_each_available_child_of_node(node, child_node) { + rc = of_property_read_u32(child_node, "led-sources", &id); + if (rc) { + dev_err(chip->dev, "Get led-sources failed, rc=%d\n", + rc); + return rc; + } + + if (id >= TRILED_NUM_MAX) { + dev_err(chip->dev, "only support 0~%d current source\n", + TRILED_NUM_MAX - 1); + return -EINVAL; + } + + led = &chip->leds[i++]; + led->chip = chip; + led->id = id; + led->label = + of_get_property(child_node, "label", NULL) ? : + child_node->name; + + led->pwm_dev = + devm_of_pwm_get(chip->dev, child_node, NULL); + if (IS_ERR(led->pwm_dev)) { + rc = PTR_ERR(led->pwm_dev); + if (rc != -EPROBE_DEFER) + dev_err(chip->dev, "Get pwm device for %s led failed, rc=%d\n", + led->label, rc); + return rc; + } + + pwm_get_args(led->pwm_dev, &pargs); + if (pargs.period == 0) + led->pwm_setting.pre_period_ns = PWM_PERIOD_DEFAULT_NS; + else + led->pwm_setting.pre_period_ns = pargs.period; + + led->default_trigger = of_get_property(child_node, + "linux,default-trigger", NULL); + } + + return rc; +} +static int indicator_led_pinctrl_init(struct indicator_led_chip *chip) +{ + int rc = 0; + + chip->pinctrl = devm_pinctrl_get(chip->dev); + if (IS_ERR_OR_NULL(chip->pinctrl)) { + dev_err(chip->dev, "Failed to get pinctrl handler"); + chip->pinctrl = NULL; + return -EINVAL; + } + chip->pin_sta_default = pinctrl_lookup_state(chip->pinctrl, PINCTRL_STATE_DEFAULT); + if (IS_ERR_OR_NULL(chip->pin_sta_default)) { + rc = PTR_ERR(chip->pin_sta_default); + dev_err(chip->dev, "Failed to get pinctrl state:%s, r:%d", + PINCTRL_STATE_DEFAULT, rc); + chip->pin_sta_default = NULL; + goto exit_pinctrl_put; + } + rc = pinctrl_select_state(chip->pinctrl, chip->pin_sta_default); + if (rc < 0) { + dev_err(chip->dev, "Failed to select default pinstate, rc:%d", rc); + } + +exit_pinctrl_put: + devm_pinctrl_put(chip->pinctrl); + chip->pinctrl = NULL; + + return rc; +} + + +static int indicator_led_probe(struct platform_device *pdev) +{ + struct indicator_led_chip *chip; + int rc = 0; + + chip = devm_kzalloc(&pdev->dev, sizeof(*chip), GFP_KERNEL); + if (!chip) + return -ENOMEM; + + chip->dev = &pdev->dev; + + rc = indicator_led_parse_dt(chip); + if (rc < 0) { + if (rc != -EPROBE_DEFER) + dev_err(chip->dev, "Devicetree properties parsing failed, rc=%d\n", + rc); + return rc; + } + + rc = indicator_led_pinctrl_init(chip); + if(rc < 0) { + dev_err(chip->dev, "Indicator led pinctrl init failed, rc=%d\n", rc); + return rc; + } + + mutex_init(&chip->bus_lock); + + dev_set_drvdata(chip->dev, chip); + + rc = indicator_led_register(chip); + if (rc < 0) { + dev_err(chip->dev, "Registering LED class devices failed, rc=%d\n", + rc); + goto destroy; + } + + dev_err(chip->dev, "%s has been finished\n", __func__); + return 0; +destroy: + mutex_destroy(&chip->bus_lock); + dev_set_drvdata(chip->dev, NULL); + + return rc; +} + +static int indicator_led_remove(struct platform_device *pdev) +{ + int i; + struct indicator_led_chip *chip = dev_get_drvdata(&pdev->dev); + + mutex_destroy(&chip->bus_lock); + for (i = 0; i < chip->num_leds; i++) { + sysfs_remove_files(&chip->leds[i].cdev.dev->kobj, breath_attrs); + mutex_destroy(&chip->leds[i].lock); + } + dev_set_drvdata(chip->dev, NULL); + return 0; +} + +static const struct of_device_id indicator_led_of_match[] = { + { .compatible = "qcom,indicator-pwm-led",}, + { }, +}; + +static struct platform_driver indicator_led_driver = { + .driver = { + .name = "qcom,indicator-pwm-led", + .of_match_table = indicator_led_of_match, + }, + .probe = indicator_led_probe, + .remove = indicator_led_remove, +}; +module_platform_driver(indicator_led_driver); + +MODULE_DESCRIPTION("PWM LED driver"); +MODULE_LICENSE("GPL v2"); +MODULE_SOFTDEP("pre: pwm-qti-lpg");