[linux.git] / drivers / leds / leds-pm8058.c

// SPDX-License-Identifier: GPL-2.0-only
/* Copyright (c) 2010, 2011, 2016 The Linux Foundation. All rights reserved.
 */
#include <linux/leds.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/platform_device.h>
#include <linux/pm.h>
#include <linux/regmap.h>

#define PM8058_LED_TYPE_COMMON	0x00
#define PM8058_LED_TYPE_KEYPAD	0x01
#define PM8058_LED_TYPE_FLASH	0x02

#define PM8058_LED_TYPE_COMMON_MASK	0xf8
#define PM8058_LED_TYPE_KEYPAD_MASK	0xf0
#define PM8058_LED_TYPE_COMMON_SHIFT	3
#define PM8058_LED_TYPE_KEYPAD_SHIFT	4

struct pm8058_led {
	struct regmap *map;
	u32 reg;
	u32 ledtype;
	struct led_classdev cdev;
};

static void pm8058_led_set(struct led_classdev *cled,
	enum led_brightness value)
{
	struct pm8058_led *led;
	int ret = 0;
	unsigned int mask = 0;
	unsigned int val = 0;

	led = container_of(cled, struct pm8058_led, cdev);
	switch (led->ledtype) {
	case PM8058_LED_TYPE_COMMON:
		mask = PM8058_LED_TYPE_COMMON_MASK;
		val = value << PM8058_LED_TYPE_COMMON_SHIFT;
		break;
	case PM8058_LED_TYPE_KEYPAD:
	case PM8058_LED_TYPE_FLASH:
		mask = PM8058_LED_TYPE_KEYPAD_MASK;
		val = value << PM8058_LED_TYPE_KEYPAD_SHIFT;
		break;
	default:
		break;
	}

	ret = regmap_update_bits(led->map, led->reg, mask, val);
	if (ret)
		pr_err("Failed to set LED brightness\n");
}

static enum led_brightness pm8058_led_get(struct led_classdev *cled)
{
	struct pm8058_led *led;
	int ret;
	unsigned int val;

	led = container_of(cled, struct pm8058_led, cdev);

	ret = regmap_read(led->map, led->reg, &val);
	if (ret) {
		pr_err("Failed to get LED brightness\n");
		return LED_OFF;
	}

	switch (led->ledtype) {
	case PM8058_LED_TYPE_COMMON:
		val &= PM8058_LED_TYPE_COMMON_MASK;
		val >>= PM8058_LED_TYPE_COMMON_SHIFT;
		break;
	case PM8058_LED_TYPE_KEYPAD:
	case PM8058_LED_TYPE_FLASH:
		val &= PM8058_LED_TYPE_KEYPAD_MASK;
		val >>= PM8058_LED_TYPE_KEYPAD_SHIFT;
		break;
	default:
		val = LED_OFF;
		break;
	}

	return val;
}

static int pm8058_led_probe(struct platform_device *pdev)
{
	struct led_init_data init_data = {};
	struct device *dev = &pdev->dev;
	struct pm8058_led *led;
	struct device_node *np;
	int ret;
	struct regmap *map;
	enum led_brightness maxbright;
	enum led_default_state state;

	led = devm_kzalloc(dev, sizeof(*led), GFP_KERNEL);
	if (!led)
		return -ENOMEM;

	led->ledtype = (u32)(unsigned long)of_device_get_match_data(dev);

	map = dev_get_regmap(dev->parent, NULL);
	if (!map) {
		dev_err(dev, "Parent regmap unavailable.\n");
		return -ENXIO;
	}
	led->map = map;

	np = dev_of_node(dev);

	ret = of_property_read_u32(np, "reg", &led->reg);
	if (ret) {
		dev_err(dev, "no register offset specified\n");
		return -EINVAL;
	}

	led->cdev.brightness_set = pm8058_led_set;
	led->cdev.brightness_get = pm8058_led_get;
	if (led->ledtype == PM8058_LED_TYPE_COMMON)
		maxbright = 31; /* 5 bits */
	else
		maxbright = 15; /* 4 bits */
	led->cdev.max_brightness = maxbright;

	init_data.fwnode = of_fwnode_handle(np);

	state = led_init_default_state_get(init_data.fwnode);
	switch (state) {
	case LEDS_DEFSTATE_ON:
		led->cdev.brightness = maxbright;
		pm8058_led_set(&led->cdev, maxbright);
		break;
	case LEDS_DEFSTATE_KEEP:
		led->cdev.brightness = pm8058_led_get(&led->cdev);
		break;
	default:
		led->cdev.brightness = LED_OFF;
		pm8058_led_set(&led->cdev, LED_OFF);
	}

	if (led->ledtype == PM8058_LED_TYPE_KEYPAD ||
	    led->ledtype == PM8058_LED_TYPE_FLASH)
		led->cdev.flags	= LED_CORE_SUSPENDRESUME;

	ret = devm_led_classdev_register_ext(dev, &led->cdev, &init_data);
	if (ret)
		dev_err(dev, "Failed to register LED for %pOF\n", np);

	return ret;
}

