[J-u-boot.git] / drivers / led / led_gpio.c

// SPDX-License-Identifier: GPL-2.0+
/*
 * Copyright (c) 2015 Google, Inc
 * Written by Simon Glass <[email protected]>
 */

#include <common.h>
#include <dm.h>
#include <errno.h>
#include <led.h>
#include <log.h>
#include <malloc.h>
#include <asm/gpio.h>
#include <dm/lists.h>

struct led_gpio_priv {
	struct gpio_desc gpio;
};

static int gpio_led_set_state(struct udevice *dev, enum led_state_t state)
{
	struct led_gpio_priv *priv = dev_get_priv(dev);
	int ret;

	if (!dm_gpio_is_valid(&priv->gpio))
		return -EREMOTEIO;
	switch (state) {
	case LEDST_OFF:
	case LEDST_ON:
		break;
	case LEDST_TOGGLE:
		ret = dm_gpio_get_value(&priv->gpio);
		if (ret < 0)
			return ret;
		state = !ret;
		break;
	default:
		return -ENOSYS;
	}

	return dm_gpio_set_value(&priv->gpio, state);
}

static enum led_state_t gpio_led_get_state(struct udevice *dev)
{
	struct led_gpio_priv *priv = dev_get_priv(dev);
	int ret;

	if (!dm_gpio_is_valid(&priv->gpio))
		return -EREMOTEIO;
	ret = dm_gpio_get_value(&priv->gpio);
	if (ret < 0)
		return ret;

	return ret ? LEDST_ON : LEDST_OFF;
}

static int led_gpio_probe(struct udevice *dev)
{
	struct led_uc_plat *uc_plat = dev_get_uclass_plat(dev);
	struct led_gpio_priv *priv = dev_get_priv(dev);
	int ret;

	/* Ignore the top-level LED node */
	if (!uc_plat->label)
		return 0;

	ret = gpio_request_by_name(dev, "gpios", 0, &priv->gpio, GPIOD_IS_OUT);
	if (ret)
		return ret;

	return 0;
}

static int led_gpio_remove(struct udevice *dev)
{
	/*
	 * The GPIO driver may have already been removed. We will need to
	 * address this more generally.
	 */
#ifndef CONFIG_SANDBOX
	struct led_gpio_priv *priv = dev_get_priv(dev);

	if (dm_gpio_is_valid(&priv->gpio))
		dm_gpio_free(dev, &priv->gpio);
#endif

	return 0;
}

static int led_gpio_bind(struct udevice *parent)
{
	struct udevice *dev;
	ofnode node;
	int ret;

	dev_for_each_subnode(node, parent) {
		ret = device_bind_driver_to_node(parent, "gpio_led",
						 ofnode_get_name(node),
						 node, &dev);
		if (ret)
			return ret;
	}

	return 0;
}

static const struct led_ops gpio_led_ops = {
	.set_state	= gpio_led_set_state,
	.get_state	= gpio_led_get_state,
};

static const struct udevice_id led_gpio_ids[] = {
	{ .compatible = "gpio-leds" },
	{ }
};

U_BOOT_DRIVER(led_gpio) = {
	.name	= "gpio_led",
	.id	= UCLASS_LED,
	.of_match = led_gpio_ids,
	.ops	= &gpio_led_ops,
	.priv_auto	= sizeof(struct led_gpio_priv),
	.bind	= led_gpio_bind,
	.probe	= led_gpio_probe,
	.remove	= led_gpio_remove,
};
Commit	Line	Data
83d290c5	1	// SPDX-License-Identifier: GPL-2.0+
5ac76bad SG	2	/*
	3	* Copyright (c) 2015 Google, Inc
	4	* Written by Simon Glass <[email protected]>
5ac76bad SG	5	*/
	6
	7	#include <common.h>
	8	#include <dm.h>
	9	#include <errno.h>
	10	#include <led.h>
f7ae49fc	11	#include <log.h>
336d4615	12	#include <malloc.h>
5ac76bad SG	13	#include <asm/gpio.h>
	14	#include <dm/lists.h>
	15
5ac76bad SG	16	struct led_gpio_priv {
	17	struct gpio_desc gpio;
	18	};
	19
