ixp425.c revision 278613
1/* $NetBSD: ixp425.c,v 1.10 2005/12/11 12:16:51 christos Exp $ */ 2 3/* 4 * Copyright (c) 2003 5 * Ichiro FUKUHARA <ichiro@ichiro.org>. 6 * All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 3. All advertising materials mentioning features or use of this software 17 * must display the following acknowledgement: 18 * This product includes software developed by Ichiro FUKUHARA. 19 * 4. The name of the company nor the name of the author may be used to 20 * endorse or promote products derived from this software without specific 21 * prior written permission. 22 * 23 * THIS SOFTWARE IS PROVIDED BY ICHIRO FUKUHARA ``AS IS'' AND ANY EXPRESS OR 24 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 25 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 26 * IN NO EVENT SHALL ICHIRO FUKUHARA OR THE VOICES IN HIS HEAD BE LIABLE FOR 27 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 28 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 29 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 30 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 31 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 32 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 33 * SUCH DAMAGE. 34 */ 35 36#include <sys/cdefs.h> 37__FBSDID("$FreeBSD: stable/10/sys/arm/xscale/ixp425/ixp425.c 278613 2015-02-12 03:50:33Z ian $"); 38 39#include "opt_ddb.h" 40 41#define _ARM32_BUS_DMA_PRIVATE 42#include <sys/param.h> 43#include <sys/systm.h> 44#include <sys/bus.h> 45#include <sys/kernel.h> 46#include <sys/module.h> 47#include <sys/malloc.h> 48#include <sys/rman.h> 49#include <machine/armreg.h> 50#include <machine/bus.h> 51#include <machine/intr.h> 52 53#include <vm/vm.h> 54#include <vm/pmap.h> 55#include <arm/xscale/ixp425/ixp425reg.h> 56#include <arm/xscale/ixp425/ixp425var.h> 57#include <arm/xscale/ixp425/ixp425_intr.h> 58 59#include <dev/pci/pcireg.h> 60 61volatile uint32_t intr_enabled; 62uint32_t intr_steer = 0; 63 64/* ixp43x et. al have +32 IRQ's */ 65volatile uint32_t intr_enabled2; 66uint32_t intr_steer2 = 0; 67 68struct ixp425_softc *ixp425_softc = NULL; 69 70struct mtx ixp425_gpio_mtx; 71 72static int ixp425_probe(device_t); 73static void ixp425_identify(driver_t *, device_t); 74static int ixp425_attach(device_t); 75 76/* 77 * Return a mask of the "fuse" bits that identify 78 * which h/w features are present. 79 * NB: assumes the expansion bus is mapped. 80 */ 81uint32_t 82ixp4xx_read_feature_bits(void) 83{ 84 uint32_t bits = ~IXPREG(IXP425_EXP_VBASE + EXP_FCTRL_OFFSET); 85 bits &= ~EXP_FCTRL_RESVD; 86 if (!cpu_is_ixp46x()) 87 bits &= ~EXP_FCTRL_IXP46X_ONLY; 88 return bits; 89} 90 91void 92ixp4xx_write_feature_bits(uint32_t v) 93{ 94 IXPREG(IXP425_EXP_VBASE + EXP_FCTRL_OFFSET) = ~v; 95} 96 97struct arm32_dma_range * 98bus_dma_get_range(void) 99{ 100 return (NULL); 101} 102 103int 104bus_dma_get_range_nb(void) 105{ 106 return (0); 107} 108 109static const uint8_t int2gpio[32] __attribute__ ((aligned(32))) = { 110 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, /* INT#0 -> INT#5 */ 111 0x00, 0x01, /* GPIO#0 -> GPIO#1 */ 112 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, /* INT#8 -> INT#13 */ 113 0xff, 0xff, 0xff, 0xff, 0xff, /* INT#14 -> INT#18 */ 114 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, /* GPIO#2 -> GPIO#7 */ 115 0x08, 0x09, 0x0a, 0x0b, 0x0c, /* GPIO#8 -> GPIO#12 */ 116 0xff, 0xff /* INT#30 -> INT#31 */ 117}; 118 119static __inline uint32_t 120ixp425_irq2gpio_bit(int irq) 121{ 122 return (1U << int2gpio[irq]); 123} 124 125#ifdef DDB 126#include <ddb/ddb.h> 127 128DB_SHOW_COMMAND(gpio, db_show_gpio) 129{ 130 static const char *itype[8] = { 131 [GPIO_TYPE_ACT_HIGH] = "act-high", 132 [GPIO_TYPE_ACT_LOW] = "act-low", 133 [GPIO_TYPE_EDG_RISING] = "edge-rising", 134 [GPIO_TYPE_EDG_FALLING] = "edge-falling", 135 [GPIO_TYPE_TRANSITIONAL]= "transitional", 136 [5] = "type-5", [6] = "type-6", [7] = "type-7" 137 }; 138 uint32_t gpoutr = GPIO_CONF_READ_4(ixp425_softc, IXP425_GPIO_GPOUTR); 139 uint32_t gpoer = GPIO_CONF_READ_4(ixp425_softc, IXP425_GPIO_GPOER); 140 uint32_t gpinr = GPIO_CONF_READ_4(ixp425_softc, IXP425_GPIO_GPINR); 141 uint32_t gpit1r = GPIO_CONF_READ_4(ixp425_softc, IXP425_GPIO_GPIT1R); 142 uint32_t gpit2r = GPIO_CONF_READ_4(ixp425_softc, IXP425_GPIO_GPIT2R); 143 int i, j; 144 145 db_printf("GPOUTR %08x GPINR %08x GPOER %08x GPISR %08x\n", 146 gpoutr, gpinr, gpoer, 147 GPIO_CONF_READ_4(ixp425_softc, IXP425_GPIO_GPISR)); 148 db_printf("GPIT1R %08x GPIT2R %08x GPCLKR %08x\n", 149 gpit1r, gpit2r, GPIO_CONF_READ_4(ixp425_softc, IXP425_GPIO_GPCLKR)); 150 for (i = 0; i < 16; i++) { 151 db_printf("[%2d] out %u in %u %-3s", i, 152 (gpoutr>>i)&1, (gpinr>>i)&1, (gpoer>>i)&1 ? "in" : "out"); 153 for (j = 0; j < 32; j++) 154 if (int2gpio[j] == i) { 155 db_printf(" irq %2u %s", j, itype[ 156 (((i & 8) ? gpit2r : gpit1r) >> (3*(i&7))) 157 & 7]); 158 break; 159 } 160 db_printf("\n"); 161 } 162} 163#endif 164 165void 166ixp425_set_gpio(struct ixp425_softc *sc, int pin, int type) 167{ 168 uint32_t gpiotr = GPIO_CONF_READ_4(sc, GPIO_TYPE_REG(pin)); 169 170 IXP4XX_GPIO_LOCK(); 171 /* clear interrupt type */ 172 GPIO_CONF_WRITE_4(sc, GPIO_TYPE_REG(pin), 173 gpiotr &~ GPIO_TYPE(pin, GPIO_TYPE_MASK)); 174 /* clear any pending interrupt */ 175 GPIO_CONF_WRITE_4(sc, IXP425_GPIO_GPISR, (1<<pin)); 176 /* set new interrupt type */ 177 GPIO_CONF_WRITE_4(sc, GPIO_TYPE_REG(pin), 178 gpiotr | GPIO_TYPE(pin, type)); 179 180 /* configure gpio line as an input */ 181 GPIO_CONF_WRITE_4(sc, IXP425_GPIO_GPOER, 182 GPIO_CONF_READ_4(sc, IXP425_GPIO_GPOER) | (1<<pin)); 183 IXP4XX_GPIO_UNLOCK(); 184} 185 186static __inline void 187ixp425_gpio_ack(int irq) 188{ 189 if (irq < 32 && ((1 << irq) & IXP425_INT_GPIOMASK)) 190 IXPREG(IXP425_GPIO_VBASE + IXP425_GPIO_GPISR) = 191 ixp425_irq2gpio_bit(irq); 192} 193 194static void 195ixp425_post_filter(void *arg) 196{ 197 uintptr_t irq = (uintptr_t) arg; 198 ixp425_gpio_ack(irq); 199} 200 201void 202arm_mask_irq(uintptr_t nb) 203{ 204 int i; 205 206 i = disable_interrupts(PSR_I); 207 if (nb < 32) { 208 intr_enabled &= ~(1 << nb); 209 ixp425_set_intrmask(); 210 } else { 211 intr_enabled2 &= ~(1 << (nb - 32)); 212 ixp435_set_intrmask(); 213 } 214 restore_interrupts(i); 215 /*XXX; If it's a GPIO interrupt, ACK it know. Can it be a problem ?*/ 216 ixp425_gpio_ack(nb); 217} 218 219void 220arm_unmask_irq(uintptr_t nb) 221{ 222 int i; 223 224 i = disable_interrupts(PSR_I); 225 if (nb < 32) { 226 intr_enabled |= (1 << nb); 227 ixp425_set_intrmask(); 228 } else { 229 intr_enabled2 |= (1 << (nb - 32)); 230 ixp435_set_intrmask(); 231 } 232 restore_interrupts(i); 233} 234 235static __inline uint32_t 236ixp425_irq_read(void) 237{ 238 return IXPREG(IXP425_INT_STATUS) & intr_enabled; 239} 240 241static __inline uint32_t 242ixp435_irq_read(void) 243{ 244 return IXPREG(IXP435_INT_STATUS2) & intr_enabled2; 245} 246 247int 248arm_get_next_irq(int last) 249{ 250 uint32_t mask; 251 252 last += 1; /* always advance fwd, NB: handles -1 */ 253 if (last < 32) { 254 mask = ixp425_irq_read() >> last; 255 for (; mask != 0; mask >>= 1, last++) { 256 if (mask & 1) 257 return last; 258 } 259 last = 32; 260 } 261 if (cpu_is_ixp43x()) { 262 mask = ixp435_irq_read() >> (32-last); 263 for (; mask != 0; mask >>= 1, last++) { 264 if (mask & 1) 265 return last; 266 } 267 } 268 return -1; 269} 270 271void 272cpu_reset(void) 273{ 274 275 bus_space_write_4(&ixp425_bs_tag, IXP425_TIMER_VBASE, 276 IXP425_OST_WDOG_KEY, OST_WDOG_KEY_MAJICK); 277 bus_space_write_4(&ixp425_bs_tag, IXP425_TIMER_VBASE, 278 IXP425_OST_WDOG, 0); 279 bus_space_write_4(&ixp425_bs_tag, IXP425_TIMER_VBASE, 280 IXP425_OST_WDOG_ENAB, OST_WDOG_ENAB_RST_ENA | 281 OST_WDOG_ENAB_CNT_ENA); 282 printf("Reset failed!\n"); 283 for(;;); 284} 285 286static void 287ixp425_identify(driver_t *driver, device_t parent) 288{ 289 BUS_ADD_CHILD(parent, 0, "ixp", 0); 290} 291 292static int 293ixp425_probe(device_t dev) 294{ 295 device_set_desc(dev, "Intel IXP4XX"); 296 return (0); 297} 298 299static int 300ixp425_attach(device_t dev) 301{ 302 struct ixp425_softc *sc; 303 304 device_printf(dev, "%b\n", ixp4xx_read_feature_bits(), EXP_FCTRL_BITS); 305 306 sc = device_get_softc(dev); 307 sc->sc_iot = &ixp425_bs_tag; 308 KASSERT(ixp425_softc == NULL, ("%s called twice?", __func__)); 309 ixp425_softc = sc; 310 311 intr_enabled = 0; 312 ixp425_set_intrmask(); 313 ixp425_set_intrsteer(); 314 if (cpu_is_ixp43x()) { 315 intr_enabled2 = 0; 316 ixp435_set_intrmask(); 317 ixp435_set_intrsteer(); 318 } 319 arm_post_filter = ixp425_post_filter; 320 321 mtx_init(&ixp425_gpio_mtx, "gpio", NULL, MTX_DEF); 322 if (bus_space_map(sc->sc_iot, IXP425_GPIO_HWBASE, IXP425_GPIO_SIZE, 323 0, &sc->sc_gpio_ioh)) 324 panic("%s: unable to map GPIO registers", __func__); 325 if (bus_space_map(sc->sc_iot, IXP425_EXP_HWBASE, IXP425_EXP_SIZE, 326 0, &sc->sc_exp_ioh)) 327 panic("%s: unable to map Expansion Bus registers", __func__); 328 329 /* XXX belongs in platform init */ 330 if (cpu_is_ixp43x()) 331 cambria_exp_bus_init(sc); 332 333 if (bus_dma_tag_create(NULL, 1, 0, BUS_SPACE_MAXADDR_32BIT, 334 BUS_SPACE_MAXADDR, NULL, NULL, 0xffffffff, 0xff, 0xffffffff, 0, 335 NULL, NULL, &sc->sc_dmat)) 336 panic("%s: failed to create dma tag", __func__); 337 338 sc->sc_irq_rman.rm_type = RMAN_ARRAY; 339 sc->sc_irq_rman.rm_descr = "IXP4XX IRQs"; 340 if (rman_init(&sc->sc_irq_rman) != 0 || 341 rman_manage_region(&sc->sc_irq_rman, 0, cpu_is_ixp43x() ? 63 : 31) != 0) 342 panic("%s: failed to set up IRQ rman", __func__); 343 344 sc->sc_mem_rman.rm_type = RMAN_ARRAY; 345 sc->sc_mem_rman.rm_descr = "IXP4XX Memory"; 346 if (rman_init(&sc->sc_mem_rman) != 0 || 347 rman_manage_region(&sc->sc_mem_rman, 0, ~0) != 0) 348 panic("%s: failed to set up memory rman", __func__); 349 350 BUS_ADD_CHILD(dev, 0, "pcib", 0); 351 BUS_ADD_CHILD(dev, 0, "ixpclk", 0); 352 BUS_ADD_CHILD(dev, 0, "ixpiic", 0); 353 /* XXX move to hints? */ 354 BUS_ADD_CHILD(dev, 0, "ixpwdog", 0); 355 356 /* attach wired devices via hints */ 357 bus_enumerate_hinted_children(dev); 358 359 bus_generic_probe(dev); 360 bus_generic_attach(dev); 361 362 return (0); 363} 364 365static void 366ixp425_hinted_child(device_t bus, const char *dname, int dunit) 367{ 368 device_t child; 369 struct ixp425_ivar *ivar; 370 371 child = BUS_ADD_CHILD(bus, 0, dname, dunit); 372 ivar = IXP425_IVAR(child); 373 resource_int_value(dname, dunit, "addr", &ivar->addr); 374 resource_int_value(dname, dunit, "irq", &ivar->irq); 375} 376 377static device_t 378ixp425_add_child(device_t dev, u_int order, const char *name, int unit) 379{ 380 device_t child; 381 struct ixp425_ivar *ivar; 382 383 child = device_add_child_ordered(dev, order, name, unit); 384 if (child == NULL) 385 return NULL; 386 ivar = malloc(sizeof(struct ixp425_ivar), M_DEVBUF, M_NOWAIT); 387 if (ivar == NULL) { 388 device_delete_child(dev, child); 389 return NULL; 390 } 391 ivar->addr = 0; 392 ivar->irq = -1; 393 device_set_ivars(child, ivar); 394 return child; 395} 396 397static int 398ixp425_read_ivar(device_t bus, device_t child, int which, uintptr_t *result) 399{ 400 struct ixp425_ivar *ivar = IXP425_IVAR(child); 401 402 switch (which) { 403 case IXP425_IVAR_ADDR: 404 if (ivar->addr != 0) { 405 *(uint32_t *)result = ivar->addr; 406 return 0; 407 } 408 break; 409 case IXP425_IVAR_IRQ: 410 if (ivar->irq != -1) { 411 *(int *)result = ivar->irq; 412 return 0; 413 } 414 break; 415 } 416 return EINVAL; 417} 418 419/* 420 * NB: This table handles P->V translations for regions setup with 421 * static mappings in initarm. This is used solely for calls to 422 * bus_alloc_resource_any; anything done with bus_space_map is 423 * handled elsewhere and does not require an entry here. 424 * 425 * XXX this table is also used by uart_cpu_getdev via getvbase 426 * (hence the public api) 427 */ 428struct hwvtrans { 429 uint32_t hwbase; 430 uint32_t size; 431 uint32_t vbase; 432 int isa4x; /* XXX needs special bus space tag */ 433 int isslow; /* XXX needs special bus space tag */ 434}; 435 436static const struct hwvtrans * 437gethwvtrans(uint32_t hwbase, uint32_t size) 438{ 439 static const struct hwvtrans hwvtrans[] = { 440 /* NB: needed only for uart_cpu_getdev */ 441 { .hwbase = IXP425_UART0_HWBASE, 442 .size = IXP425_REG_SIZE, 443 .vbase = IXP425_UART0_VBASE, 444 .isa4x = 1 }, 445 { .hwbase = IXP425_UART1_HWBASE, 446 .size = IXP425_REG_SIZE, 447 .vbase = IXP425_UART1_VBASE, 448 .isa4x = 1 }, 449 { .hwbase = IXP425_PCI_HWBASE, 450 .size = IXP425_PCI_SIZE, 451 .vbase = IXP425_PCI_VBASE }, 452 { .hwbase = IXP425_PCI_MEM_HWBASE, 453 .size = IXP425_PCI_MEM_SIZE, 454 .vbase = IXP425_PCI_MEM_VBASE }, 455 { .hwbase = IXP425_EXP_BUS_CS0_HWBASE, 456 .size = IXP425_EXP_BUS_CS0_SIZE, 457 .vbase = IXP425_EXP_BUS_CS0_VBASE }, 458 /* NB: needed for ixp435 ehci controllers */ 459 { .hwbase = IXP435_USB1_HWBASE, 460 .size = IXP435_USB1_SIZE, 461 .vbase = IXP435_USB1_VBASE }, 462 { .hwbase = IXP435_USB2_HWBASE, 463 .size = IXP435_USB2_SIZE, 464 .vbase = IXP435_USB2_VBASE }, 465 { .hwbase = CAMBRIA_GPS_HWBASE, 466 .size = CAMBRIA_GPS_SIZE, 467 .vbase = CAMBRIA_GPS_VBASE, 468 .isslow = 1 }, 469 { .hwbase = CAMBRIA_RS485_HWBASE, 470 .size = CAMBRIA_RS485_SIZE, 471 .vbase = CAMBRIA_RS485_VBASE, 472 .isslow = 1 }, 473 }; 474 int i; 475 476 for (i = 0; i < sizeof hwvtrans / sizeof *hwvtrans; i++) { 477 if (hwbase >= hwvtrans[i].hwbase && 478 hwbase + size <= hwvtrans[i].hwbase + hwvtrans[i].size) 479 return &hwvtrans[i]; 480 } 481 return NULL; 482} 483 484/* XXX for uart_cpu_getdev */ 485int 486getvbase(uint32_t hwbase, uint32_t size, uint32_t *vbase) 487{ 488 const struct hwvtrans *hw; 489 490 hw = gethwvtrans(hwbase, size); 491 if (hw == NULL) 492 return (ENOENT); 493 *vbase = hwbase - hw->hwbase + hw->vbase; 494 return (0); 495} 496 497static struct resource * 498ixp425_alloc_resource(device_t dev, device_t child, int type, int *rid, 499 u_long start, u_long end, u_long count, u_int flags) 500{ 501 struct ixp425_softc *sc = device_get_softc(dev); 502 const struct hwvtrans *vtrans; 503 struct resource *rv; 504 uint32_t addr; 505 int needactivate = flags & RF_ACTIVE; 506 int irq; 507 508 flags &= ~RF_ACTIVE; 509 switch (type) { 510 case SYS_RES_IRQ: 511 /* override per hints */ 512 if (BUS_READ_IVAR(dev, child, IXP425_IVAR_IRQ, &irq) == 0) 513 start = end = irq; 514 rv = rman_reserve_resource(&sc->sc_irq_rman, start, end, count, 515 flags, child); 516 if (rv != NULL) 517 rman_set_rid(rv, *rid); 518 break; 519 520 case SYS_RES_MEMORY: 521 /* override per hints */ 522 if (BUS_READ_IVAR(dev, child, IXP425_IVAR_ADDR, &addr) == 0) { 523 start = addr; 524 /* XXX use nominal window to check for mapping */ 525 vtrans = gethwvtrans(start, 0x1000); 526 if (vtrans != NULL) { 527 /* 528 * Assign the entire mapped region; this may 529 * not be correct but without more info from 530 * the caller we cannot tell. 531 */ 532 end = start + vtrans->size - 533 (start - vtrans->hwbase); 534 if (bootverbose) 535 device_printf(child, 536 "%s: assign 0x%lx:0x%lx%s\n", 537 __func__, start, end - start, 538 vtrans->isa4x ? " A4X" : 539 vtrans->isslow ? " SLOW" : ""); 540 } 541 } else 542 vtrans = gethwvtrans(start, end - start); 543 if (vtrans == NULL) { 544 /* likely means above table needs to be updated */ 545 device_printf(child, "%s: no mapping for 0x%lx:0x%lx\n", 546 __func__, start, end - start); 547 return NULL; 548 } 549 rv = rman_reserve_resource(&sc->sc_mem_rman, start, end, 550 end - start, flags, child); 551 if (rv == NULL) { 552 device_printf(child, "%s: cannot reserve 0x%lx:0x%lx\n", 553 __func__, start, end - start); 554 return NULL; 555 } 556 rman_set_rid(rv, *rid); 557 break; 558 default: 559 rv = NULL; 560 break; 561 } 562 if (rv != NULL && needactivate) { 563 if (bus_activate_resource(child, type, *rid, rv)) { 564 rman_release_resource(rv); 565 return (NULL); 566 } 567 } 568 return (rv); 569} 570 571static int 572ixp425_release_resource(device_t bus, device_t child, int type, int rid, 573 struct resource *r) 574{ 575 /* NB: no private resources, just release */ 576 return rman_release_resource(r); 577} 578 579static int 580ixp425_activate_resource(device_t dev, device_t child, int type, int rid, 581 struct resource *r) 582{ 583 struct ixp425_softc *sc = device_get_softc(dev); 584 const struct hwvtrans *vtrans; 585 586 if (type == SYS_RES_MEMORY) { 587 vtrans = gethwvtrans(rman_get_start(r), rman_get_size(r)); 588 if (vtrans == NULL) { /* NB: should not happen */ 589 device_printf(child, "%s: no mapping for 0x%lx:0x%lx\n", 590 __func__, rman_get_start(r), rman_get_size(r)); 591 return (ENOENT); 592 } 593 if (vtrans->isa4x) 594 rman_set_bustag(r, &ixp425_a4x_bs_tag); 595 else if (vtrans->isslow) 596 rman_set_bustag(r, &cambria_exp_bs_tag); 597 else 598 rman_set_bustag(r, sc->sc_iot); 599 rman_set_bushandle(r, vtrans->vbase); 600 } 601 return (rman_activate_resource(r)); 602} 603 604static int 605ixp425_deactivate_resource(device_t bus, device_t child, int type, int rid, 606 struct resource *r) 607{ 608 /* NB: no private resources, just deactive */ 609 return (rman_deactivate_resource(r)); 610} 611 612static __inline void 613get_masks(struct resource *res, uint32_t *mask, uint32_t *mask2) 614{ 615 int i; 616 617 *mask = 0; 618 for (i = rman_get_start(res); i < 32 && i <= rman_get_end(res); i++) 619 *mask |= 1 << i; 620 *mask2 = 0; 621 for (; i <= rman_get_end(res); i++) 622 *mask2 |= 1 << (i - 32); 623} 624 625static __inline void 626update_masks(uint32_t mask, uint32_t mask2) 627{ 628 629 intr_enabled = mask; 630 ixp425_set_intrmask(); 631 if (cpu_is_ixp43x()) { 632 intr_enabled2 = mask2; 633 ixp435_set_intrmask(); 634 } 635} 636 637static int 638ixp425_setup_intr(device_t dev, device_t child, 639 struct resource *res, int flags, driver_filter_t *filt, 640 driver_intr_t *intr, void *arg, void **cookiep) 641{ 642 uint32_t mask, mask2; 643 int error; 644 645 error = BUS_SETUP_INTR(device_get_parent(dev), child, res, flags, 646 filt, intr, arg, cookiep); 647 if (error) 648 return (error); 649 650 get_masks(res, &mask, &mask2); 651 update_masks(intr_enabled | mask, intr_enabled2 | mask2); 652 653 return (0); 654} 655 656static int 657ixp425_teardown_intr(device_t dev, device_t child, struct resource *res, 658 void *cookie) 659{ 660 uint32_t mask, mask2; 661 662 get_masks(res, &mask, &mask2); 663 update_masks(intr_enabled &~ mask, intr_enabled2 &~ mask2); 664 665 return (BUS_TEARDOWN_INTR(device_get_parent(dev), child, res, cookie)); 666} 667 668static device_method_t ixp425_methods[] = { 669 /* Device interface */ 670 DEVMETHOD(device_probe, ixp425_probe), 671 DEVMETHOD(device_attach, ixp425_attach), 672 DEVMETHOD(device_identify, ixp425_identify), 673 674 /* Bus interface */ 675 DEVMETHOD(bus_add_child, ixp425_add_child), 676 DEVMETHOD(bus_hinted_child, ixp425_hinted_child), 677 DEVMETHOD(bus_read_ivar, ixp425_read_ivar), 678 679 DEVMETHOD(bus_alloc_resource, ixp425_alloc_resource), 680 DEVMETHOD(bus_release_resource, ixp425_release_resource), 681 DEVMETHOD(bus_activate_resource, ixp425_activate_resource), 682 DEVMETHOD(bus_deactivate_resource, ixp425_deactivate_resource), 683 DEVMETHOD(bus_setup_intr, ixp425_setup_intr), 684 DEVMETHOD(bus_teardown_intr, ixp425_teardown_intr), 685 686 {0, 0}, 687}; 688 689static driver_t ixp425_driver = { 690 "ixp", 691 ixp425_methods, 692 sizeof(struct ixp425_softc), 693}; 694static devclass_t ixp425_devclass; 695 696DRIVER_MODULE(ixp, nexus, ixp425_driver, ixp425_devclass, 0, 0); 697