static const struct of_device_id pm8058_leds_id_table[] = {
	{
		.compatible = "qcom,pm8058-led",
		.data = (void *)PM8058_LED_TYPE_COMMON
	},
	{
		.compatible = "qcom,pm8058-keypad-led",
		.data = (void *)PM8058_LED_TYPE_KEYPAD
	},
	{
		.compatible = "qcom,pm8058-flash-led",
		.data = (void *)PM8058_LED_TYPE_FLASH
	},
	{ },
};
MODULE_DEVICE_TABLE(of, pm8058_leds_id_table);

static struct platform_driver pm8058_led_driver = {
	.probe		= pm8058_led_probe,
	.driver		= {
		.name	= "pm8058-leds",
		.of_match_table = pm8058_leds_id_table,
	},
};
module_platform_driver(pm8058_led_driver);

MODULE_DESCRIPTION("PM8058 LEDs driver");
MODULE_LICENSE("GPL v2");
MODULE_ALIAS("platform:pm8058-leds");
Commit	Line	Data
97fb5e8d	1	// SPDX-License-Identifier: GPL-2.0-only
7f866986	2	/* Copyright (c) 2010, 2011, 2016 The Linux Foundation. All rights reserved.
7f866986 LW	3	*/
	4	#include <linux/leds.h>
	5	#include <linux/module.h>
	6	#include <linux/of.h>
