1 /* $NetBSD: rk_gpio.c,v 1.8 2025/06/03 18:26:38 rjs Exp $ */ 2 3 /*- 4 * Copyright (c) 2018 Jared McNeill <jmcneill (at) invisible.ca> 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 21 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 22 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 23 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 24 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 * SUCH DAMAGE. 27 */ 28 29 #include <sys/cdefs.h> 30 __KERNEL_RCSID(0, "$NetBSD: rk_gpio.c,v 1.8 2025/06/03 18:26:38 rjs Exp $"); 31 32 #include <sys/param.h> 33 #include <sys/bus.h> 34 #include <sys/device.h> 35 #include <sys/intr.h> 36 #include <sys/systm.h> 37 #include <sys/mutex.h> 38 #include <sys/kmem.h> 39 #include <sys/gpio.h> 40 #include <sys/bitops.h> 41 #include <sys/lwp.h> 42 43 #include <dev/fdt/fdtvar.h> 44 #include <dev/gpio/gpiovar.h> 45 46 #define GPIO_SWPORTA_DR_REG 0x0000 47 #define GPIO_SWPORTA_DDR_REG 0x0004 48 #define GPIO_INTEN_REG 0x0030 49 #define GPIO_INTMASK_REG 0x0034 50 #define GPIO_INTTYPE_LEVEL_REG 0x0038 51 #define GPIO_INT_POLARITY_REG 0x003c 52 #define GPIO_INT_STATUS_REG 0x0040 53 #define GPIO_INT_RAWSTATUS_REG 0x0044 54 #define GPIO_DEBOUNCE_REG 0x0048 55 #define GPIO_PORTA_EOI_REG 0x004c 56 #define GPIO_EXT_PORTA_REG 0x0050 57 #define GPIO_LS_SYNC_REG 0x0060 58 #define GPIO_VER_ID_REG 0x0078 59 #define GPIO_VER_ID_GPIOV2 0x0101157c 60 61 /* 62 * In "version 2" GPIO controllers, half of each register is used by the 63 * write_enable mask, so the 32 pins are spread over two registers. 64 * 65 * pins 0 - 15 go into the GPIO_SWPORT_*_L register 66 * pins 16 - 31 go into the GPIO_SWPORT_*_H register 67 */ 68 #define GPIOV2_SWPORT_DR_BASE 0x0000 69 #define GPIOV2_SWPORT_DR_REG(pin) \ 70 (GPIOV2_SWPORT_DR_BASE + GPIOV2_REG_OFFSET(pin)) 71 #define GPIOV2_SWPORT_DDR_BASE 0x0008 72 #define GPIOV2_SWPORT_DDR_REG(pin) \ 73 (GPIOV2_SWPORT_DDR_BASE + GPIOV2_REG_OFFSET(pin)) 74 #define GPIOV2_EXT_PORT_REG 0x0070 75 #define GPIOV2_REG_OFFSET(pin) (((pin) >> 4) << 2) 76 #define GPIOV2_DATA_MASK(pin) (__BIT((pin) & 0xF)) 77 #define GPIOV2_WRITE_MASK(pin) (__BIT(((pin) & 0xF) | 0x10)) 78 79 static const struct device_compatible_entry compat_data[] = { 80 { .compat = "rockchip,gpio-bank" }, 81 DEVICE_COMPAT_EOL 82 }; 83 84 struct rk_gpio_eint { 85 int (*eint_func)(void *); 86 void *eint_arg; 87 bool eint_mpsafe; 88 int eint_num; 89 }; 90 91 struct rk_gpio_softc { 92 device_t sc_dev; 93 bus_space_tag_t sc_bst; 94 bus_space_handle_t sc_bsh; 95 kmutex_t sc_lock; 96 97 struct gpio_chipset_tag sc_gp; 98 gpio_pin_t sc_pins[32]; 99 device_t sc_gpiodev; 100 101 void *sc_ih; 102 struct rk_gpio_eint sc_eint[32]; 103 }; 104 105 struct rk_gpio_pin { 106 struct rk_gpio_softc *pin_sc; 107 u_int pin_nr; 108 int pin_flags; 109 bool pin_actlo; 110 }; 111 112 #define RD4(sc, reg) \ 113 bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg)) 114 #define WR4(sc, reg, val) \ 115 bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val)) 116 117 static int rk_gpio_match(device_t, cfdata_t, void *); 118 static void rk_gpio_attach(device_t, device_t, void *); 119 120 CFATTACH_DECL_NEW(rk_gpio, sizeof(struct rk_gpio_softc), 121 rk_gpio_match, rk_gpio_attach, NULL, NULL); 122 123 static void * 124 rk_gpio_acquire(device_t dev, const void *data, size_t len, int flags) 125 { 126 struct rk_gpio_softc * const sc = device_private(dev); 127 struct rk_gpio_pin *gpin; 128 const u_int *gpio = data; 129 130 if (len != 12) 131 return NULL; 132 133 const uint8_t pin = be32toh(gpio[1]) & 0xff; 134 const bool actlo = be32toh(gpio[2]) & 1; 135 136 if (pin >= __arraycount(sc->sc_pins)) 137 return NULL; 138 139 sc->sc_gp.gp_pin_ctl(sc, pin, flags); 140 141 gpin = kmem_zalloc(sizeof(*gpin), KM_SLEEP); 142 gpin->pin_sc = sc; 143 gpin->pin_nr = pin; 144 gpin->pin_flags = flags; 145 gpin->pin_actlo = actlo; 146 147 return gpin; 148 } 149 150 static void 151 rk_gpio_release(device_t dev, void *priv) 152 { 153 struct rk_gpio_softc * const sc = device_private(dev); 154 struct rk_gpio_pin *pin = priv; 155 156 KASSERT(sc == pin->pin_sc); 157 158 sc->sc_gp.gp_pin_ctl(sc, pin->pin_nr, GPIO_PIN_INPUT); 159 160 kmem_free(pin, sizeof(*pin)); 161 } 162 163 static int 164 rk_gpio_read(device_t dev, void *priv, bool raw) 165 { 166 struct rk_gpio_softc * const sc = device_private(dev); 167 struct rk_gpio_pin *pin = priv; 168 int val; 169 170 KASSERT(sc == pin->pin_sc); 171 172 val = sc->sc_gp.gp_pin_read(sc, pin->pin_nr); 173 if (!raw && pin->pin_actlo) 174 val = !val; 175 176 return val; 177 } 178 179 static void 180 rk_gpio_write(device_t dev, void *priv, int val, bool raw) 181 { 182 struct rk_gpio_softc * const sc = device_private(dev); 183 struct rk_gpio_pin *pin = priv; 184 185 KASSERT(sc == pin->pin_sc); 186 187 if (!raw && pin->pin_actlo) 188 val = !val; 189 190 sc->sc_gp.gp_pin_write(sc, pin->pin_nr, val); 191 } 192 193 static struct fdtbus_gpio_controller_func rk_gpio_funcs = { 194 .acquire = rk_gpio_acquire, 195 .release = rk_gpio_release, 196 .read = rk_gpio_read, 197 .write = rk_gpio_write, 198 }; 199 200 static int 201 rk_gpio_pin_read(void *priv, int pin) 202 { 203 struct rk_gpio_softc * const sc = priv; 204 uint32_t data; 205 int val; 206 207 KASSERT(pin < __arraycount(sc->sc_pins)); 208 209 const uint32_t data_mask = __BIT(pin); 210 211 /* No lock required for reads */ 212 data = RD4(sc, GPIO_EXT_PORTA_REG); 213 val = __SHIFTOUT(data, data_mask); 214 215 return val; 216 } 217 218 static void 219 rk_gpio_pin_write(void *priv, int pin, int val) 220 { 221 struct rk_gpio_softc * const sc = priv; 222 uint32_t data; 223 224 KASSERT(pin < __arraycount(sc->sc_pins)); 225 226 const uint32_t data_mask = __BIT(pin); 227 228 mutex_enter(&sc->sc_lock); 229 data = RD4(sc, GPIO_SWPORTA_DR_REG); 230 if (val) 231 data |= data_mask; 232 else 233 data &= ~data_mask; 234 WR4(sc, GPIO_SWPORTA_DR_REG, data); 235 mutex_exit(&sc->sc_lock); 236 } 237 238 static void 239 rk_gpio_pin_ctl(void *priv, int pin, int flags) 240 { 241 struct rk_gpio_softc * const sc = priv; 242 uint32_t ddr; 243 244 KASSERT(pin < __arraycount(sc->sc_pins)); 245 246 mutex_enter(&sc->sc_lock); 247 ddr = RD4(sc, GPIO_SWPORTA_DDR_REG); 248 if (flags & GPIO_PIN_INPUT) 249 ddr &= ~__BIT(pin); 250 else if (flags & GPIO_PIN_OUTPUT) 251 ddr |= __BIT(pin); 252 WR4(sc, GPIO_SWPORTA_DDR_REG, ddr); 253 mutex_exit(&sc->sc_lock); 254 } 255 256 static int 257 rk_gpio_v2_pin_read(void *priv, int pin) 258 { 259 struct rk_gpio_softc * const sc = priv; 260 uint32_t data; 261 int val; 262 263 KASSERT(pin < __arraycount(sc->sc_pins)); 264 265 const uint32_t data_mask = __BIT(pin); 266 267 /* No lock required for reads */ 268 data = RD4(sc, GPIOV2_EXT_PORT_REG); 269 val = __SHIFTOUT(data, data_mask); 270 271 return val; 272 } 273 274 static void 275 rk_gpio_v2_pin_write(void *priv, int pin, int val) 276 { 277 struct rk_gpio_softc * const sc = priv; 278 uint32_t data; 279 280 KASSERT(pin < __arraycount(sc->sc_pins)); 281 282 const uint32_t write_mask = GPIOV2_WRITE_MASK(pin); 283 284 /* No lock required for writes on v2 controllers */ 285 data = val ? GPIOV2_DATA_MASK(pin) : 0; 286 WR4(sc, GPIOV2_SWPORT_DR_REG(pin), write_mask | data); 287 } 288 289 static void 290 rk_gpio_v2_pin_ctl(void *priv, int pin, int flags) 291 { 292 struct rk_gpio_softc * const sc = priv; 293 uint32_t ddr; 294 295 KASSERT(pin < __arraycount(sc->sc_pins)); 296 297 /* No lock required for writes on v2 controllers */ 298 ddr = (flags & GPIO_PIN_OUTPUT) ? GPIOV2_DATA_MASK(pin) : 0; 299 WR4(sc, GPIOV2_SWPORT_DDR_REG(pin), GPIOV2_WRITE_MASK(pin) | ddr); 300 } 301 302 static int 303 rk_gpio_intr(void *priv) 304 { 305 struct rk_gpio_softc * const sc = priv; 306 struct rk_gpio_eint *eint; 307 uint32_t status, bit; 308 int ret = 0; 309 310 status = RD4(sc, GPIO_INT_STATUS_REG); 311 if (status == 0) 312 return ret; 313 314 WR4(sc, GPIO_PORTA_EOI_REG, status); 315 316 while ((bit = ffs32(status)) != 0) { 317 status &= ~__BIT(bit - 1); 318 eint = &sc->sc_eint[bit - 1]; 319 if (eint == NULL || eint->eint_func == NULL) 320 continue; 321 if (!eint->eint_mpsafe) 322 KERNEL_LOCK(1, curlwp); 323 ret |= eint->eint_func(eint->eint_arg); 324 if (!eint->eint_mpsafe) 325 KERNEL_UNLOCK_ONE(curlwp); 326 } 327 328 return ret; 329 } 330 331 static void * 332 rk_intr_enable(struct rk_gpio_softc *sc, u_int pin, uint32_t level, 333 uint32_t polarity, bool mpsafe, int (*func)(void *), void *arg) 334 { 335 uint32_t val; 336 struct rk_gpio_eint *eint; 337 338 mutex_enter(&sc->sc_lock); 339 if (sc->sc_eint[pin].eint_func != NULL) { 340 mutex_exit(&sc->sc_lock); 341 return NULL; /* in use */ 342 } 343 344 eint = &sc->sc_eint[pin]; 345 346 eint->eint_func = func; 347 eint->eint_arg = arg; 348 eint->eint_mpsafe = mpsafe; 349 eint->eint_num = pin; 350 351 val = RD4(sc, GPIO_INTTYPE_LEVEL_REG); 352 if (level) 353 val |= 1 << pin; 354 else 355 val &= ~(1 << pin); 356 WR4(sc, GPIO_INTTYPE_LEVEL_REG, val); 357 358 val = RD4(sc, GPIO_INT_POLARITY_REG); 359 if (polarity) 360 val |= 1 << pin; 361 else 362 val &= ~(1 << pin); 363 WR4(sc, GPIO_INT_POLARITY_REG, val); 364 365 val = RD4(sc, GPIO_INTEN_REG); 366 val |= 1 << pin; 367 WR4(sc, GPIO_INTEN_REG, val); 368 #if 0 369 /* Configure eint mode */ 370 val = R4(sc, SUNXI_GPIO_INT_CFG, pin); 371 val &= ~SUNXI_GPIO_INT_MODEMASK(eint->eint_num); 372 val |= __SHIFTIN(mode, SUNXI_GPIO_INT_MODEMASK(eint->eint_num)); 373 GPIO_WRITE(sc, SUNXI_GPIO_INT_CFG(eint->eint_bank, eint->eint_num), val); 374 375 val = SUNXI_GPIO_INT_DEBOUNCE_CLK_SEL; 376 GPIO_WRITE(sc, SUNXI_GPIO_INT_DEBOUNCE(eint->eint_bank), val); 377 378 /* Enable eint */ 379 val = GPIO_READ(sc, SUNXI_GPIO_INT_CTL(eint->eint_bank)); 380 val |= __BIT(eint->eint_num); 381 GPIO_WRITE(sc, SUNXI_GPIO_INT_CTL(eint->eint_bank), val); 382 #endif 383 mutex_exit(&sc->sc_lock); 384 385 return eint; 386 } 387 388 static void 389 rk_intr_disable(struct rk_gpio_softc *sc, struct rk_gpio_eint *eint) 390 { 391 uint32_t val; 392 393 KASSERT(eint != NULL && eint->eint_func != NULL); 394 395 mutex_enter(&sc->sc_lock); 396 397 /* Disable eint */ 398 val = RD4(sc, GPIO_INTEN_REG); 399 val &= ~__BIT(eint->eint_num); 400 WR4(sc, GPIO_INTEN_REG, val); 401 WR4(sc, GPIO_INT_STATUS_REG, __BIT(eint->eint_num)); 402 403 sc->sc_eint[eint->eint_num].eint_func = NULL; 404 405 mutex_exit(&sc->sc_lock); 406 } 407 408 static void * 409 rk_fdt_intr_establish(device_t dev, u_int *specifier, int ipl, int flags, 410 int (*func)(void *), void *arg, const char *xname) 411 { 412 struct rk_gpio_softc * const sc = device_private(dev); 413 bool mpsafe = (flags & GPIO_INTR_MPSAFE) != 0; 414 uint32_t level, polarity; 415 416 const uint32_t pin = be32toh(specifier[0]); 417 const uint32_t type = be32toh(specifier[1]) & 0xf; 418 419 switch (type) { 420 case FDT_INTR_TYPE_POS_EDGE: 421 level = 1; 422 polarity = 1; 423 break; 424 case FDT_INTR_TYPE_NEG_EDGE: 425 level = 1; 426 polarity = 0; 427 break; 428 case FDT_INTR_TYPE_HIGH_LEVEL: 429 level = 0; 430 polarity = 1; 431 break; 432 case FDT_INTR_TYPE_LOW_LEVEL: 433 level = 0; 434 polarity = 0; 435 break; 436 default: 437 aprint_error_dev(dev, "%s: unsupported irq type 0x%x\n", 438 __func__, type); 439 return NULL; 440 } 441 442 return rk_intr_enable(sc, pin, level, polarity, mpsafe, func, arg); 443 } 444 445 static void 446 rk_fdt_intr_disestablish(device_t dev, void *ih) 447 { 448 struct rk_gpio_softc * const sc = device_private(dev); 449 struct rk_gpio_eint * const eint = ih; 450 451 rk_intr_disable(sc, eint); 452 } 453 454 static bool 455 rk_fdt_intrstr(device_t dev, u_int *specifier, char *buf, size_t buflen) 456 { 457 458 if (!specifier) 459 return false; 460 const u_int pin = be32toh(specifier[0]); 461 462 if (pin < 0 || pin >= 32) 463 return false; 464 465 snprintf(buf, buflen, "GPIO %d", pin); 466 467 return true; 468 } 469 470 static void 471 rk_fdt_intr_mask(device_t dev, void *ih) 472 { 473 struct rk_gpio_softc * const sc = device_private(dev); 474 void * const gpio = device_private(sc->sc_gpiodev); 475 476 gpio_intr_mask(gpio, ih); 477 } 478 479 static void 480 rk_fdt_intr_unmask(device_t dev, void *ih) 481 { 482 struct rk_gpio_softc * const sc = device_private(dev); 483 void * const gpio = device_private(sc->sc_gpiodev); 484 485 gpio_intr_unmask(gpio, ih); 486 } 487 488 489 static struct fdtbus_interrupt_controller_func rk_gpio_intrfuncs = { 490 .establish = rk_fdt_intr_establish, 491 .disestablish = rk_fdt_intr_disestablish, 492 .intrstr = rk_fdt_intrstr, 493 .mask = rk_fdt_intr_mask, 494 .unmask = rk_fdt_intr_unmask 495 }; 496 497 static void * 498 rk_gpio_intr_establish(void *vsc, int pin, int ipl, int irqmode, 499 int (*func)(void *), void *arg) 500 { 501 struct rk_gpio_softc * const sc = vsc; 502 bool mpsafe = (irqmode & GPIO_INTR_MPSAFE) != 0; 503 int type = irqmode & GPIO_INTR_MODE_MASK; 504 uint32_t level, polarity; 505 506 switch (type) { 507 case GPIO_INTR_POS_EDGE: 508 level = 1; 509 polarity = 1; 510 break; 511 case GPIO_INTR_NEG_EDGE: 512 level = 1; 513 polarity = 0; 514 break; 515 case GPIO_INTR_HIGH_LEVEL: 516 level = 0; 517 polarity = 1; 518 break; 519 case GPIO_INTR_LOW_LEVEL: 520 level = 0; 521 polarity = 0; 522 break; 523 default: 524 aprint_error_dev(sc->sc_dev, "%s: unsupported irq type 0x%x\n", 525 __func__, type); 526 return NULL; 527 } 528 529 return rk_intr_enable(sc, pin, level, polarity, mpsafe, func, arg); 530 } 531 532 static void 533 rk_gpio_intr_disestablish(void *vsc, void *ih) 534 { 535 struct rk_gpio_softc * const sc = vsc; 536 struct rk_gpio_eint * const eint = ih; 537 538 rk_intr_disable(sc, eint); 539 } 540 541 static bool 542 rk_gpio_intrstr(void *vsc, int pin, int irqmode, char *buf, size_t buflen) 543 { 544 545 if (pin < 0 || pin >= 32) 546 return false; 547 548 snprintf(buf, buflen, "GPIO %d", pin); 549 550 return true; 551 } 552 553 static void 554 rk_gpio_intr_mask(void *priv, void *ih) 555 { 556 struct rk_gpio_softc * const sc = priv; 557 struct rk_gpio_eint * const eint = ih; 558 uint32_t val; 559 560 val = RD4(sc, GPIO_INTMASK_REG); 561 val |= 1 << eint->eint_num; 562 WR4(sc, GPIO_INTEN_REG, val); 563 } 564 565 static void 566 rk_gpio_intr_unmask(void *priv, void *ih) 567 { 568 struct rk_gpio_softc * const sc = priv; 569 struct rk_gpio_eint * const eint = ih; 570 uint32_t val; 571 572 val = RD4(sc, GPIO_INTMASK_REG); 573 val &= ~(1 << eint->eint_num); 574 WR4(sc, GPIO_INTEN_REG, val); 575 } 576 577 static void 578 rk_gpio_attach_ports(struct rk_gpio_softc *sc) 579 { 580 struct gpiobus_attach_args gba; 581 u_int pin; 582 583 for (pin = 0; pin < __arraycount(sc->sc_pins); pin++) { 584 sc->sc_pins[pin].pin_num = pin; 585 sc->sc_pins[pin].pin_caps = GPIO_PIN_INPUT | GPIO_PIN_OUTPUT; 586 sc->sc_pins[pin].pin_state = rk_gpio_pin_read(sc, pin); 587 } 588 589 memset(&gba, 0, sizeof(gba)); 590 gba.gba_gc = &sc->sc_gp; 591 gba.gba_pins = sc->sc_pins; 592 gba.gba_npins = __arraycount(sc->sc_pins); 593 sc->sc_gpiodev = config_found(sc->sc_dev, &gba, NULL, CFARGS_NONE); 594 } 595 596 static int 597 rk_gpio_match(device_t parent, cfdata_t cf, void *aux) 598 { 599 struct fdt_attach_args * const faa = aux; 600 601 return of_compatible_match(faa->faa_phandle, compat_data); 602 } 603 604 static void 605 rk_gpio_attach(device_t parent, device_t self, void *aux) 606 { 607 struct rk_gpio_softc * const sc = device_private(self); 608 struct gpio_chipset_tag * const gp = &sc->sc_gp; 609 struct fdt_attach_args * const faa = aux; 610 const int phandle = faa->faa_phandle; 611 char intrstr[128]; 612 struct clk *clk; 613 bus_addr_t addr; 614 bus_size_t size; 615 uint32_t ver_id; 616 int ver; 617 618 if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) { 619 aprint_error(": couldn't get registers\n"); 620 return; 621 } 622 623 if ((clk = fdtbus_clock_get_index(phandle, 0)) == NULL || clk_enable(clk) != 0) { 624 aprint_error(": couldn't enable clock\n"); 625 return; 626 } 627 628 sc->sc_dev = self; 629 sc->sc_bst = faa->faa_bst; 630 if (bus_space_map(sc->sc_bst, addr, size, 0, &sc->sc_bsh) != 0) { 631 aprint_error(": couldn't map registers\n"); 632 return; 633 } 634 635 gp->gp_cookie = sc; 636 ver_id = RD4(sc, GPIO_VER_ID_REG); 637 switch (ver_id) { 638 case 0: /* VER_ID not implemented in v1 but reads back as 0 */ 639 ver = 1; 640 gp->gp_pin_read = rk_gpio_pin_read; 641 gp->gp_pin_write = rk_gpio_pin_write; 642 gp->gp_pin_ctl = rk_gpio_pin_ctl; 643 gp->gp_intr_establish = rk_gpio_intr_establish; 644 gp->gp_intr_disestablish = rk_gpio_intr_disestablish; 645 gp->gp_intr_str = rk_gpio_intrstr; 646 gp->gp_intr_mask = rk_gpio_intr_mask; 647 gp->gp_intr_unmask = rk_gpio_intr_unmask; 648 break; 649 case GPIO_VER_ID_GPIOV2: 650 ver = 2; 651 gp->gp_pin_read = rk_gpio_v2_pin_read; 652 gp->gp_pin_write = rk_gpio_v2_pin_write; 653 gp->gp_pin_ctl = rk_gpio_v2_pin_ctl; 654 /* XXX */ 655 break; 656 default: 657 aprint_error(": unknown version 0x%08" PRIx32 "\n", ver_id); 658 return; 659 } 660 661 mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_VM); 662 663 aprint_naive("\n"); 664 aprint_normal(": GPIO v%d (%s)\n", ver, fdtbus_get_string(phandle, "name")); 665 666 fdtbus_register_gpio_controller(self, phandle, &rk_gpio_funcs); 667 668 rk_gpio_attach_ports(sc); 669 670 WR4(sc, GPIO_INTEN_REG, 0); 671 672 if (!fdtbus_intr_str(phandle, 0, intrstr, sizeof(intrstr))) { 673 aprint_error_dev(self, "failed to decode interrupt\n"); 674 return; 675 } 676 sc->sc_ih = fdtbus_intr_establish_xname(phandle, 0, IPL_VM, 677 FDT_INTR_MPSAFE, rk_gpio_intr, sc, device_xname(self)); 678 if (sc->sc_ih == NULL) { 679 aprint_error_dev(self, "failed to establish interrupt on %s\n", 680 intrstr); 681 return; 682 } 683 aprint_normal_dev(self, "interrupting on %s\n", intrstr); 684 fdtbus_register_interrupt_controller(self, phandle, 685 &rk_gpio_intrfuncs); 686 } 687