blob: ef9b61ee626b7f86633c9d4879f841e334f73745 [file] [log] [blame]
Tom Rini10e47792018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Simon Glass5a9390b2015-06-23 15:38:46 -06002/*
3 * Copyright (c) 2015 Google, Inc
4 * Written by Simon Glass <sjg@chromium.org>
Simon Glass5a9390b2015-06-23 15:38:46 -06005 */
6
7#include <common.h>
8#include <dm.h>
9#include <errno.h>
10#include <led.h>
Simon Glass0f2af882020-05-10 11:40:05 -060011#include <log.h>
Simon Glass9bc15642020-02-03 07:36:16 -070012#include <malloc.h>
Simon Glass5a9390b2015-06-23 15:38:46 -060013#include <asm/gpio.h>
14#include <dm/lists.h>
15
Simon Glass5a9390b2015-06-23 15:38:46 -060016struct led_gpio_priv {
17 struct gpio_desc gpio;
18};
19
Simon Glass6ca19772017-04-10 11:34:54 -060020static int gpio_led_set_state(struct udevice *dev, enum led_state_t state)
Simon Glass5a9390b2015-06-23 15:38:46 -060021{
22 struct led_gpio_priv *priv = dev_get_priv(dev);
Simon Glasse445dfd2017-04-10 11:34:56 -060023 int ret;
Simon Glass5a9390b2015-06-23 15:38:46 -060024
25 if (!dm_gpio_is_valid(&priv->gpio))
26 return -EREMOTEIO;
Simon Glassdc531662017-04-10 11:34:55 -060027 switch (state) {
28 case LEDST_OFF:
29 case LEDST_ON:
30 break;
Simon Glasse445dfd2017-04-10 11:34:56 -060031 case LEDST_TOGGLE:
32 ret = dm_gpio_get_value(&priv->gpio);
33 if (ret < 0)
34 return ret;
35 state = !ret;
36 break;
Simon Glassdc531662017-04-10 11:34:55 -060037 default:
38 return -ENOSYS;
39 }
Simon Glass5a9390b2015-06-23 15:38:46 -060040
Simon Glass6ca19772017-04-10 11:34:54 -060041 return dm_gpio_set_value(&priv->gpio, state);
Simon Glass5a9390b2015-06-23 15:38:46 -060042}
43
Simon Glassdc531662017-04-10 11:34:55 -060044static 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
Simon Glass5a9390b2015-06-23 15:38:46 -060058static int led_gpio_probe(struct udevice *dev)
59{
Simon Glassda01de92017-04-10 11:34:53 -060060 struct led_uc_plat *uc_plat = dev_get_uclass_platdata(dev);
Simon Glass5a9390b2015-06-23 15:38:46 -060061 struct led_gpio_priv *priv = dev_get_priv(dev);
Patrick Bruenn10ab0232018-04-11 11:16:27 +020062 int ret;
Simon Glass5a9390b2015-06-23 15:38:46 -060063
64 /* Ignore the top-level LED node */
65 if (!uc_plat->label)
66 return 0;
Patrick Bruenn10ab0232018-04-11 11:16:27 +020067
68 ret = gpio_request_by_name(dev, "gpios", 0, &priv->gpio, GPIOD_IS_OUT);
69 if (ret)
70 return ret;
71
Patrick Bruenn10ab0232018-04-11 11:16:27 +020072 return 0;
Simon Glass5a9390b2015-06-23 15:38:46 -060073}
74
75static int led_gpio_remove(struct udevice *dev)
76{
Simon Glassd783eb32015-07-06 12:54:34 -060077 /*
78 * The GPIO driver may have already been removed. We will need to
79 * address this more generally.
80 */
81#ifndef CONFIG_SANDBOX
Simon Glass5a9390b2015-06-23 15:38:46 -060082 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);
Simon Glassd783eb32015-07-06 12:54:34 -060086#endif
Simon Glass5a9390b2015-06-23 15:38:46 -060087
88 return 0;
89}
90
91static int led_gpio_bind(struct udevice *parent)
92{
Simon Glass5a9390b2015-06-23 15:38:46 -060093 struct udevice *dev;
Simon Glasse6dd8da2017-05-18 20:09:07 -060094 ofnode node;
Simon Glass5a9390b2015-06-23 15:38:46 -060095 int ret;
96
Simon Glasse6dd8da2017-05-18 20:09:07 -060097 dev_for_each_subnode(node, parent) {
Simon Glassda01de92017-04-10 11:34:53 -060098 struct led_uc_plat *uc_plat;
Simon Glass5a9390b2015-06-23 15:38:46 -060099 const char *label;
100
Simon Glasse6dd8da2017-05-18 20:09:07 -0600101 label = ofnode_read_string(node, "label");
Simon Glass5a9390b2015-06-23 15:38:46 -0600102 if (!label) {
103 debug("%s: node %s has no label\n", __func__,
Simon Glasse6dd8da2017-05-18 20:09:07 -0600104 ofnode_get_name(node));
Simon Glass5a9390b2015-06-23 15:38:46 -0600105 return -EINVAL;
106 }
107 ret = device_bind_driver_to_node(parent, "gpio_led",
Simon Glasse6dd8da2017-05-18 20:09:07 -0600108 ofnode_get_name(node),
Simon Glass5a9390b2015-06-23 15:38:46 -0600109 node, &dev);
110 if (ret)
111 return ret;
112 uc_plat = dev_get_uclass_platdata(dev);
113 uc_plat->label = label;
114 }
115
116 return 0;
117}
118
119static const struct led_ops gpio_led_ops = {
Simon Glass6ca19772017-04-10 11:34:54 -0600120 .set_state = gpio_led_set_state,
Simon Glassdc531662017-04-10 11:34:55 -0600121 .get_state = gpio_led_get_state,
Simon Glass5a9390b2015-06-23 15:38:46 -0600122};
123
124static const struct udevice_id led_gpio_ids[] = {
125 { .compatible = "gpio-leds" },
126 { }
127};
128
129U_BOOT_DRIVER(led_gpio) = {
130 .name = "gpio_led",
131 .id = UCLASS_LED,
132 .of_match = led_gpio_ids,
133 .ops = &gpio_led_ops,
134 .priv_auto_alloc_size = sizeof(struct led_gpio_priv),
135 .bind = led_gpio_bind,
136 .probe = led_gpio_probe,
137 .remove = led_gpio_remove,
138};