7f866986 LW	7	#include <linux/platform_device.h>
	8	#include <linux/pm.h>
	9	#include <linux/regmap.h>
	10
	11	#define PM8058_LED_TYPE_COMMON 0x00
	12	#define PM8058_LED_TYPE_KEYPAD 0x01
	13	#define PM8058_LED_TYPE_FLASH 0x02
	14
	15	#define PM8058_LED_TYPE_COMMON_MASK 0xf8
	16	#define PM8058_LED_TYPE_KEYPAD_MASK 0xf0
	17	#define PM8058_LED_TYPE_COMMON_SHIFT 3
	18	#define PM8058_LED_TYPE_KEYPAD_SHIFT 4
	19
	20	struct pm8058_led {
	21	struct regmap *map;
	22	u32 reg;
	23	u32 ledtype;
	24	struct led_classdev cdev;
	25	};
	26
	27	static void pm8058_led_set(struct led_classdev *cled,
	28	enum led_brightness value)
	29	{
	30	struct pm8058_led *led;
	31	int ret = 0;
	32	unsigned int mask = 0;
	33	unsigned int val = 0;
	34
	35	led = container_of(cled, struct pm8058_led, cdev);
	36	switch (led->ledtype) {
	37	case PM8058_LED_TYPE_COMMON:
	38	mask = PM8058_LED_TYPE_COMMON_MASK;
	39	val = value << PM8058_LED_TYPE_COMMON_SHIFT;
	40	break;
	41	case PM8058_LED_TYPE_KEYPAD:
	42	case PM8058_LED_TYPE_FLASH:
	43	mask = PM8058_LED_TYPE_KEYPAD_MASK;
	44	val = value << PM8058_LED_TYPE_KEYPAD_SHIFT;
	45	break;
	46	default:
	47	break;
	48	}
	49
	50	ret = regmap_update_bits(led->map, led->reg, mask, val);
	51	if (ret)
	52	pr_err("Failed to set LED brightness\n");
	53	}
	54
	55	static enum led_brightness pm8058_led_get(struct led_classdev *cled)
	56	{
	57	struct pm8058_led *led;
	58	int ret;
	59	unsigned int val;
	60
	61	led = container_of(cled, struct pm8058_led, cdev);
	62
	63	ret = regmap_read(led->map, led->reg, &val);
	64	if (ret) {
	65	pr_err("Failed to get LED brightness\n");
	66	return LED_OFF;
	67	}
	68
	69	switch (led->ledtype) {
	70	case PM8058_LED_TYPE_COMMON:
71	val &= PM8058_LED_TYPE_COMMON_MASK;
72	val >>= PM8058_LED_TYPE_COMMON_SHIFT;
73	break;
74	case PM8058_LED_TYPE_KEYPAD:
75	case PM8058_LED_TYPE_FLASH:
76	val &= PM8058_LED_TYPE_KEYPAD_MASK;
77	val >>= PM8058_LED_TYPE_KEYPAD_SHIFT;
78	break;
79	default:
80	val = LED_OFF;
81	break;
82	}
83
84	return val;
85	}
86
87	static int pm8058_led_probe(struct platform_device *pdev)
88	{
eed951bb	89	struct led_init_data init_data = {};
fb270ba0	90	struct device *dev = &pdev->dev;
7f866986	91	struct pm8058_led *led;
fb270ba0	92	struct device_node *np;
7f866986 LW	93	int ret;
7f866986 LW	94	struct regmap *map;
7f866986	95	enum led_brightness maxbright;
bf8a9a76	96	enum led_default_state state;
7f866986	97
fb270ba0	98	led = devm_kzalloc(dev, sizeof(*led), GFP_KERNEL);
7f866986 LW	99	if (!led)
	100	return -ENOMEM;
	101
fb270ba0	102	led->ledtype = (u32)(unsigned long)of_device_get_match_data(dev);
7f866986	103
fb270ba0	104	map = dev_get_regmap(dev->parent, NULL);
7f866986	105	if (!map) {
fb270ba0	106	dev_err(dev, "Parent regmap unavailable.\n");
7f866986 LW	107	return -ENXIO;
	108	}
	109	led->map = map;
	110
fb270ba0 MB	111	np = dev_of_node(dev);
fb270ba0 MB	112
7f866986 LW	113	ret = of_property_read_u32(np, "reg", &led->reg);
7f866986 LW	114	if (ret) {
fb270ba0	115	dev_err(dev, "no register offset specified\n");
7f866986 LW	116	return -EINVAL;
	117	}
	118
7f866986 LW	119	led->cdev.brightness_set = pm8058_led_set;
	120	led->cdev.brightness_get = pm8058_led_get;
	121	if (led->ledtype == PM8058_LED_TYPE_COMMON)
	122	maxbright = 31; /* 5 bits */
	123	else
	124	maxbright = 15; /* 4 bits */
	125	led->cdev.max_brightness = maxbright;
	126
bf8a9a76 AS	127	init_data.fwnode = of_fwnode_handle(np);
	128
	129	state = led_init_default_state_get(init_data.fwnode);
	130	switch (state) {
	131	case LEDS_DEFSTATE_ON:
	132	led->cdev.brightness = maxbright;
	133	pm8058_led_set(&led->cdev, maxbright);
	134	break;
	135	case LEDS_DEFSTATE_KEEP:
	136	led->cdev.brightness = pm8058_led_get(&led->cdev);
	137	break;
	138	default:
	139	led->cdev.brightness = LED_OFF;
	140	pm8058_led_set(&led->cdev, LED_OFF);
7f866986 LW	141	}
	142
	143	if (led->ledtype == PM8058_LED_TYPE_KEYPAD \|\|
	144	led->ledtype == PM8058_LED_TYPE_FLASH)
	145	led->cdev.flags = LED_CORE_SUSPENDRESUME;
	146
fb270ba0	147	ret = devm_led_classdev_register_ext(dev, &led->cdev, &init_data);
1016daf9	148	if (ret)
fb270ba0	149	dev_err(dev, "Failed to register LED for %pOF\n", np);
7f866986	150
1016daf9	151	return ret;
7f866986 LW	152	}
	153
	154	static const struct of_device_id pm8058_leds_id_table[] = {
	155	{
	156	.compatible = "qcom,pm8058-led",
	157	.data = (void *)PM8058_LED_TYPE_COMMON
	158	},
	159	{
	160	.compatible = "qcom,pm8058-keypad-led",
	161	.data = (void *)PM8058_LED_TYPE_KEYPAD
	162	},
	163	{
	164	.compatible = "qcom,pm8058-flash-led",
	165	.data = (void *)PM8058_LED_TYPE_FLASH
	166	},
	167	{ },
	168	};
	169	MODULE_DEVICE_TABLE(of, pm8058_leds_id_table);
	170
	171	static struct platform_driver pm8058_led_driver = {
	172	.probe = pm8058_led_probe,
	173	.driver = {
	174	.name = "pm8058-leds",
	175	.of_match_table = pm8058_leds_id_table,
	176	},
	177	};
	178	module_platform_driver(pm8058_led_driver);
	179
	180	MODULE_DESCRIPTION("PM8058 LEDs driver");
	181	MODULE_LICENSE("GPL v2");
	182	MODULE_ALIAS("platform:pm8058-leds");