ddae9fcd	20	static int gpio_led_set_state(struct udevice *dev, enum led_state_t state)
5ac76bad SG	21	{
5ac76bad SG	22	struct led_gpio_priv *priv = dev_get_priv(dev);
9413ad4f	23	int ret;
5ac76bad SG	24
	25	if (!dm_gpio_is_valid(&priv->gpio))
	26	return -EREMOTEIO;
8f4b6123 SG	27	switch (state) {
	28	case LEDST_OFF:
	29	case LEDST_ON:
	30	break;
9413ad4f SG	31	case LEDST_TOGGLE:
	32	ret = dm_gpio_get_value(&priv->gpio);
	33	if (ret < 0)
	34	return ret;
	35	state = !ret;
	36	break;
8f4b6123 SG	37	default:
	38	return -ENOSYS;
	39	}
5ac76bad	40
ddae9fcd	41	return dm_gpio_set_value(&priv->gpio, state);
5ac76bad SG	42	}
5ac76bad SG	43
8f4b6123 SG	44	static enum led_state_t gpio_led_get_state(struct udevice *dev)
	45	{
	46	struct led_gpio_priv *priv = dev_get_priv(dev);
	47	int ret;
	48
	49	if (!dm_gpio_is_valid(&priv->gpio))
	50	return -EREMOTEIO;
	51	ret = dm_gpio_get_value(&priv->gpio);
	52	if (ret < 0)
	53	return ret;
	54
	55	return ret ? LEDST_ON : LEDST_OFF;
	56	}
	57
5ac76bad SG	58	static int led_gpio_probe(struct udevice *dev)
5ac76bad SG	59	{
caa4daa2	60	struct led_uc_plat *uc_plat = dev_get_uclass_plat(dev);
5ac76bad	61	struct led_gpio_priv *priv = dev_get_priv(dev);
d90f0d4c	62	int ret;
5ac76bad SG	63
	64	/* Ignore the top-level LED node */
	65	if (!uc_plat->label)
	66	return 0;
d90f0d4c PB	67
	68	ret = gpio_request_by_name(dev, "gpios", 0, &priv->gpio, GPIOD_IS_OUT);
	69	if (ret)
	70	return ret;
	71
d90f0d4c	72	return 0;
5ac76bad SG	73	}
	74
	75	static int led_gpio_remove(struct udevice *dev)
	76	{
3c43fba3 SG	77	/*
	78	* The GPIO driver may have already been removed. We will need to
	79	* address this more generally.
	80	*/
	81	#ifndef CONFIG_SANDBOX
5ac76bad SG	82	struct led_gpio_priv *priv = dev_get_priv(dev);
	83
	84	if (dm_gpio_is_valid(&priv->gpio))
	85	dm_gpio_free(dev, &priv->gpio);
3c43fba3	86	#endif
5ac76bad SG	87
	88	return 0;
	89	}
	90
	91	static int led_gpio_bind(struct udevice *parent)
	92	{
5ac76bad	93	struct udevice *dev;
45a26867	94	ofnode node;
5ac76bad SG	95	int ret;
5ac76bad SG	96
45a26867	97	dev_for_each_subnode(node, parent) {
5ac76bad	98	ret = device_bind_driver_to_node(parent, "gpio_led",
45a26867	99	ofnode_get_name(node),
5ac76bad SG	100	node, &dev);
	101	if (ret)
	102	return ret;
5ac76bad SG	103	}
	104
	105	return 0;
	106	}
	107
	108	static const struct led_ops gpio_led_ops = {
ddae9fcd	109	.set_state = gpio_led_set_state,
8f4b6123	110	.get_state = gpio_led_get_state,
5ac76bad SG	111	};
	112
	113	static const struct udevice_id led_gpio_ids[] = {
	114	{ .compatible = "gpio-leds" },
	115	{ }
	116	};
	117
	118	U_BOOT_DRIVER(led_gpio) = {
	119	.name = "gpio_led",
	120	.id = UCLASS_LED,
	121	.of_match = led_gpio_ids,
	122	.ops = &gpio_led_ops,
41575d8e	123	.priv_auto = sizeof(struct led_gpio_priv),
5ac76bad SG	124	.bind = led_gpio_bind,
	125	.probe = led_gpio_probe,
	126	.remove = led_gpio_remove,
	127	};