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

/*
 * Copyright (c) 2015 Google, Inc
 * Written by Simon Glass <sjg@chromium.org>
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

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

DECLARE_GLOBAL_DATA_PTR;

struct led_gpio_priv {
	struct gpio_desc gpio;
};

static int gpio_led_set_on(struct udevice *dev, int on)
{
	struct led_gpio_priv *priv = dev_get_priv(dev);

	if (!dm_gpio_is_valid(&priv->gpio))
		return -EREMOTEIO;

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

static int led_gpio_probe(struct udevice *dev)
{
	struct led_uclass_plat *uc_plat = dev_get_uclass_platdata(dev);
	struct led_gpio_priv *priv = dev_get_priv(dev);

	/* Ignore the top-level LED node */
	if (!uc_plat->label)
		return 0;
	return gpio_request_by_name(dev, "gpios", 0, &priv->gpio, GPIOD_IS_OUT);
}

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)
{
	const void *blob = gd->fdt_blob;
	struct udevice *dev;
	int node;
	int ret;

	for (node = fdt_first_subnode(blob, parent->of_offset);
	     node > 0;
	     node = fdt_next_subnode(blob, node)) {
		struct led_uclass_plat *uc_plat;
		const char *label;

		label = fdt_getprop(blob, node, "label", NULL);
		if (!label) {
			debug("%s: node %s has no label\n", __func__,
			      fdt_get_name(blob, node, NULL));
			return -EINVAL;
		}
		ret = device_bind_driver_to_node(parent, "gpio_led",
						 fdt_get_name(blob, node, NULL),
						 node, &dev);
		if (ret)
			return ret;
		uc_plat = dev_get_uclass_platdata(dev);
		uc_plat->label = label;
	}

	return 0;
}

static const struct led_ops gpio_led_ops = {
	.set_on		= gpio_led_set_on,
};

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_alloc_size = sizeof(struct led_gpio_priv),
	.bind	= led_gpio_bind,
	.probe	= led_gpio_probe,
	.remove	= led_gpio_remove,
};
Commit	Line	Data
5ac76bad SG	1	/*
	2	* Copyright (c) 2015 Google, Inc
	3	* Written by Simon Glass <sjg@chromium.org>
	4	*
	5	* SPDX-License-Identifier: GPL-2.0+
	6	*/
	7
	8	#include <common.h>
	9	#include <dm.h>
	10	#include <errno.h>
	11	#include <led.h>
	12	#include <asm/gpio.h>
	13	#include <dm/lists.h>
	14
	15	DECLARE_GLOBAL_DATA_PTR;
	16
	17	struct led_gpio_priv {
	18	struct gpio_desc gpio;
	19	};
	20
	21	static int gpio_led_set_on(struct udevice *dev, int on)
	22	{
	23	struct led_gpio_priv *priv = dev_get_priv(dev);
	24
	25	if (!dm_gpio_is_valid(&priv->gpio))
	26	return -EREMOTEIO;
	27
	28	return dm_gpio_set_value(&priv->gpio, on);
	29	}
	30
	31	static int led_gpio_probe(struct udevice *dev)
	32	{
	33	struct led_uclass_plat *uc_plat = dev_get_uclass_platdata(dev);
	34	struct led_gpio_priv *priv = dev_get_priv(dev);
	35
	36	/* Ignore the top-level LED node */
	37	if (!uc_plat->label)
	38	return 0;
	39	return gpio_request_by_name(dev, "gpios", 0, &priv->gpio, GPIOD_IS_OUT);
	40	}
	41
	42	static int led_gpio_remove(struct udevice *dev)
	43	{
3c43fba3 SG	44	/*
	45	* The GPIO driver may have already been removed. We will need to
	46	* address this more generally.
	47	*/
	48	#ifndef CONFIG_SANDBOX
5ac76bad SG	49	struct led_gpio_priv *priv = dev_get_priv(dev);
	50
	51	if (dm_gpio_is_valid(&priv->gpio))
	52	dm_gpio_free(dev, &priv->gpio);
3c43fba3	53	#endif
5ac76bad SG	54
	55	return 0;
	56	}
	57
	58	static int led_gpio_bind(struct udevice *parent)
	59	{
	60	const void *blob = gd->fdt_blob;
	61	struct udevice *dev;
	62	int node;
	63	int ret;
	64
	65	for (node = fdt_first_subnode(blob, parent->of_offset);
	66	node > 0;
	67	node = fdt_next_subnode(blob, node)) {
	68	struct led_uclass_plat *uc_plat;
	69	const char *label;
	70
	71	label = fdt_getprop(blob, node, "label", NULL);
	72	if (!label) {
	73	debug("%s: node %s has no label\n", __func__,
	74	fdt_get_name(blob, node, NULL));
	75	return -EINVAL;
	76	}
	77	ret = device_bind_driver_to_node(parent, "gpio_led",
	78	fdt_get_name(blob, node, NULL),
	79	node, &dev);
	80	if (ret)
	81	return ret;
	82	uc_plat = dev_get_uclass_platdata(dev);
	83	uc_plat->label = label;
	84	}
	85
	86	return 0;
	87	}
	88
	89	static const struct led_ops gpio_led_ops = {
	90	.set_on = gpio_led_set_on,
	91	};
	92
	93	static const struct udevice_id led_gpio_ids[] = {
	94	{ .compatible = "gpio-leds" },
	95	{ }
	96	};
	97
	98	U_BOOT_DRIVER(led_gpio) = {
	99	.name = "gpio_led",
	100	.id = UCLASS_LED,
	101	.of_match = led_gpio_ids,
	102	.ops = &gpio_led_ops,
	103	.priv_auto_alloc_size = sizeof(struct led_gpio_priv),
	104	.bind = led_gpio_bind,
	105	.probe = led_gpio_probe,
	106	.remove = led_gpio_remove,
	107	};