drivers/gpio/gpio-tegra186.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (c) 2016-2017 NVIDIA Corporation
   4  *
   5  * Author: Thierry Reding <treding@nvidia.com>
   6  */
   7
   8 #include <linux/gpio/driver.h>
   9 #include <linux/interrupt.h>
  10 #include <linux/irq.h>
  11 #include <linux/module.h>
  12 #include <linux/of_device.h>
  13 #include <linux/platform_device.h>
  14
  15 #include <dt-bindings/gpio/tegra186-gpio.h>
  16 #include <dt-bindings/gpio/tegra194-gpio.h>
  17
  18 /* security registers */
  19 #define TEGRA186_GPIO_CTL_SCR 0x0c
  20 #define  TEGRA186_GPIO_CTL_SCR_SEC_WEN BIT(28)
  21 #define  TEGRA186_GPIO_CTL_SCR_SEC_REN BIT(27)
  22
  23 #define TEGRA186_GPIO_INT_ROUTE_MAPPING(p, x) (0x14 + (p) * 0x20 + (x) * 4)
  24
  25 /* control registers */
  26 #define TEGRA186_GPIO_ENABLE_CONFIG 0x00
  27 #define  TEGRA186_GPIO_ENABLE_CONFIG_ENABLE BIT(0)
  28 #define  TEGRA186_GPIO_ENABLE_CONFIG_OUT BIT(1)
  29 #define  TEGRA186_GPIO_ENABLE_CONFIG_TRIGGER_TYPE_NONE (0x0 << 2)
  30 #define  TEGRA186_GPIO_ENABLE_CONFIG_TRIGGER_TYPE_LEVEL (0x1 << 2)
  31 #define  TEGRA186_GPIO_ENABLE_CONFIG_TRIGGER_TYPE_SINGLE_EDGE (0x2 << 2)
  32 #define  TEGRA186_GPIO_ENABLE_CONFIG_TRIGGER_TYPE_DOUBLE_EDGE (0x3 << 2)
  33 #define  TEGRA186_GPIO_ENABLE_CONFIG_TRIGGER_TYPE_MASK (0x3 << 2)
  34 #define  TEGRA186_GPIO_ENABLE_CONFIG_TRIGGER_LEVEL BIT(4)
  35 #define  TEGRA186_GPIO_ENABLE_CONFIG_DEBOUNCE BIT(5)
  36 #define  TEGRA186_GPIO_ENABLE_CONFIG_INTERRUPT BIT(6)
  37
  38 #define TEGRA186_GPIO_DEBOUNCE_CONTROL 0x04
  39 #define  TEGRA186_GPIO_DEBOUNCE_CONTROL_THRESHOLD(x) ((x) & 0xff)
  40
  41 #define TEGRA186_GPIO_INPUT 0x08
  42 #define  TEGRA186_GPIO_INPUT_HIGH BIT(0)
  43
  44 #define TEGRA186_GPIO_OUTPUT_CONTROL 0x0c
  45 #define  TEGRA186_GPIO_OUTPUT_CONTROL_FLOATED BIT(0)
  46
  47 #define TEGRA186_GPIO_OUTPUT_VALUE 0x10
  48 #define  TEGRA186_GPIO_OUTPUT_VALUE_HIGH BIT(0)
  49
  50 #define TEGRA186_GPIO_INTERRUPT_CLEAR 0x14
  51
  52 #define TEGRA186_GPIO_INTERRUPT_STATUS(x) (0x100 + (x) * 4)
  53
  54 struct tegra_gpio_port {
  55         const char *name;
  56         unsigned int bank;
  57         unsigned int port;
  58         unsigned int pins;
  59 };
  60
  61 struct tegra_gpio_soc {
  62         const struct tegra_gpio_port *ports;
  63         unsigned int num_ports;
  64         const char *name;
  65         unsigned int instance;
  66 };
  67
  68 struct tegra_gpio {
  69         struct gpio_chip gpio;
  70         struct irq_chip intc;
  71         unsigned int num_irq;
  72         unsigned int *irq;
  73
  74         const struct tegra_gpio_soc *soc;
  75
  76         void __iomem *secure;
  77         void __iomem *base;
  78 };
  79
  80 static const struct tegra_gpio_port *
  81 tegra186_gpio_get_port(struct tegra_gpio *gpio, unsigned int *pin)
  82 {
  83         unsigned int start = 0, i;
  84
  85         for (i = 0; i < gpio->soc->num_ports; i++) {
  86                 const struct tegra_gpio_port *port = &gpio->soc->ports[i];
  87
  88                 if (*pin >= start && *pin < start + port->pins) {
  89                         *pin -= start;
  90                         return port;
  91                 }
  92
  93                 start += port->pins;
  94         }
  95
  96         return NULL;
  97 }
  98
  99 static void __iomem *tegra186_gpio_get_base(struct tegra_gpio *gpio,
 100                                             unsigned int pin)
 101 {
 102         const struct tegra_gpio_port *port;
 103         unsigned int offset;
 104
 105         port = tegra186_gpio_get_port(gpio, &pin);
 106         if (!port)
 107                 return NULL;
 108
 109         offset = port->bank * 0x1000 + port->port * 0x200;
 110
 111         return gpio->base + offset + pin * 0x20;
 112 }
 113
 114 static int tegra186_gpio_get_direction(struct gpio_chip *chip,
 115                                        unsigned int offset)
 116 {
 117         struct tegra_gpio *gpio = gpiochip_get_data(chip);
 118         void __iomem *base;
 119         u32 value;
 120
 121         base = tegra186_gpio_get_base(gpio, offset);
 122         if (WARN_ON(base == NULL))
 123                 return -ENODEV;
 124
 125         value = readl(base + TEGRA186_GPIO_ENABLE_CONFIG);
 126         if (value & TEGRA186_GPIO_ENABLE_CONFIG_OUT)
 127                 return GPIO_LINE_DIRECTION_OUT;
 128
 129         return GPIO_LINE_DIRECTION_IN;
 130 }
 131
 132 static int tegra186_gpio_direction_input(struct gpio_chip *chip,
 133                                          unsigned int offset)
 134 {
 135         struct tegra_gpio *gpio = gpiochip_get_data(chip);
 136         void __iomem *base;
 137         u32 value;
 138
 139         base = tegra186_gpio_get_base(gpio, offset);
 140         if (WARN_ON(base == NULL))
 141                 return -ENODEV;
 142
 143         value = readl(base + TEGRA186_GPIO_OUTPUT_CONTROL);
 144         value |= TEGRA186_GPIO_OUTPUT_CONTROL_FLOATED;
 145         writel(value, base + TEGRA186_GPIO_OUTPUT_CONTROL);
 146
 147         value = readl(base + TEGRA186_GPIO_ENABLE_CONFIG);
 148         value |= TEGRA186_GPIO_ENABLE_CONFIG_ENABLE;
 149         value &= ~TEGRA186_GPIO_ENABLE_CONFIG_OUT;
 150         writel(value, base + TEGRA186_GPIO_ENABLE_CONFIG);
 151
 152         return 0;
 153 }
 154
 155 static int tegra186_gpio_direction_output(struct gpio_chip *chip,
 156                                           unsigned int offset, int level)
 157 {
 158         struct tegra_gpio *gpio = gpiochip_get_data(chip);
 159         void __iomem *base;
 160         u32 value;
 161
 162         /* configure output level first */
 163         chip->set(chip, offset, level);
 164
 165         base = tegra186_gpio_get_base(gpio, offset);
 166         if (WARN_ON(base == NULL))
 167                 return -EINVAL;
 168
 169         /* set the direction */
 170         value = readl(base + TEGRA186_GPIO_OUTPUT_CONTROL);
 171         value &= ~TEGRA186_GPIO_OUTPUT_CONTROL_FLOATED;
 172         writel(value, base + TEGRA186_GPIO_OUTPUT_CONTROL);
 173
 174         value = readl(base + TEGRA186_GPIO_ENABLE_CONFIG);
 175         value |= TEGRA186_GPIO_ENABLE_CONFIG_ENABLE;
 176         value |= TEGRA186_GPIO_ENABLE_CONFIG_OUT;
 177         writel(value, base + TEGRA186_GPIO_ENABLE_CONFIG);
 178
 179         return 0;
 180 }
 181
 182 static int tegra186_gpio_get(struct gpio_chip *chip, unsigned int offset)
 183 {
 184         struct tegra_gpio *gpio = gpiochip_get_data(chip);
 185         void __iomem *base;
 186         u32 value;
 187
 188         base = tegra186_gpio_get_base(gpio, offset);
 189         if (WARN_ON(base == NULL))
 190                 return -ENODEV;
 191
 192         value = readl(base + TEGRA186_GPIO_ENABLE_CONFIG);
 193         if (value & TEGRA186_GPIO_ENABLE_CONFIG_OUT)
 194                 value = readl(base + TEGRA186_GPIO_OUTPUT_VALUE);
 195         else
 196                 value = readl(base + TEGRA186_GPIO_INPUT);
 197
 198         return value & BIT(0);
 199 }
 200
 201 static void tegra186_gpio_set(struct gpio_chip *chip, unsigned int offset,
 202                               int level)
 203 {
 204         struct tegra_gpio *gpio = gpiochip_get_data(chip);
 205         void __iomem *base;
 206         u32 value;
 207
 208         base = tegra186_gpio_get_base(gpio, offset);
 209         if (WARN_ON(base == NULL))
 210                 return;
 211
 212         value = readl(base + TEGRA186_GPIO_OUTPUT_VALUE);
 213         if (level == 0)
 214                 value &= ~TEGRA186_GPIO_OUTPUT_VALUE_HIGH;
 215         else
 216                 value |= TEGRA186_GPIO_OUTPUT_VALUE_HIGH;
 217
 218         writel(value, base + TEGRA186_GPIO_OUTPUT_VALUE);
 219 }
 220
 221 static int tegra186_gpio_set_config(struct gpio_chip *chip,
 222                                     unsigned int offset,
 223                                     unsigned long config)
 224 {
 225         struct tegra_gpio *gpio = gpiochip_get_data(chip);
 226         u32 debounce, value;
 227         void __iomem *base;
 228
 229         base = tegra186_gpio_get_base(gpio, offset);
 230         if (base == NULL)
 231                 return -ENXIO;
 232
 233         if (pinconf_to_config_param(config) != PIN_CONFIG_INPUT_DEBOUNCE)
 234                 return -ENOTSUPP;
 235
 236         debounce = pinconf_to_config_argument(config);
 237
 238         /*
 239          * The Tegra186 GPIO controller supports a maximum of 255 ms debounce
 240          * time.
 241          */
 242         if (debounce > 255000)
 243                 return -EINVAL;
 244
 245         debounce = DIV_ROUND_UP(debounce, USEC_PER_MSEC);
 246
 247         value = TEGRA186_GPIO_DEBOUNCE_CONTROL_THRESHOLD(debounce);
 248         writel(value, base + TEGRA186_GPIO_DEBOUNCE_CONTROL);
 249
 250         value = readl(base + TEGRA186_GPIO_ENABLE_CONFIG);
 251         value |= TEGRA186_GPIO_ENABLE_CONFIG_DEBOUNCE;
 252         writel(value, base + TEGRA186_GPIO_ENABLE_CONFIG);
 253
 254         return 0;
 255 }
 256
 257 static int tegra186_gpio_of_xlate(struct gpio_chip *chip,
 258                                   const struct of_phandle_args *spec,
 259                                   u32 *flags)
 260 {
 261         struct tegra_gpio *gpio = gpiochip_get_data(chip);
 262         unsigned int port, pin, i, offset = 0;
 263
 264         if (WARN_ON(chip->of_gpio_n_cells < 2))
 265                 return -EINVAL;
 266
 267         if (WARN_ON(spec->args_count < chip->of_gpio_n_cells))
 268                 return -EINVAL;
 269
 270         port = spec->args[0] / 8;
 271         pin = spec->args[0] % 8;
 272
 273         if (port >= gpio->soc->num_ports) {
 274                 dev_err(chip->parent, "invalid port number: %u\n", port);
 275                 return -EINVAL;
 276         }
 277
 278         for (i = 0; i < port; i++)
 279                 offset += gpio->soc->ports[i].pins;
 280
 281         if (flags)
 282                 *flags = spec->args[1];
 283
 284         return offset + pin;
 285 }
 286
 287 static void tegra186_irq_ack(struct irq_data *data)
 288 {
 289         struct tegra_gpio *gpio = irq_data_get_irq_chip_data(data);
 290         void __iomem *base;
 291
 292         base = tegra186_gpio_get_base(gpio, data->hwirq);
 293         if (WARN_ON(base == NULL))
 294                 return;
 295
 296         writel(1, base + TEGRA186_GPIO_INTERRUPT_CLEAR);
 297 }
 298
 299 static void tegra186_irq_mask(struct irq_data *data)
 300 {
 301         struct tegra_gpio *gpio = irq_data_get_irq_chip_data(data);
 302         void __iomem *base;
 303         u32 value;
 304
 305         base = tegra186_gpio_get_base(gpio, data->hwirq);
 306         if (WARN_ON(base == NULL))
 307                 return;
 308
 309         value = readl(base + TEGRA186_GPIO_ENABLE_CONFIG);
 310         value &= ~TEGRA186_GPIO_ENABLE_CONFIG_INTERRUPT;
 311         writel(value, base + TEGRA186_GPIO_ENABLE_CONFIG);
 312 }
 313
 314 static void tegra186_irq_unmask(struct irq_data *data)
 315 {
 316         struct tegra_gpio *gpio = irq_data_get_irq_chip_data(data);
 317         void __iomem *base;
 318         u32 value;
 319
 320         base = tegra186_gpio_get_base(gpio, data->hwirq);
 321         if (WARN_ON(base == NULL))
 322                 return;
 323
 324         value = readl(base + TEGRA186_GPIO_ENABLE_CONFIG);
 325         value |= TEGRA186_GPIO_ENABLE_CONFIG_INTERRUPT;
 326         writel(value, base + TEGRA186_GPIO_ENABLE_CONFIG);
 327 }
 328
 329 static int tegra186_irq_set_type(struct irq_data *data, unsigned int type)
 330 {
 331         struct tegra_gpio *gpio = irq_data_get_irq_chip_data(data);
 332         void __iomem *base;
 333         u32 value;
 334
 335         base = tegra186_gpio_get_base(gpio, data->hwirq);
 336         if (WARN_ON(base == NULL))
 337                 return -ENODEV;
 338
 339         value = readl(base + TEGRA186_GPIO_ENABLE_CONFIG);
 340         value &= ~TEGRA186_GPIO_ENABLE_CONFIG_TRIGGER_TYPE_MASK;
 341         value &= ~TEGRA186_GPIO_ENABLE_CONFIG_TRIGGER_LEVEL;
 342
 343         switch (type & IRQ_TYPE_SENSE_MASK) {
 344         case IRQ_TYPE_NONE:
 345                 break;
 346
 347         case IRQ_TYPE_EDGE_RISING:
 348                 value |= TEGRA186_GPIO_ENABLE_CONFIG_TRIGGER_TYPE_SINGLE_EDGE;
 349                 value |= TEGRA186_GPIO_ENABLE_CONFIG_TRIGGER_LEVEL;
 350                 break;
 351
 352         case IRQ_TYPE_EDGE_FALLING:
 353                 value |= TEGRA186_GPIO_ENABLE_CONFIG_TRIGGER_TYPE_SINGLE_EDGE;
 354                 break;
 355
 356         case IRQ_TYPE_EDGE_BOTH:
 357                 value |= TEGRA186_GPIO_ENABLE_CONFIG_TRIGGER_TYPE_DOUBLE_EDGE;
 358                 break;
 359
 360         case IRQ_TYPE_LEVEL_HIGH:
 361                 value |= TEGRA186_GPIO_ENABLE_CONFIG_TRIGGER_TYPE_LEVEL;
 362                 value |= TEGRA186_GPIO_ENABLE_CONFIG_TRIGGER_LEVEL;
 363                 break;
 364
 365         case IRQ_TYPE_LEVEL_LOW:
 366                 value |= TEGRA186_GPIO_ENABLE_CONFIG_TRIGGER_TYPE_LEVEL;
 367                 break;
 368
 369         default:
 370                 return -EINVAL;
 371         }
 372
 373         writel(value, base + TEGRA186_GPIO_ENABLE_CONFIG);
 374
 375         if ((type & IRQ_TYPE_EDGE_BOTH) == 0)
 376                 irq_set_handler_locked(data, handle_level_irq);
 377         else
 378                 irq_set_handler_locked(data, handle_edge_irq);
 379
 380         return irq_chip_set_type_parent(data, type);
 381 }
 382
 383 static void tegra186_gpio_irq(struct irq_desc *desc)
 384 {
 385         struct tegra_gpio *gpio = irq_desc_get_handler_data(desc);
 386         struct irq_domain *domain = gpio->gpio.irq.domain;
 387         struct irq_chip *chip = irq_desc_get_chip(desc);
 388         unsigned int parent = irq_desc_get_irq(desc);
 389         unsigned int i, offset = 0;
 390
 391         chained_irq_enter(chip, desc);
 392
 393         for (i = 0; i < gpio->soc->num_ports; i++) {
 394                 const struct tegra_gpio_port *port = &gpio->soc->ports[i];
 395                 unsigned int pin, irq;
 396                 unsigned long value;
 397                 void __iomem *base;
 398
 399                 base = gpio->base + port->bank * 0x1000 + port->port * 0x200;
 400
 401                 /* skip ports that are not associated with this bank */
 402                 if (parent != gpio->irq[port->bank])
 403                         goto skip;
 404
 405                 value = readl(base + TEGRA186_GPIO_INTERRUPT_STATUS(1));
 406
 407                 for_each_set_bit(pin, &value, port->pins) {
 408                         irq = irq_find_mapping(domain, offset + pin);
 409                         if (WARN_ON(irq == 0))
 410                                 continue;
 411
 412                         generic_handle_irq(irq);
 413                 }
 414
 415 skip:
 416                 offset += port->pins;
 417         }
 418
 419         chained_irq_exit(chip, desc);
 420 }
 421
 422 static int tegra186_gpio_irq_domain_translate(struct irq_domain *domain,
 423                                               struct irq_fwspec *fwspec,
 424                                               unsigned long *hwirq,
 425                                               unsigned int *type)
 426 {
 427         struct tegra_gpio *gpio = gpiochip_get_data(domain->host_data);
 428         unsigned int port, pin, i, offset = 0;
 429
 430         if (WARN_ON(gpio->gpio.of_gpio_n_cells < 2))
 431                 return -EINVAL;
 432
 433         if (WARN_ON(fwspec->param_count < gpio->gpio.of_gpio_n_cells))
 434                 return -EINVAL;
 435
 436         port = fwspec->param[0] / 8;
 437         pin = fwspec->param[0] % 8;
 438
 439         if (port >= gpio->soc->num_ports)
 440                 return -EINVAL;
 441
 442         for (i = 0; i < port; i++)
 443                 offset += gpio->soc->ports[i].pins;
 444
 445         *type = fwspec->param[1] & IRQ_TYPE_SENSE_MASK;
 446         *hwirq = offset + pin;
 447
 448         return 0;
 449 }
 450
 451 static void tegra186_gpio_populate_parent_fwspec(struct gpio_chip *chip,
 452                                                  struct irq_fwspec *fwspec,
 453                                                  unsigned int parent_hwirq,
 454                                                  unsigned int parent_type)
 455 {
 456         struct tegra_gpio *gpio = gpiochip_get_data(chip);
 457
 458         fwspec->param_count = 3;
 459         fwspec->param[0] = gpio->soc->instance;
 460         fwspec->param[1] = parent_hwirq;
 461         fwspec->param[2] = parent_type;
 462 }
 463
 464 static int tegra186_gpio_child_to_parent_hwirq(struct gpio_chip *chip,
 465                                                unsigned int hwirq,
 466                                                unsigned int type,
 467                                                unsigned int *parent_hwirq,
 468                                                unsigned int *parent_type)
 469 {
 470         *parent_hwirq = chip->irq.child_offset_to_irq(chip, hwirq);
 471         *parent_type = type;
 472
 473         return 0;
 474 }
 475
 476 static unsigned int tegra186_gpio_child_offset_to_irq(struct gpio_chip *chip,
 477                                                       unsigned int offset)
 478 {
 479         struct tegra_gpio *gpio = gpiochip_get_data(chip);
 480         unsigned int i;
 481
 482         for (i = 0; i < gpio->soc->num_ports; i++) {
 483                 if (offset < gpio->soc->ports[i].pins)
 484                         break;
 485
 486                 offset -= gpio->soc->ports[i].pins;
 487         }
 488
 489         return offset + i * 8;
 490 }
 491
 492 static const struct of_device_id tegra186_pmc_of_match[] = {
 493         { .compatible = "nvidia,tegra186-pmc" },
 494         { .compatible = "nvidia,tegra194-pmc" },
 495         { /* sentinel */ }
 496 };
 497
 498 static void tegra186_gpio_init_route_mapping(struct tegra_gpio *gpio)
 499 {
 500         unsigned int i, j;
 501         u32 value;
 502
 503         for (i = 0; i < gpio->soc->num_ports; i++) {
 504                 const struct tegra_gpio_port *port = &gpio->soc->ports[i];
 505                 unsigned int offset, p = port->port;
 506                 void __iomem *base;
 507
 508                 base = gpio->secure + port->bank * 0x1000 + 0x800;
 509
 510                 value = readl(base + TEGRA186_GPIO_CTL_SCR);
 511
 512                 /*
 513                  * For controllers that haven't been locked down yet, make
 514                  * sure to program the default interrupt route mapping.
 515                  */
 516                 if ((value & TEGRA186_GPIO_CTL_SCR_SEC_REN) == 0 &&
 517                     (value & TEGRA186_GPIO_CTL_SCR_SEC_WEN) == 0) {
 518                         for (j = 0; j < 8; j++) {
 519                                 offset = TEGRA186_GPIO_INT_ROUTE_MAPPING(p, j);
 520
 521                                 value = readl(base + offset);
 522                                 value = BIT(port->pins) - 1;
 523                                 writel(value, base + offset);
 524                         }
 525                 }
 526         }
 527 }
 528
 529 static int tegra186_gpio_probe(struct platform_device *pdev)
 530 {
 531         unsigned int i, j, offset;
 532         struct gpio_irq_chip *irq;
 533         struct tegra_gpio *gpio;
 534         struct device_node *np;
 535         char **names;
 536         int err;
 537
 538         gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL);
 539         if (!gpio)
 540                 return -ENOMEM;
 541
 542         gpio->soc = of_device_get_match_data(&pdev->dev);
 543
 544         gpio->secure = devm_platform_ioremap_resource_byname(pdev, "security");
 545         if (IS_ERR(gpio->secure))
 546                 return PTR_ERR(gpio->secure);
 547
 548         gpio->base = devm_platform_ioremap_resource_byname(pdev, "gpio");
 549         if (IS_ERR(gpio->base))
 550                 return PTR_ERR(gpio->base);
 551
 552         err = platform_irq_count(pdev);
 553         if (err < 0)
 554                 return err;
 555
 556         gpio->num_irq = err;
 557
 558         gpio->irq = devm_kcalloc(&pdev->dev, gpio->num_irq, sizeof(*gpio->irq),
 559                                  GFP_KERNEL);
 560         if (!gpio->irq)
 561                 return -ENOMEM;
 562
 563         for (i = 0; i < gpio->num_irq; i++) {
 564                 err = platform_get_irq(pdev, i);
 565                 if (err < 0)
 566                         return err;
 567
 568                 gpio->irq[i] = err;
 569         }
 570
 571         gpio->gpio.label = gpio->soc->name;
 572         gpio->gpio.parent = &pdev->dev;
 573
 574         gpio->gpio.get_direction = tegra186_gpio_get_direction;
 575         gpio->gpio.direction_input = tegra186_gpio_direction_input;
 576         gpio->gpio.direction_output = tegra186_gpio_direction_output;
 577         gpio->gpio.get = tegra186_gpio_get,
 578         gpio->gpio.set = tegra186_gpio_set;
 579         gpio->gpio.set_config = tegra186_gpio_set_config;
 580
 581         gpio->gpio.base = -1;
 582
 583         for (i = 0; i < gpio->soc->num_ports; i++)
 584                 gpio->gpio.ngpio += gpio->soc->ports[i].pins;
 585
 586         names = devm_kcalloc(gpio->gpio.parent, gpio->gpio.ngpio,
 587                              sizeof(*names), GFP_KERNEL);
 588         if (!names)
 589                 return -ENOMEM;
 590
 591         for (i = 0, offset = 0; i < gpio->soc->num_ports; i++) {
 592                 const struct tegra_gpio_port *port = &gpio->soc->ports[i];
 593                 char *name;
 594
 595                 for (j = 0; j < port->pins; j++) {
 596                         name = devm_kasprintf(gpio->gpio.parent, GFP_KERNEL,
 597                                               "P%s.%02x", port->name, j);
 598                         if (!name)
 599                                 return -ENOMEM;
 600
 601                         names[offset + j] = name;
 602                 }
 603
 604                 offset += port->pins;
 605         }
 606
 607         gpio->gpio.names = (const char * const *)names;
 608
 609         gpio->gpio.of_node = pdev->dev.of_node;
 610         gpio->gpio.of_gpio_n_cells = 2;
 611         gpio->gpio.of_xlate = tegra186_gpio_of_xlate;
 612
 613         gpio->intc.name = pdev->dev.of_node->name;
 614         gpio->intc.irq_ack = tegra186_irq_ack;
 615         gpio->intc.irq_mask = tegra186_irq_mask;
 616         gpio->intc.irq_unmask = tegra186_irq_unmask;
 617         gpio->intc.irq_set_type = tegra186_irq_set_type;
 618         gpio->intc.irq_set_wake = irq_chip_set_wake_parent;
 619
 620         irq = &gpio->gpio.irq;
 621         irq->chip = &gpio->intc;
 622         irq->fwnode = of_node_to_fwnode(pdev->dev.of_node);
 623         irq->child_to_parent_hwirq = tegra186_gpio_child_to_parent_hwirq;
 624         irq->populate_parent_fwspec = tegra186_gpio_populate_parent_fwspec;
 625         irq->child_offset_to_irq = tegra186_gpio_child_offset_to_irq;
 626         irq->child_irq_domain_ops.translate = tegra186_gpio_irq_domain_translate;
 627         irq->handler = handle_simple_irq;
 628         irq->default_type = IRQ_TYPE_NONE;
 629         irq->parent_handler = tegra186_gpio_irq;
 630         irq->parent_handler_data = gpio;
 631         irq->num_parents = gpio->num_irq;
 632         irq->parents = gpio->irq;
 633
 634         np = of_find_matching_node(NULL, tegra186_pmc_of_match);
 635         if (np) {
 636                 irq->parent_domain = irq_find_host(np);
 637                 of_node_put(np);
 638
 639                 if (!irq->parent_domain)
 640                         return -EPROBE_DEFER;
 641         }
 642
 643         tegra186_gpio_init_route_mapping(gpio);
 644
 645         irq->map = devm_kcalloc(&pdev->dev, gpio->gpio.ngpio,
 646                                 sizeof(*irq->map), GFP_KERNEL);
 647         if (!irq->map)
 648                 return -ENOMEM;
 649
 650         for (i = 0, offset = 0; i < gpio->soc->num_ports; i++) {
 651                 const struct tegra_gpio_port *port = &gpio->soc->ports[i];
 652
 653                 for (j = 0; j < port->pins; j++)
 654                         irq->map[offset + j] = irq->parents[port->bank];
 655
 656                 offset += port->pins;
 657         }
 658
 659         platform_set_drvdata(pdev, gpio);
 660
 661         err = devm_gpiochip_add_data(&pdev->dev, &gpio->gpio, gpio);
 662         if (err < 0)
 663                 return err;
 664
 665         return 0;
 666 }
 667
 668 static int tegra186_gpio_remove(struct platform_device *pdev)
 669 {
 670         return 0;
 671 }
 672
 673 #define TEGRA186_MAIN_GPIO_PORT(_name, _bank, _port, _pins)     \
 674         [TEGRA186_MAIN_GPIO_PORT_##_name] = {                   \
 675                 .name = #_name,                                 \
 676                 .bank = _bank,                                  \
 677                 .port = _port,                                  \
 678                 .pins = _pins,                                  \
 679         }
 680
 681 static const struct tegra_gpio_port tegra186_main_ports[] = {
 682         TEGRA186_MAIN_GPIO_PORT( A, 2, 0, 7),
 683         TEGRA186_MAIN_GPIO_PORT( B, 3, 0, 7),
 684         TEGRA186_MAIN_GPIO_PORT( C, 3, 1, 7),
 685         TEGRA186_MAIN_GPIO_PORT( D, 3, 2, 6),
 686         TEGRA186_MAIN_GPIO_PORT( E, 2, 1, 8),
 687         TEGRA186_MAIN_GPIO_PORT( F, 2, 2, 6),
 688         TEGRA186_MAIN_GPIO_PORT( G, 4, 1, 6),
 689         TEGRA186_MAIN_GPIO_PORT( H, 1, 0, 7),
 690         TEGRA186_MAIN_GPIO_PORT( I, 0, 4, 8),
 691         TEGRA186_MAIN_GPIO_PORT( J, 5, 0, 8),
 692         TEGRA186_MAIN_GPIO_PORT( K, 5, 1, 1),
 693         TEGRA186_MAIN_GPIO_PORT( L, 1, 1, 8),
 694         TEGRA186_MAIN_GPIO_PORT( M, 5, 3, 6),
 695         TEGRA186_MAIN_GPIO_PORT( N, 0, 0, 7),
 696         TEGRA186_MAIN_GPIO_PORT( O, 0, 1, 4),
 697         TEGRA186_MAIN_GPIO_PORT( P, 4, 0, 7),
 698         TEGRA186_MAIN_GPIO_PORT( Q, 0, 2, 6),
 699         TEGRA186_MAIN_GPIO_PORT( R, 0, 5, 6),
 700         TEGRA186_MAIN_GPIO_PORT( T, 0, 3, 4),
 701         TEGRA186_MAIN_GPIO_PORT( X, 1, 2, 8),
 702         TEGRA186_MAIN_GPIO_PORT( Y, 1, 3, 7),
 703         TEGRA186_MAIN_GPIO_PORT(BB, 2, 3, 2),
 704         TEGRA186_MAIN_GPIO_PORT(CC, 5, 2, 4),
 705 };
 706
 707 static const struct tegra_gpio_soc tegra186_main_soc = {
 708         .num_ports = ARRAY_SIZE(tegra186_main_ports),
 709         .ports = tegra186_main_ports,
 710         .name = "tegra186-gpio",
 711         .instance = 0,
 712 };
 713
 714 #define TEGRA186_AON_GPIO_PORT(_name, _bank, _port, _pins)      \
 715         [TEGRA186_AON_GPIO_PORT_##_name] = {                    \
 716                 .name = #_name,                                 \
 717                 .bank = _bank,                                  \
 718                 .port = _port,                                  \
 719                 .pins = _pins,                                  \
 720         }
 721
 722 static const struct tegra_gpio_port tegra186_aon_ports[] = {
 723         TEGRA186_AON_GPIO_PORT( S, 0, 1, 5),
 724         TEGRA186_AON_GPIO_PORT( U, 0, 2, 6),
 725         TEGRA186_AON_GPIO_PORT( V, 0, 4, 8),
 726         TEGRA186_AON_GPIO_PORT( W, 0, 5, 8),
 727         TEGRA186_AON_GPIO_PORT( Z, 0, 7, 4),
 728         TEGRA186_AON_GPIO_PORT(AA, 0, 6, 8),
 729         TEGRA186_AON_GPIO_PORT(EE, 0, 3, 3),
 730         TEGRA186_AON_GPIO_PORT(FF, 0, 0, 5),
 731 };
 732
 733 static const struct tegra_gpio_soc tegra186_aon_soc = {
 734         .num_ports = ARRAY_SIZE(tegra186_aon_ports),
 735         .ports = tegra186_aon_ports,
 736         .name = "tegra186-gpio-aon",
 737         .instance = 1,
 738 };
 739
 740 #define TEGRA194_MAIN_GPIO_PORT(_name, _bank, _port, _pins)     \
 741         [TEGRA194_MAIN_GPIO_PORT_##_name] = {                   \
 742                 .name = #_name,                                 \
 743                 .bank = _bank,                                  \
 744                 .port = _port,                                  \
 745                 .pins = _pins,                                  \
 746         }
 747
 748 static const struct tegra_gpio_port tegra194_main_ports[] = {
 749         TEGRA194_MAIN_GPIO_PORT( A, 1, 2, 8),
 750         TEGRA194_MAIN_GPIO_PORT( B, 4, 7, 2),
 751         TEGRA194_MAIN_GPIO_PORT( C, 4, 3, 8),
 752         TEGRA194_MAIN_GPIO_PORT( D, 4, 4, 4),
 753         TEGRA194_MAIN_GPIO_PORT( E, 4, 5, 8),
 754         TEGRA194_MAIN_GPIO_PORT( F, 4, 6, 6),
 755         TEGRA194_MAIN_GPIO_PORT( G, 4, 0, 8),
 756         TEGRA194_MAIN_GPIO_PORT( H, 4, 1, 8),
 757         TEGRA194_MAIN_GPIO_PORT( I, 4, 2, 5),
 758         TEGRA194_MAIN_GPIO_PORT( J, 5, 1, 6),
 759         TEGRA194_MAIN_GPIO_PORT( K, 3, 0, 8),
 760         TEGRA194_MAIN_GPIO_PORT( L, 3, 1, 4),
 761         TEGRA194_MAIN_GPIO_PORT( M, 2, 3, 8),
 762         TEGRA194_MAIN_GPIO_PORT( N, 2, 4, 3),
 763         TEGRA194_MAIN_GPIO_PORT( O, 5, 0, 6),
 764         TEGRA194_MAIN_GPIO_PORT( P, 2, 5, 8),
 765         TEGRA194_MAIN_GPIO_PORT( Q, 2, 6, 8),
 766         TEGRA194_MAIN_GPIO_PORT( R, 2, 7, 6),
 767         TEGRA194_MAIN_GPIO_PORT( S, 3, 3, 8),
 768         TEGRA194_MAIN_GPIO_PORT( T, 3, 4, 8),
 769         TEGRA194_MAIN_GPIO_PORT( U, 3, 5, 1),
 770         TEGRA194_MAIN_GPIO_PORT( V, 1, 0, 8),
 771         TEGRA194_MAIN_GPIO_PORT( W, 1, 1, 2),
 772         TEGRA194_MAIN_GPIO_PORT( X, 2, 0, 8),
 773         TEGRA194_MAIN_GPIO_PORT( Y, 2, 1, 8),
 774         TEGRA194_MAIN_GPIO_PORT( Z, 2, 2, 8),
 775         TEGRA194_MAIN_GPIO_PORT(FF, 3, 2, 2),
 776         TEGRA194_MAIN_GPIO_PORT(GG, 0, 0, 2)
 777 };
 778
 779 static const struct tegra_gpio_soc tegra194_main_soc = {
 780         .num_ports = ARRAY_SIZE(tegra194_main_ports),
 781         .ports = tegra194_main_ports,
 782         .name = "tegra194-gpio",
 783         .instance = 0,
 784 };
 785
 786 #define TEGRA194_AON_GPIO_PORT(_name, _bank, _port, _pins)      \
 787         [TEGRA194_AON_GPIO_PORT_##_name] = {                    \
 788                 .name = #_name,                                 \
 789                 .bank = _bank,                                  \
 790                 .port = _port,                                  \
 791                 .pins = _pins,                                  \
 792         }
 793
 794 static const struct tegra_gpio_port tegra194_aon_ports[] = {
 795         TEGRA194_AON_GPIO_PORT(AA, 0, 3, 8),
 796         TEGRA194_AON_GPIO_PORT(BB, 0, 4, 4),
 797         TEGRA194_AON_GPIO_PORT(CC, 0, 1, 8),
 798         TEGRA194_AON_GPIO_PORT(DD, 0, 2, 3),
 799         TEGRA194_AON_GPIO_PORT(EE, 0, 0, 7)
 800 };
 801
 802 static const struct tegra_gpio_soc tegra194_aon_soc = {
 803         .num_ports = ARRAY_SIZE(tegra194_aon_ports),
 804         .ports = tegra194_aon_ports,
 805         .name = "tegra194-gpio-aon",
 806         .instance = 1,
 807 };
 808
 809 static const struct of_device_id tegra186_gpio_of_match[] = {
 810         {
 811                 .compatible = "nvidia,tegra186-gpio",
 812                 .data = &tegra186_main_soc
 813         }, {
 814                 .compatible = "nvidia,tegra186-gpio-aon",
 815                 .data = &tegra186_aon_soc
 816         }, {
 817                 .compatible = "nvidia,tegra194-gpio",
 818                 .data = &tegra194_main_soc
 819         }, {
 820                 .compatible = "nvidia,tegra194-gpio-aon",
 821                 .data = &tegra194_aon_soc
 822         }, {
 823                 /* sentinel */
 824         }
 825 };
 826
 827 static struct platform_driver tegra186_gpio_driver = {
 828         .driver = {
 829                 .name = "tegra186-gpio",
 830                 .of_match_table = tegra186_gpio_of_match,
 831         },
 832         .probe = tegra186_gpio_probe,
 833         .remove = tegra186_gpio_remove,
 834 };
 835 module_platform_driver(tegra186_gpio_driver);
 836
 837 MODULE_DESCRIPTION("NVIDIA Tegra186 GPIO controller driver");
 838 MODULE_AUTHOR("Thierry Reding <treding@nvidia.com>");
 839 MODULE_LICENSE("GPL v2");