mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-05 19:31:57 -04:00
modules: add leds-indicator-pwm.c driver
add leds-indicator-pwm.c driver to control pm6375 gpio8 for charging leds Change-Id: Ie14136d11016185eb4a0eb3e816f6e6f5a742f1a Signed-off-by: mahj8 <mahj8@lenovo.com> Reviewed-on: https://gerrit.mot.com/2007937 SME-Granted: SME Approvals Granted SLTApproved: Slta Waiver Tested-by: Jira Key Reviewed-by: Lu Chai <chailu1@motorola.com> Reviewed-by: Huosheng Liao <liaohs@motorola.com> Submit-Approved: Jira Key
This commit is contained in:
mahj8
Haijian Ma
parent
76e4591f92
commit
58898c9e98
3 changed files with 526 additions and 0 deletions
8
drivers/leds/Android.mk
Executable file
8
drivers/leds/Android.mk
Executable file
|
|
@ -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
|
||||
6
drivers/leds/Kbuild
Executable file
6
drivers/leds/Kbuild
Executable file
|
|
@ -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
|
||||
512
drivers/leds/leds-indicator-pwm.c
Normal file
512
drivers/leds/leds-indicator-pwm.c
Normal file
|
|
@ -0,0 +1,512 @@
|
|||
// SPDX-License-Identifier: GPL-2.0-only
|
||||
/*
|
||||
* Copyright (c) 2018-2019, 2021, The Linux Foundation. All rights reserved.
|
||||
*/
|
||||
|
||||
#include <linux/bitops.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/leds.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/mutex.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/of_address.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/pwm.h>
|
||||
#include <linux/types.h>
|
||||
#include <linux/pinctrl/consumer.h>
|
||||
|
||||
#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");
|
||||
Loading…
Reference in a new issue