183d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+ 25ac76badSSimon Glass /* 35ac76badSSimon Glass * Copyright (c) 2015 Google, Inc 45ac76badSSimon Glass * Written by Simon Glass <sjg@chromium.org> 55ac76badSSimon Glass */ 65ac76badSSimon Glass 75ac76badSSimon Glass #include <common.h> 85ac76badSSimon Glass #include <dm.h> 95ac76badSSimon Glass #include <errno.h> 105ac76badSSimon Glass #include <led.h> 115ac76badSSimon Glass #include <asm/gpio.h> 125ac76badSSimon Glass #include <dm/lists.h> 135ac76badSSimon Glass 145ac76badSSimon Glass struct led_gpio_priv { 155ac76badSSimon Glass struct gpio_desc gpio; 165ac76badSSimon Glass }; 175ac76badSSimon Glass 18ddae9fcdSSimon Glass static int gpio_led_set_state(struct udevice *dev, enum led_state_t state) 195ac76badSSimon Glass { 205ac76badSSimon Glass struct led_gpio_priv *priv = dev_get_priv(dev); 219413ad4fSSimon Glass int ret; 225ac76badSSimon Glass 235ac76badSSimon Glass if (!dm_gpio_is_valid(&priv->gpio)) 245ac76badSSimon Glass return -EREMOTEIO; 258f4b6123SSimon Glass switch (state) { 268f4b6123SSimon Glass case LEDST_OFF: 278f4b6123SSimon Glass case LEDST_ON: 288f4b6123SSimon Glass break; 299413ad4fSSimon Glass case LEDST_TOGGLE: 309413ad4fSSimon Glass ret = dm_gpio_get_value(&priv->gpio); 319413ad4fSSimon Glass if (ret < 0) 329413ad4fSSimon Glass return ret; 339413ad4fSSimon Glass state = !ret; 349413ad4fSSimon Glass break; 358f4b6123SSimon Glass default: 368f4b6123SSimon Glass return -ENOSYS; 378f4b6123SSimon Glass } 385ac76badSSimon Glass 39ddae9fcdSSimon Glass return dm_gpio_set_value(&priv->gpio, state); 405ac76badSSimon Glass } 415ac76badSSimon Glass 428f4b6123SSimon Glass static enum led_state_t gpio_led_get_state(struct udevice *dev) 438f4b6123SSimon Glass { 448f4b6123SSimon Glass struct led_gpio_priv *priv = dev_get_priv(dev); 458f4b6123SSimon Glass int ret; 468f4b6123SSimon Glass 478f4b6123SSimon Glass if (!dm_gpio_is_valid(&priv->gpio)) 488f4b6123SSimon Glass return -EREMOTEIO; 498f4b6123SSimon Glass ret = dm_gpio_get_value(&priv->gpio); 508f4b6123SSimon Glass if (ret < 0) 518f4b6123SSimon Glass return ret; 528f4b6123SSimon Glass 538f4b6123SSimon Glass return ret ? LEDST_ON : LEDST_OFF; 548f4b6123SSimon Glass } 558f4b6123SSimon Glass 565ac76badSSimon Glass static int led_gpio_probe(struct udevice *dev) 575ac76badSSimon Glass { 5856e19871SSimon Glass struct led_uc_plat *uc_plat = dev_get_uclass_platdata(dev); 595ac76badSSimon Glass struct led_gpio_priv *priv = dev_get_priv(dev); 60*d90f0d4cSPatrick Bruenn const char *default_state; 61*d90f0d4cSPatrick Bruenn int ret; 625ac76badSSimon Glass 635ac76badSSimon Glass /* Ignore the top-level LED node */ 645ac76badSSimon Glass if (!uc_plat->label) 655ac76badSSimon Glass return 0; 66*d90f0d4cSPatrick Bruenn 67*d90f0d4cSPatrick Bruenn ret = gpio_request_by_name(dev, "gpios", 0, &priv->gpio, GPIOD_IS_OUT); 68*d90f0d4cSPatrick Bruenn if (ret) 69*d90f0d4cSPatrick Bruenn return ret; 70*d90f0d4cSPatrick Bruenn 71*d90f0d4cSPatrick Bruenn default_state = dev_read_string(dev, "default-state"); 72*d90f0d4cSPatrick Bruenn if (default_state) { 73*d90f0d4cSPatrick Bruenn if (!strncmp(default_state, "on", 2)) 74*d90f0d4cSPatrick Bruenn gpio_led_set_state(dev, LEDST_ON); 75*d90f0d4cSPatrick Bruenn else if (!strncmp(default_state, "off", 3)) 76*d90f0d4cSPatrick Bruenn gpio_led_set_state(dev, LEDST_OFF); 77*d90f0d4cSPatrick Bruenn } 78*d90f0d4cSPatrick Bruenn return 0; 795ac76badSSimon Glass } 805ac76badSSimon Glass 815ac76badSSimon Glass static int led_gpio_remove(struct udevice *dev) 825ac76badSSimon Glass { 833c43fba3SSimon Glass /* 843c43fba3SSimon Glass * The GPIO driver may have already been removed. We will need to 853c43fba3SSimon Glass * address this more generally. 863c43fba3SSimon Glass */ 873c43fba3SSimon Glass #ifndef CONFIG_SANDBOX 885ac76badSSimon Glass struct led_gpio_priv *priv = dev_get_priv(dev); 895ac76badSSimon Glass 905ac76badSSimon Glass if (dm_gpio_is_valid(&priv->gpio)) 915ac76badSSimon Glass dm_gpio_free(dev, &priv->gpio); 923c43fba3SSimon Glass #endif 935ac76badSSimon Glass 945ac76badSSimon Glass return 0; 955ac76badSSimon Glass } 965ac76badSSimon Glass 975ac76badSSimon Glass static int led_gpio_bind(struct udevice *parent) 985ac76badSSimon Glass { 995ac76badSSimon Glass struct udevice *dev; 10045a26867SSimon Glass ofnode node; 1015ac76badSSimon Glass int ret; 1025ac76badSSimon Glass 10345a26867SSimon Glass dev_for_each_subnode(node, parent) { 10456e19871SSimon Glass struct led_uc_plat *uc_plat; 1055ac76badSSimon Glass const char *label; 1065ac76badSSimon Glass 10745a26867SSimon Glass label = ofnode_read_string(node, "label"); 1085ac76badSSimon Glass if (!label) { 1095ac76badSSimon Glass debug("%s: node %s has no label\n", __func__, 11045a26867SSimon Glass ofnode_get_name(node)); 1115ac76badSSimon Glass return -EINVAL; 1125ac76badSSimon Glass } 1135ac76badSSimon Glass ret = device_bind_driver_to_node(parent, "gpio_led", 11445a26867SSimon Glass ofnode_get_name(node), 1155ac76badSSimon Glass node, &dev); 1165ac76badSSimon Glass if (ret) 1175ac76badSSimon Glass return ret; 1185ac76badSSimon Glass uc_plat = dev_get_uclass_platdata(dev); 1195ac76badSSimon Glass uc_plat->label = label; 1205ac76badSSimon Glass } 1215ac76badSSimon Glass 1225ac76badSSimon Glass return 0; 1235ac76badSSimon Glass } 1245ac76badSSimon Glass 1255ac76badSSimon Glass static const struct led_ops gpio_led_ops = { 126ddae9fcdSSimon Glass .set_state = gpio_led_set_state, 1278f4b6123SSimon Glass .get_state = gpio_led_get_state, 1285ac76badSSimon Glass }; 1295ac76badSSimon Glass 1305ac76badSSimon Glass static const struct udevice_id led_gpio_ids[] = { 1315ac76badSSimon Glass { .compatible = "gpio-leds" }, 1325ac76badSSimon Glass { } 1335ac76badSSimon Glass }; 1345ac76badSSimon Glass 1355ac76badSSimon Glass U_BOOT_DRIVER(led_gpio) = { 1365ac76badSSimon Glass .name = "gpio_led", 1375ac76badSSimon Glass .id = UCLASS_LED, 1385ac76badSSimon Glass .of_match = led_gpio_ids, 1395ac76badSSimon Glass .ops = &gpio_led_ops, 1405ac76badSSimon Glass .priv_auto_alloc_size = sizeof(struct led_gpio_priv), 1415ac76badSSimon Glass .bind = led_gpio_bind, 1425ac76badSSimon Glass .probe = led_gpio_probe, 1435ac76badSSimon Glass .remove = led_gpio_remove, 1445ac76badSSimon Glass }; 145