Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit fb15fdc7 authored by qctecmdr's avatar qctecmdr Committed by Gerrit - the friendly Code Review server
Browse files

Merge "leds: qcom-clk: Add clock controller based PWM driver"

parents 278f89d3 3b5d3bff
Loading
Loading
Loading
Loading
+9 −0
Original line number Diff line number Diff line
@@ -739,6 +739,15 @@ config LEDS_SC27XX_BLTC
	  This driver can also be built as a module. If so the module will be
	  called leds-sc27xx-bltc.

config LEDS_QCOM_CLK
	tristate "LED Support for cock controller based PWM drvier"
	depends on OF && PINCTRL && LEDS_CLASS
	help
	  This option enables the driver for clock driven LED.
	  This driver controls the duty cycle of clocks generated
	  by Qualcomm Technologies, Inc Chipsets.
	  It also configures the pinctrl to output the clock.

comment "LED driver for blink(1) USB RGB LED is under Special HID drivers (HID_THINGM)"

config LEDS_BLINKM
+1 −0
Original line number Diff line number Diff line
@@ -52,6 +52,7 @@ obj-$(CONFIG_LEDS_PCA955X) += leds-pca955x.o
obj-$(CONFIG_LEDS_PCA963X)		+= leds-pca963x.o
obj-$(CONFIG_LEDS_DA903X)		+= leds-da903x.o
obj-$(CONFIG_LEDS_DA9052)		+= leds-da9052.o
obj-$(CONFIG_LEDS_QCOM_CLK)		+= leds-qcom-clk.o
obj-$(CONFIG_LEDS_WM831X_STATUS)	+= leds-wm831x-status.o
obj-$(CONFIG_LEDS_WM8350)		+= leds-wm8350.o
obj-$(CONFIG_LEDS_PWM)			+= leds-pwm.o
+181 −0
Original line number Diff line number Diff line
// SPDX-License-Identifier: GPL-2.0-only
// Copyright (c) 2019-2021, The Linux Foundation. All rights reserved.

#include <linux/clk.h>
#include <linux/leds.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/platform_device.h>
#include <linux/pinctrl/consumer.h>

#define PINCTRL_ACTIVE		"active"
#define PINCTRL_SLEEP		"sleep"
#define CLK_DUTY_DEN		100

struct led_qcom_clk_priv {
	struct led_classdev cdev;
	struct clk *core;
	struct pinctrl *pinctrl;
	struct pinctrl_state *gpio_active;
	struct pinctrl_state *gpio_sleep;
	const char *name;
	int duty_cycle, max_duty;
	bool clk_enabled;
};

static int qcom_clk_led_set(struct led_classdev *led_cdev,
		       enum led_brightness brightness)
{
	struct led_qcom_clk_priv *led_priv =
		container_of(led_cdev, struct led_qcom_clk_priv, cdev);
	int rc;

	if (brightness == LED_OFF) {
		if (led_priv->clk_enabled) {
			clk_disable_unprepare(led_priv->core);
			pinctrl_select_state(led_priv->pinctrl,
					led_priv->gpio_sleep);
			led_priv->clk_enabled = false;
		}
		return 0;
	}

	if (!led_priv->clk_enabled) {
		rc = pinctrl_select_state(led_priv->pinctrl,
				led_priv->gpio_active);
		if (rc < 0) {
			dev_err(led_cdev->dev, "Failed to select pinctrl state rc=%d\n",
					rc);
			return rc;
		}

		rc = clk_prepare_enable(led_priv->core);
		if (rc < 0) {
			dev_err(led_cdev->dev, "Failed to enable clock rc=%d\n",
					rc);
			goto err_enable;
		}

		led_priv->clk_enabled = true;
	}

	/*
	 * Duty cycle will be configured based on the brightness.
	 * Complete clock period/duty cycle is 100 and
	 * brightness is the period in which signal is active.
	 */
	led_priv->duty_cycle = brightness;
	rc = clk_set_duty_cycle(led_priv->core,
			led_priv->duty_cycle, CLK_DUTY_DEN);
	if (rc < 0) {
		dev_err(led_cdev->dev, "Failed to set duty cycle rc=%d\n",
				rc);
		goto err_set_duty;
	}

	return rc;

err_set_duty:
	clk_disable_unprepare(led_priv->core);
	led_priv->clk_enabled = false;
err_enable:
	pinctrl_select_state(led_priv->pinctrl, led_priv->gpio_sleep);

	return rc;
}

static int qcom_clk_led_parse_dt(struct device *dev,
		struct led_qcom_clk_priv *led)
{
	int ret;

	led->name = of_get_property(dev->of_node, "qcom,label", NULL) ? :
				dev->of_node->name;

	ret = of_property_read_u32(dev->of_node, "qcom,max_duty",
			&led->max_duty);
	if (ret) {
		dev_err(dev, "Failed to read max_duty\n");
		return ret;
	}

	if (led->max_duty <= 0) {
		dev_err(dev, "Max duty cycle should not be <= 0\n");
		return -EINVAL;
	}

	led->core = devm_clk_get(dev, "core");
	if (IS_ERR(led->core)) {
		ret = PTR_ERR(led->core);
		if (ret != -EPROBE_DEFER)
			dev_err(dev, "Failed to get core source\n");

		return ret;
	}

	led->pinctrl = devm_pinctrl_get(dev);
	if (IS_ERR_OR_NULL(led->pinctrl)) {
		dev_err(dev, "No pinctrl config specified!\n");
		return PTR_ERR(led->pinctrl);
	}

	led->gpio_active = pinctrl_lookup_state(led->pinctrl,
				PINCTRL_ACTIVE);
	if (IS_ERR_OR_NULL(led->gpio_active)) {
		dev_err(dev, "No default config specified!\n");
		return PTR_ERR(led->gpio_active);
	}

	led->gpio_sleep = pinctrl_lookup_state(led->pinctrl,
							PINCTRL_SLEEP);
	if (IS_ERR_OR_NULL(led->gpio_sleep)) {
		dev_err(dev, "No sleep config specified!\n");
		return  PTR_ERR(led->gpio_sleep);
	}

	return 0;
}

static int led_qcom_clk_probe(struct platform_device *pdev)
{
	struct led_qcom_clk_priv *priv;
	int ret;

	priv = devm_kzalloc(&pdev->dev, sizeof(struct led_qcom_clk_priv),
			    GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

	ret = qcom_clk_led_parse_dt(&pdev->dev, priv);
	if (ret)
		return ret;

	priv->cdev.name = priv->name;
	priv->cdev.brightness = LED_OFF;
	priv->cdev.max_brightness = priv->max_duty;
	priv->cdev.flags = LED_CORE_SUSPENDRESUME;
	priv->cdev.brightness_set_blocking = qcom_clk_led_set;

	return devm_led_classdev_register(&pdev->dev, &priv->cdev);
}

static const struct of_device_id of_qcom_clk_leds_match[] = {
	{ .compatible = "qcom,clk-led-pwm", },
	{}
};
MODULE_DEVICE_TABLE(of, of_qcom_clk_leds_match);

static struct platform_driver led_qcom_clk_driver = {
	.probe		= led_qcom_clk_probe,
	.driver		= {
		.name		= "led_qcom_clk_pwm",
		.of_match_table	= of_qcom_clk_leds_match,
	},
};

module_platform_driver(led_qcom_clk_driver);

MODULE_DESCRIPTION("Generic clock driven LED driver");
MODULE_LICENSE("GPL v2");
MODULE_ALIAS("platform:leds-qcom-clk");