drivers/gpio/gpio-uclass.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (c) 2013 Google, Inc
   4  */
   5
   6 #include <common.h>
   7 #include <dm.h>
   8 #include <dt-bindings/gpio/gpio.h>
   9 #include <errno.h>
  10 #include <fdtdec.h>
  11 #include <malloc.h>
  12 #include <asm/gpio.h>
  13 #include <linux/bug.h>
  14 #include <linux/ctype.h>
  15
  16 DECLARE_GLOBAL_DATA_PTR;
  17
  18 /**
  19  * gpio_to_device() - Convert global GPIO number to device, number
  20  *
  21  * Convert the GPIO number to an entry in the list of GPIOs
  22  * or GPIO blocks registered with the GPIO controller. Returns
  23  * entry on success, NULL on error.
  24  *
  25  * @gpio:       The numeric representation of the GPIO
  26  * @desc:       Returns description (desc->flags will always be 0)
  27  * @return 0 if found, -ENOENT if not found
  28  */
  29 static int gpio_to_device(unsigned int gpio, struct gpio_desc *desc)
  30 {
  31         struct gpio_dev_priv *uc_priv;
  32         struct udevice *dev;
  33         int ret;
  34
  35         for (ret = uclass_first_device(UCLASS_GPIO, &dev);
  36              dev;
  37              ret = uclass_next_device(&dev)) {
  38                 uc_priv = dev_get_uclass_priv(dev);
  39                 if (gpio >= uc_priv->gpio_base &&
  40                     gpio < uc_priv->gpio_base + uc_priv->gpio_count) {
  41                         desc->dev = dev;
  42                         desc->offset = gpio - uc_priv->gpio_base;
  43                         desc->flags = 0;
  44                         return 0;
  45                 }
  46         }
  47
  48         /* No such GPIO */
  49         return ret ? ret : -ENOENT;
  50 }
  51
  52 int dm_gpio_lookup_name(const char *name, struct gpio_desc *desc)
  53 {
  54         struct gpio_dev_priv *uc_priv = NULL;
  55         struct udevice *dev;
  56         ulong offset;
  57         int numeric;
  58         int ret;
  59
  60         numeric = isdigit(*name) ? simple_strtoul(name, NULL, 10) : -1;
  61         for (ret = uclass_first_device(UCLASS_GPIO, &dev);
  62              dev;
  63              ret = uclass_next_device(&dev)) {
  64                 int len;
  65
  66                 uc_priv = dev_get_uclass_priv(dev);
  67                 if (numeric != -1) {
  68                         offset = numeric - uc_priv->gpio_base;
  69                         /* Allow GPIOs to be numbered from 0 */
  70                         if (offset < uc_priv->gpio_count)
  71                                 break;
  72                 }
  73
  74                 len = uc_priv->bank_name ? strlen(uc_priv->bank_name) : 0;
  75
  76                 if (!strncasecmp(name, uc_priv->bank_name, len)) {
  77                         if (!strict_strtoul(name + len, 10, &offset))
  78                                 break;
  79                 }
  80         }
  81
  82         if (!dev)
  83                 return ret ? ret : -EINVAL;
  84
  85         desc->dev = dev;
  86         desc->offset = offset;
  87
  88         return 0;
  89 }
  90
  91 int gpio_lookup_name(const char *name, struct udevice **devp,
  92                      unsigned int *offsetp, unsigned int *gpiop)
  93 {
  94         struct gpio_desc desc;
  95         int ret;
  96
  97         if (devp)
  98                 *devp = NULL;
  99         ret = dm_gpio_lookup_name(name, &desc);
 100         if (ret)
 101                 return ret;
 102
 103         if (devp)
 104                 *devp = desc.dev;
 105         if (offsetp)
 106                 *offsetp = desc.offset;
 107         if (gpiop) {
 108                 struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(desc.dev);
 109
 110                 *gpiop = uc_priv->gpio_base + desc.offset;
 111         }
 112
 113         return 0;
 114 }
 115
 116 int gpio_xlate_offs_flags(struct udevice *dev, struct gpio_desc *desc,
 117                           struct ofnode_phandle_args *args)
 118 {
 119         if (args->args_count < 1)
 120                 return -EINVAL;
 121
 122         desc->offset = args->args[0];
 123
 124         if (args->args_count < 2)
 125                 return 0;
 126
 127         if (args->args[1] & GPIO_ACTIVE_LOW)
 128                 desc->flags = GPIOD_ACTIVE_LOW;
 129
 130         return 0;
 131 }
 132
 133 static int gpio_find_and_xlate(struct gpio_desc *desc,
 134                                struct ofnode_phandle_args *args)
 135 {
 136         struct dm_gpio_ops *ops = gpio_get_ops(desc->dev);
 137
 138         if (ops->xlate)
 139                 return ops->xlate(desc->dev, desc, args);
 140         else
 141                 return gpio_xlate_offs_flags(desc->dev, desc, args);
 142 }
 143
 144 int dm_gpio_request(struct gpio_desc *desc, const char *label)
 145 {
 146         struct udevice *dev = desc->dev;
 147         struct gpio_dev_priv *uc_priv;
 148         char *str;
 149         int ret;
 150
 151         uc_priv = dev_get_uclass_priv(dev);
 152         if (uc_priv->name[desc->offset])
 153                 return -EBUSY;
 154         str = strdup(label);
 155         if (!str)
 156                 return -ENOMEM;
 157         if (gpio_get_ops(dev)->request) {
 158                 ret = gpio_get_ops(dev)->request(dev, desc->offset, label);
 159                 if (ret) {
 160                         free(str);
 161                         return ret;
 162                 }
 163         }
 164         uc_priv->name[desc->offset] = str;
 165
 166         return 0;
 167 }
 168
 169 static int dm_gpio_requestf(struct gpio_desc *desc, const char *fmt, ...)
 170 {
 171 #if !defined(CONFIG_SPL_BUILD) || !defined(CONFIG_USE_TINY_PRINTF)
 172         va_list args;
 173         char buf[40];
 174
 175         va_start(args, fmt);
 176         vscnprintf(buf, sizeof(buf), fmt, args);
 177         va_end(args);
 178         return dm_gpio_request(desc, buf);
 179 #else
 180         return dm_gpio_request(desc, fmt);
 181 #endif
 182 }
 183
 184 /**
 185  * gpio_request() - [COMPAT] Request GPIO
 186  * gpio:        GPIO number
 187  * label:       Name for the requested GPIO
 188  *
 189  * The label is copied and allocated so the caller does not need to keep
 190  * the pointer around.
 191  *
 192  * This function implements the API that's compatible with current
 193  * GPIO API used in U-Boot. The request is forwarded to particular
 194  * GPIO driver. Returns 0 on success, negative value on error.
 195  */
 196 int gpio_request(unsigned gpio, const char *label)
 197 {
 198         struct gpio_desc desc;
 199         int ret;
 200
 201         ret = gpio_to_device(gpio, &desc);
 202         if (ret)
 203                 return ret;
 204
 205         return dm_gpio_request(&desc, label);
 206 }
 207
 208 /**
 209  * gpio_requestf() - [COMPAT] Request GPIO
 210  * @gpio:       GPIO number
 211  * @fmt:        Format string for the requested GPIO
 212  * @...:        Arguments for the printf() format string
 213  *
 214  * This function implements the API that's compatible with current
 215  * GPIO API used in U-Boot. The request is forwarded to particular
 216  * GPIO driver. Returns 0 on success, negative value on error.
 217  */
 218 int gpio_requestf(unsigned gpio, const char *fmt, ...)
 219 {
 220 #if !defined(CONFIG_SPL_BUILD) || !defined(CONFIG_USE_TINY_PRINTF)
 221         va_list args;
 222         char buf[40];
 223
 224         va_start(args, fmt);
 225         vscnprintf(buf, sizeof(buf), fmt, args);
 226         va_end(args);
 227         return gpio_request(gpio, buf);
 228 #else
 229         return gpio_request(gpio, fmt);
 230 #endif
 231 }
 232
 233 int _dm_gpio_free(struct udevice *dev, uint offset)
 234 {
 235         struct gpio_dev_priv *uc_priv;
 236         int ret;
 237
 238         uc_priv = dev_get_uclass_priv(dev);
 239         if (!uc_priv->name[offset])
 240                 return -ENXIO;
 241         if (gpio_get_ops(dev)->free) {
 242                 ret = gpio_get_ops(dev)->free(dev, offset);
 243                 if (ret)
 244                         return ret;
 245         }
 246
 247         free(uc_priv->name[offset]);
 248         uc_priv->name[offset] = NULL;
 249
 250         return 0;
 251 }
 252
 253 /**
 254  * gpio_free() - [COMPAT] Relinquish GPIO
 255  * gpio:        GPIO number
 256  *
 257  * This function implements the API that's compatible with current
 258  * GPIO API used in U-Boot. The request is forwarded to particular
 259  * GPIO driver. Returns 0 on success, negative value on error.
 260  */
 261 int gpio_free(unsigned gpio)
 262 {
 263         struct gpio_desc desc;
 264         int ret;
 265
 266         ret = gpio_to_device(gpio, &desc);
 267         if (ret)
 268                 return ret;
 269
 270         return _dm_gpio_free(desc.dev, desc.offset);
 271 }
 272
 273 static int check_reserved(const struct gpio_desc *desc, const char *func)
 274 {
 275         struct gpio_dev_priv *uc_priv;
 276
 277         if (!dm_gpio_is_valid(desc))
 278                 return -ENOENT;
 279
 280         uc_priv = dev_get_uclass_priv(desc->dev);
 281         if (!uc_priv->name[desc->offset]) {
 282                 printf("%s: %s: error: gpio %s%d not reserved\n",
 283                        desc->dev->name, func,
 284                        uc_priv->bank_name ? uc_priv->bank_name : "",
 285                        desc->offset);
 286                 return -EBUSY;
 287         }
 288
 289         return 0;
 290 }
 291
 292 /**
 293  * gpio_direction_input() - [COMPAT] Set GPIO direction to input
 294  * gpio:        GPIO number
 295  *
 296  * This function implements the API that's compatible with current
 297  * GPIO API used in U-Boot. The request is forwarded to particular
 298  * GPIO driver. Returns 0 on success, negative value on error.
 299  */
 300 int gpio_direction_input(unsigned gpio)
 301 {
 302         struct gpio_desc desc;
 303         int ret;
 304
 305         ret = gpio_to_device(gpio, &desc);
 306         if (ret)
 307                 return ret;
 308         ret = check_reserved(&desc, "dir_input");
 309         if (ret)
 310                 return ret;
 311
 312         return gpio_get_ops(desc.dev)->direction_input(desc.dev, desc.offset);
 313 }
 314
 315 /**
 316  * gpio_direction_output() - [COMPAT] Set GPIO direction to output and set value
 317  * gpio:        GPIO number
 318  * value:       Logical value to be set on the GPIO pin
 319  *
 320  * This function implements the API that's compatible with current
 321  * GPIO API used in U-Boot. The request is forwarded to particular
 322  * GPIO driver. Returns 0 on success, negative value on error.
 323  */
 324 int gpio_direction_output(unsigned gpio, int value)
 325 {
 326         struct gpio_desc desc;
 327         int ret;
 328
 329         ret = gpio_to_device(gpio, &desc);
 330         if (ret)
 331                 return ret;
 332         ret = check_reserved(&desc, "dir_output");
 333         if (ret)
 334                 return ret;
 335
 336         return gpio_get_ops(desc.dev)->direction_output(desc.dev,
 337                                                         desc.offset, value);
 338 }
 339
 340 int dm_gpio_get_value(const struct gpio_desc *desc)
 341 {
 342         int value;
 343         int ret;
 344
 345         ret = check_reserved(desc, "get_value");
 346         if (ret)
 347                 return ret;
 348
 349         value = gpio_get_ops(desc->dev)->get_value(desc->dev, desc->offset);
 350
 351         return desc->flags & GPIOD_ACTIVE_LOW ? !value : value;
 352 }
 353
 354 int dm_gpio_set_value(const struct gpio_desc *desc, int value)
 355 {
 356         int ret;
 357
 358         ret = check_reserved(desc, "set_value");
 359         if (ret)
 360                 return ret;
 361
 362         if (desc->flags & GPIOD_ACTIVE_LOW)
 363                 value = !value;
 364         gpio_get_ops(desc->dev)->set_value(desc->dev, desc->offset, value);
 365         return 0;
 366 }
 367
 368 int dm_gpio_get_open_drain(struct gpio_desc *desc)
 369 {
 370         struct dm_gpio_ops *ops = gpio_get_ops(desc->dev);
 371         int ret;
 372
 373         ret = check_reserved(desc, "get_open_drain");
 374         if (ret)
 375                 return ret;
 376
 377         if (ops->set_open_drain)
 378                 return ops->get_open_drain(desc->dev, desc->offset);
 379         else
 380                 return -ENOSYS;
 381 }
 382
 383 int dm_gpio_set_open_drain(struct gpio_desc *desc, int value)
 384 {
 385         struct dm_gpio_ops *ops = gpio_get_ops(desc->dev);
 386         int ret;
 387
 388         ret = check_reserved(desc, "set_open_drain");
 389         if (ret)
 390                 return ret;
 391
 392         if (ops->set_open_drain)
 393                 ret = ops->set_open_drain(desc->dev, desc->offset, value);
 394         else
 395                 return 0; /* feature not supported -> ignore setting */
 396
 397         return ret;
 398 }
 399
 400 int dm_gpio_set_dir_flags(struct gpio_desc *desc, ulong flags)
 401 {
 402         struct udevice *dev = desc->dev;
 403         struct dm_gpio_ops *ops = gpio_get_ops(dev);
 404         int ret;
 405
 406         ret = check_reserved(desc, "set_dir");
 407         if (ret)
 408                 return ret;
 409
 410         if (flags & GPIOD_IS_OUT) {
 411                 int value = flags & GPIOD_IS_OUT_ACTIVE ? 1 : 0;
 412
 413                 if (flags & GPIOD_ACTIVE_LOW)
 414                         value = !value;
 415                 ret = ops->direction_output(dev, desc->offset, value);
 416         } else  if (flags & GPIOD_IS_IN) {
 417                 ret = ops->direction_input(dev, desc->offset);
 418         }
 419         if (ret)
 420                 return ret;
 421         /*
 422          * Update desc->flags here, so that GPIO_ACTIVE_LOW is honoured in
 423          * futures
 424          */
 425         desc->flags = flags;
 426
 427         return 0;
 428 }
 429
 430 int dm_gpio_set_dir(struct gpio_desc *desc)
 431 {
 432         return dm_gpio_set_dir_flags(desc, desc->flags);
 433 }
 434
 435 /**
 436  * gpio_get_value() - [COMPAT] Sample GPIO pin and return it's value
 437  * gpio:        GPIO number
 438  *
 439  * This function implements the API that's compatible with current
 440  * GPIO API used in U-Boot. The request is forwarded to particular
 441  * GPIO driver. Returns the value of the GPIO pin, or negative value
 442  * on error.
 443  */
 444 int gpio_get_value(unsigned gpio)
 445 {
 446         int ret;
 447
 448         struct gpio_desc desc;
 449
 450         ret = gpio_to_device(gpio, &desc);
 451         if (ret)
 452                 return ret;
 453         return dm_gpio_get_value(&desc);
 454 }
 455
 456 /**
 457  * gpio_set_value() - [COMPAT] Configure logical value on GPIO pin
 458  * gpio:        GPIO number
 459  * value:       Logical value to be set on the GPIO pin.
 460  *
 461  * This function implements the API that's compatible with current
 462  * GPIO API used in U-Boot. The request is forwarded to particular
 463  * GPIO driver. Returns 0 on success, negative value on error.
 464  */
 465 int gpio_set_value(unsigned gpio, int value)
 466 {
 467         struct gpio_desc desc;
 468         int ret;
 469
 470         ret = gpio_to_device(gpio, &desc);
 471         if (ret)
 472                 return ret;
 473         return dm_gpio_set_value(&desc, value);
 474 }
 475
 476 const char *gpio_get_bank_info(struct udevice *dev, int *bit_count)
 477 {
 478         struct gpio_dev_priv *priv;
 479
 480         /* Must be called on an active device */
 481         priv = dev_get_uclass_priv(dev);
 482         assert(priv);
 483
 484         *bit_count = priv->gpio_count;
 485         return priv->bank_name;
 486 }
 487
 488 static const char * const gpio_function[GPIOF_COUNT] = {
 489         "input",
 490         "output",
 491         "unused",
 492         "unknown",
 493         "func",
 494 };
 495
 496 static int get_function(struct udevice *dev, int offset, bool skip_unused,
 497                         const char **namep)
 498 {
 499         struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
 500         struct dm_gpio_ops *ops = gpio_get_ops(dev);
 501
 502         BUILD_BUG_ON(GPIOF_COUNT != ARRAY_SIZE(gpio_function));
 503         if (!device_active(dev))
 504                 return -ENODEV;
 505         if (offset < 0 || offset >= uc_priv->gpio_count)
 506                 return -EINVAL;
 507         if (namep)
 508                 *namep = uc_priv->name[offset];
 509         if (skip_unused && !uc_priv->name[offset])
 510                 return GPIOF_UNUSED;
 511         if (ops->get_function) {
 512                 int ret;
 513
 514                 ret = ops->get_function(dev, offset);
 515                 if (ret < 0)
 516                         return ret;
 517                 if (ret >= ARRAY_SIZE(gpio_function))
 518                         return -ENODATA;
 519                 return ret;
 520         }
 521
 522         return GPIOF_UNKNOWN;
 523 }
 524
 525 int gpio_get_function(struct udevice *dev, int offset, const char **namep)
 526 {
 527         return get_function(dev, offset, true, namep);
 528 }
 529
 530 int gpio_get_raw_function(struct udevice *dev, int offset, const char **namep)
 531 {
 532         return get_function(dev, offset, false, namep);
 533 }
 534
 535 int gpio_get_status(struct udevice *dev, int offset, char *buf, int buffsize)
 536 {
 537         struct dm_gpio_ops *ops = gpio_get_ops(dev);
 538         struct gpio_dev_priv *priv;
 539         char *str = buf;
 540         int func;
 541         int ret;
 542         int len;
 543
 544         BUILD_BUG_ON(GPIOF_COUNT != ARRAY_SIZE(gpio_function));
 545
 546         *buf = 0;
 547         priv = dev_get_uclass_priv(dev);
 548         ret = gpio_get_raw_function(dev, offset, NULL);
 549         if (ret < 0)
 550                 return ret;
 551         func = ret;
 552         len = snprintf(str, buffsize, "%s%d: %s",
 553                        priv->bank_name ? priv->bank_name : "",
 554                        offset, gpio_function[func]);
 555         if (func == GPIOF_INPUT || func == GPIOF_OUTPUT ||
 556             func == GPIOF_UNUSED) {
 557                 const char *label;
 558                 bool used;
 559
 560                 ret = ops->get_value(dev, offset);
 561                 if (ret < 0)
 562                         return ret;
 563                 used = gpio_get_function(dev, offset, &label) != GPIOF_UNUSED;
 564                 snprintf(str + len, buffsize - len, ": %d [%c]%s%s",
 565                          ret,
 566                          used ? 'x' : ' ',
 567                          used ? " " : "",
 568                          label ? label : "");
 569         }
 570
 571         return 0;
 572 }
 573
 574 int gpio_claim_vector(const int *gpio_num_array, const char *fmt)
 575 {
 576         int i, ret;
 577         int gpio;
 578
 579         for (i = 0; i < 32; i++) {
 580                 gpio = gpio_num_array[i];
 581                 if (gpio == -1)
 582                         break;
 583                 ret = gpio_requestf(gpio, fmt, i);
 584                 if (ret)
 585                         goto err;
 586                 ret = gpio_direction_input(gpio);
 587                 if (ret) {
 588                         gpio_free(gpio);
 589                         goto err;
 590                 }
 591         }
 592
 593         return 0;
 594 err:
 595         for (i--; i >= 0; i--)
 596                 gpio_free(gpio_num_array[i]);
 597
 598         return ret;
 599 }
 600
 601 /*
 602  * get a number comprised of multiple GPIO values. gpio_num_array points to
 603  * the array of gpio pin numbers to scan, terminated by -1.
 604  */
 605 int gpio_get_values_as_int(const int *gpio_list)
 606 {
 607         int gpio;
 608         unsigned bitmask = 1;
 609         unsigned vector = 0;
 610         int ret;
 611
 612         while (bitmask &&
 613                ((gpio = *gpio_list++) != -1)) {
 614                 ret = gpio_get_value(gpio);
 615                 if (ret < 0)
 616                         return ret;
 617                 else if (ret)
 618                         vector |= bitmask;
 619                 bitmask <<= 1;
 620         }
 621
 622         return vector;
 623 }
 624
 625 int dm_gpio_get_values_as_int(const struct gpio_desc *desc_list, int count)
 626 {
 627         unsigned bitmask = 1;
 628         unsigned vector = 0;
 629         int ret, i;
 630
 631         for (i = 0; i < count; i++) {
 632                 ret = dm_gpio_get_value(&desc_list[i]);
 633                 if (ret < 0)
 634                         return ret;
 635                 else if (ret)
 636                         vector |= bitmask;
 637                 bitmask <<= 1;
 638         }
 639
 640         return vector;
 641 }
 642
 643 static int gpio_request_tail(int ret, ofnode node,
 644                              struct ofnode_phandle_args *args,
 645                              const char *list_name, int index,
 646                              struct gpio_desc *desc, int flags, bool add_index)
 647 {
 648         desc->dev = NULL;
 649         desc->offset = 0;
 650         desc->flags = 0;
 651         if (ret)
 652                 goto err;
 653
 654         ret = uclass_get_device_by_ofnode(UCLASS_GPIO, args->node,
 655                                           &desc->dev);
 656         if (ret) {
 657                 debug("%s: uclass_get_device_by_ofnode failed\n", __func__);
 658                 goto err;
 659         }
 660         ret = gpio_find_and_xlate(desc, args);
 661         if (ret) {
 662                 debug("%s: gpio_find_and_xlate failed\n", __func__);
 663                 goto err;
 664         }
 665         ret = dm_gpio_requestf(desc, add_index ? "%s.%s%d" : "%s.%s",
 666                                ofnode_get_name(node),
 667                                list_name, index);
 668         if (ret) {
 669                 debug("%s: dm_gpio_requestf failed\n", __func__);
 670                 goto err;
 671         }
 672         ret = dm_gpio_set_dir_flags(desc, flags | desc->flags);
 673         if (ret) {
 674                 debug("%s: dm_gpio_set_dir failed\n", __func__);
 675                 goto err;
 676         }
 677
 678         return 0;
 679 err:
 680         debug("%s: Node '%s', property '%s', failed to request GPIO index %d: %d\n",
 681               __func__, ofnode_get_name(node), list_name, index, ret);
 682         return ret;
 683 }
 684
 685 static int _gpio_request_by_name_nodev(ofnode node, const char *list_name,
 686                                        int index, struct gpio_desc *desc,
 687                                        int flags, bool add_index)
 688 {
 689         struct ofnode_phandle_args args;
 690         int ret;
 691
 692         ret = ofnode_parse_phandle_with_args(node, list_name, "#gpio-cells", 0,
 693                                              index, &args);
 694
 695         return gpio_request_tail(ret, node, &args, list_name, index, desc,
 696                                  flags, add_index);
 697 }
 698
 699 int gpio_request_by_name_nodev(ofnode node, const char *list_name, int index,
 700                                struct gpio_desc *desc, int flags)
 701 {
 702         return _gpio_request_by_name_nodev(node, list_name, index, desc, flags,
 703                                            index > 0);
 704 }
 705
 706 int gpio_request_by_name(struct udevice *dev, const char *list_name, int index,
 707                          struct gpio_desc *desc, int flags)
 708 {
 709         struct ofnode_phandle_args args;
 710         int ret;
 711
 712         ret = dev_read_phandle_with_args(dev, list_name, "#gpio-cells", 0,
 713                                          index, &args);
 714
 715         return gpio_request_tail(ret, dev_ofnode(dev), &args, list_name,
 716                                  index, desc, flags, index > 0);
 717 }
 718
 719 int gpio_request_list_by_name_nodev(ofnode node, const char *list_name,
 720                                     struct gpio_desc *desc, int max_count,
 721                                     int flags)
 722 {
 723         int count;
 724         int ret;
 725
 726         for (count = 0; count < max_count; count++) {
 727                 ret = _gpio_request_by_name_nodev(node, list_name, count,
 728                                                   &desc[count], flags, true);
 729                 if (ret == -ENOENT)
 730                         break;
 731                 else if (ret)
 732                         goto err;
 733         }
 734
 735         /* We ran out of GPIOs in the list */
 736         return count;
 737
 738 err:
 739         gpio_free_list_nodev(desc, count - 1);
 740
 741         return ret;
 742 }
 743
 744 int gpio_request_list_by_name(struct udevice *dev, const char *list_name,
 745                               struct gpio_desc *desc, int max_count,
 746                               int flags)
 747 {
 748         /*
 749          * This isn't ideal since we don't use dev->name in the debug()
 750          * calls in gpio_request_by_name(), but we can do this until
 751          * gpio_request_list_by_name_nodev() can be dropped.
 752          */
 753         return gpio_request_list_by_name_nodev(dev_ofnode(dev), list_name, desc,
 754                                                max_count, flags);
 755 }
 756
 757 int gpio_get_list_count(struct udevice *dev, const char *list_name)
 758 {
 759         int ret;
 760
 761         ret = fdtdec_parse_phandle_with_args(gd->fdt_blob, dev_of_offset(dev),
 762                                              list_name, "#gpio-cells", 0, -1,
 763                                              NULL);
 764         if (ret) {
 765                 debug("%s: Node '%s', property '%s', GPIO count failed: %d\n",
 766                       __func__, dev->name, list_name, ret);
 767         }
 768
 769         return ret;
 770 }
 771
 772 int dm_gpio_free(struct udevice *dev, struct gpio_desc *desc)
 773 {
 774         /* For now, we don't do any checking of dev */
 775         return _dm_gpio_free(desc->dev, desc->offset);
 776 }
 777
 778 int gpio_free_list(struct udevice *dev, struct gpio_desc *desc, int count)
 779 {
 780         int i;
 781
 782         /* For now, we don't do any checking of dev */
 783         for (i = 0; i < count; i++)
 784                 dm_gpio_free(dev, &desc[i]);
 785
 786         return 0;
 787 }
 788
 789 int gpio_free_list_nodev(struct gpio_desc *desc, int count)
 790 {
 791         return gpio_free_list(NULL, desc, count);
 792 }
 793
 794 /* We need to renumber the GPIOs when any driver is probed/removed */
 795 static int gpio_renumber(struct udevice *removed_dev)
 796 {
 797         struct gpio_dev_priv *uc_priv;
 798         struct udevice *dev;
 799         struct uclass *uc;
 800         unsigned base;
 801         int ret;
 802
 803         ret = uclass_get(UCLASS_GPIO, &uc);
 804         if (ret)
 805                 return ret;
 806
 807         /* Ensure that we have a base for each bank */
 808         base = 0;
 809         uclass_foreach_dev(dev, uc) {
 810                 if (device_active(dev) && dev != removed_dev) {
 811                         uc_priv = dev_get_uclass_priv(dev);
 812                         uc_priv->gpio_base = base;
 813                         base += uc_priv->gpio_count;
 814                 }
 815         }
 816
 817         return 0;
 818 }
 819
 820 int gpio_get_number(const struct gpio_desc *desc)
 821 {
 822         struct udevice *dev = desc->dev;
 823         struct gpio_dev_priv *uc_priv;
 824
 825         if (!dev)
 826                 return -1;
 827         uc_priv = dev->uclass_priv;
 828
 829         return uc_priv->gpio_base + desc->offset;
 830 }
 831
 832 static int gpio_post_probe(struct udevice *dev)
 833 {
 834         struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
 835
 836         uc_priv->name = calloc(uc_priv->gpio_count, sizeof(char *));
 837         if (!uc_priv->name)
 838                 return -ENOMEM;
 839
 840         return gpio_renumber(NULL);
 841 }
 842
 843 static int gpio_pre_remove(struct udevice *dev)
 844 {
 845         struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
 846         int i;
 847
 848         for (i = 0; i < uc_priv->gpio_count; i++) {
 849                 if (uc_priv->name[i])
 850                         free(uc_priv->name[i]);
 851         }
 852         free(uc_priv->name);
 853
 854         return gpio_renumber(dev);
 855 }
 856
 857 UCLASS_DRIVER(gpio) = {
 858         .id             = UCLASS_GPIO,
 859         .name           = "gpio",
 860         .flags          = DM_UC_FLAG_SEQ_ALIAS,
 861         .post_probe     = gpio_post_probe,
 862         .pre_remove     = gpio_pre_remove,
 863         .per_device_auto_alloc_size = sizeof(struct gpio_dev_priv),
 864 };