blob: 997663588718f0ea5795f30535ba06d6b8ef8a2b [file] [log] [blame]
Simon Glass5ac76ba2015-06-23 15:38:46 -06001/*
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
15DECLARE_GLOBAL_DATA_PTR;
16
17struct led_gpio_priv {
18 struct gpio_desc gpio;
19};
20
Simon Glassddae9fc2017-04-10 11:34:54 -060021static int gpio_led_set_state(struct udevice *dev, enum led_state_t state)
Simon Glass5ac76ba2015-06-23 15:38:46 -060022{
23 struct led_gpio_priv *priv = dev_get_priv(dev);
Simon Glass9413ad42017-04-10 11:34:56 -060024 int ret;
Simon Glass5ac76ba2015-06-23 15:38:46 -060025
26 if (!dm_gpio_is_valid(&priv->gpio))
27 return -EREMOTEIO;
Simon Glass8f4b6122017-04-10 11:34:55 -060028 switch (state) {
29 case LEDST_OFF:
30 case LEDST_ON:
31 break;
Simon Glass9413ad42017-04-10 11:34:56 -060032 case LEDST_TOGGLE:
33 ret = dm_gpio_get_value(&priv->gpio);
34 if (ret < 0)
35 return ret;
36 state = !ret;
37 break;
Simon Glass8f4b6122017-04-10 11:34:55 -060038 default:
39 return -ENOSYS;
40 }
Simon Glass5ac76ba2015-06-23 15:38:46 -060041
Simon Glassddae9fc2017-04-10 11:34:54 -060042 return dm_gpio_set_value(&priv->gpio, state);
Simon Glass5ac76ba2015-06-23 15:38:46 -060043}
44
Simon Glass8f4b6122017-04-10 11:34:55 -060045static enum led_state_t gpio_led_get_state(struct udevice *dev)
46{
47 struct led_gpio_priv *priv = dev_get_priv(dev);
48 int ret;
49
50 if (!dm_gpio_is_valid(&priv->gpio))
51 return -EREMOTEIO;
52 ret = dm_gpio_get_value(&priv->gpio);
53 if (ret < 0)
54 return ret;
55
56 return ret ? LEDST_ON : LEDST_OFF;
57}
58
Simon Glass5ac76ba2015-06-23 15:38:46 -060059static int led_gpio_probe(struct udevice *dev)
60{
Simon Glass56e19872017-04-10 11:34:53 -060061 struct led_uc_plat *uc_plat = dev_get_uclass_platdata(dev);
Simon Glass5ac76ba2015-06-23 15:38:46 -060062 struct led_gpio_priv *priv = dev_get_priv(dev);
63
64 /* Ignore the top-level LED node */
65 if (!uc_plat->label)
66 return 0;
67 return gpio_request_by_name(dev, "gpios", 0, &priv->gpio, GPIOD_IS_OUT);
68}
69
70static int led_gpio_remove(struct udevice *dev)
71{
Simon Glass3c43fba2015-07-06 12:54:34 -060072 /*
73 * The GPIO driver may have already been removed. We will need to
74 * address this more generally.
75 */
76#ifndef CONFIG_SANDBOX
Simon Glass5ac76ba2015-06-23 15:38:46 -060077 struct led_gpio_priv *priv = dev_get_priv(dev);
78
79 if (dm_gpio_is_valid(&priv->gpio))
80 dm_gpio_free(dev, &priv->gpio);
Simon Glass3c43fba2015-07-06 12:54:34 -060081#endif
Simon Glass5ac76ba2015-06-23 15:38:46 -060082
83 return 0;
84}
85
86static int led_gpio_bind(struct udevice *parent)
87{
Simon Glass5ac76ba2015-06-23 15:38:46 -060088 struct udevice *dev;
Simon Glass45a26862017-05-18 20:09:07 -060089 ofnode node;
Simon Glass5ac76ba2015-06-23 15:38:46 -060090 int ret;
91
Simon Glass45a26862017-05-18 20:09:07 -060092 dev_for_each_subnode(node, parent) {
Simon Glass56e19872017-04-10 11:34:53 -060093 struct led_uc_plat *uc_plat;
Simon Glass5ac76ba2015-06-23 15:38:46 -060094 const char *label;
95
Simon Glass45a26862017-05-18 20:09:07 -060096 label = ofnode_read_string(node, "label");
Simon Glass5ac76ba2015-06-23 15:38:46 -060097 if (!label) {
98 debug("%s: node %s has no label\n", __func__,
Simon Glass45a26862017-05-18 20:09:07 -060099 ofnode_get_name(node));
Simon Glass5ac76ba2015-06-23 15:38:46 -0600100 return -EINVAL;
101 }
102 ret = device_bind_driver_to_node(parent, "gpio_led",
Simon Glass45a26862017-05-18 20:09:07 -0600103 ofnode_get_name(node),
Simon Glass5ac76ba2015-06-23 15:38:46 -0600104 node, &dev);
105 if (ret)
106 return ret;
107 uc_plat = dev_get_uclass_platdata(dev);
108 uc_plat->label = label;
109 }
110
111 return 0;
112}
113
114static const struct led_ops gpio_led_ops = {
Simon Glassddae9fc2017-04-10 11:34:54 -0600115 .set_state = gpio_led_set_state,
Simon Glass8f4b6122017-04-10 11:34:55 -0600116 .get_state = gpio_led_get_state,
Simon Glass5ac76ba2015-06-23 15:38:46 -0600117};
118
119static const struct udevice_id led_gpio_ids[] = {
120 { .compatible = "gpio-leds" },
121 { }
122};
123
124U_BOOT_DRIVER(led_gpio) = {
125 .name = "gpio_led",
126 .id = UCLASS_LED,
127 .of_match = led_gpio_ids,
128 .ops = &gpio_led_ops,
129 .priv_auto_alloc_size = sizeof(struct led_gpio_priv),
130 .bind = led_gpio_bind,
131 .probe = led_gpio_probe,
132 .remove = led_gpio_remove,
133};