sys/arm/at91/at91.c

   1 /*-
   2  * Copyright (c) 2005 Olivier Houchard.  All rights reserved.
   3  *
   4  * Redistribution and use in source and binary forms, with or without
   5  * modification, are permitted provided that the following conditions
   6  * are met:
   7  * 1. Redistributions of source code must retain the above copyright
   8  *    notice, this list of conditions and the following disclaimer.
   9  * 2. Redistributions in binary form must reproduce the above copyright
  10  *    notice, this list of conditions and the following disclaimer in the
  11  *    documentation and/or other materials provided with the distribution.
  12  *
  13  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  14  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  15  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  16  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  17  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  18  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  19  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  20  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  21  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  22  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  23  */
  24
  25 #include <sys/cdefs.h>
  26 __FBSDID("$FreeBSD$");
  27
  28 #include <sys/param.h>
  29 #include <sys/systm.h>
  30 #include <sys/bus.h>
  31 #include <sys/kernel.h>
  32 #include <sys/malloc.h>
  33 #include <sys/module.h>
  34
  35 #include <vm/vm.h>
  36 #include <vm/vm_kern.h>
  37 #include <vm/pmap.h>
  38 #include <vm/vm_page.h>
  39 #include <vm/vm_extern.h>
  40
  41 #define _ARM32_BUS_DMA_PRIVATE
  42 #include <machine/bus.h>
  43 #include <machine/intr.h>
  44
  45 #include <arm/at91/at91rm92reg.h>
  46 #include <arm/at91/at91var.h>
  47
  48 static struct at91_softc *at91_softc;
  49
  50 static int
  51 at91_bs_map(void *t, bus_addr_t bpa, bus_size_t size, int flags,
  52     bus_space_handle_t *bshp)
  53 {
  54         vm_paddr_t pa, endpa;
  55
  56         pa = trunc_page(bpa);
  57         if (pa >= 0xfff00000)
  58                 return (0);
  59         endpa = round_page(bpa + size);
  60
  61         *bshp = (vm_offset_t)pmap_mapdev(pa, endpa - pa);
  62
  63         return (0);
  64 }
  65
  66 static void
  67 at91_bs_unmap(void *t, bus_size_t size)
  68 {
  69         vm_offset_t va, endva;
  70
  71         va = trunc_page((vm_offset_t)t);
  72         endva = va + round_page(size);
  73
  74         /* Free the kernel virtual mapping. */
  75         kmem_free(kernel_map, va, endva - va);
  76 }
  77
  78 static int
  79 at91_bs_subregion(void *t, bus_space_handle_t bsh, bus_size_t offset,
  80     bus_size_t size, bus_space_handle_t *nbshp)
  81 {
  82
  83         *nbshp = bsh + offset;
  84         return (0);
  85 }
  86
  87 static void
  88 at91_barrier(void *t, bus_space_handle_t bsh, bus_size_t size, bus_size_t b,
  89     int a)
  90 {
  91 }
  92
  93 bs_protos(generic);
  94 bs_protos(generic_armv4);
  95
  96 struct bus_space at91_bs_tag = {
  97         /* cookie */
  98         (void *) 0,
  99
 100         /* mapping/unmapping */
 101         at91_bs_map,
 102         at91_bs_unmap,
 103         at91_bs_subregion,
 104
 105         /* allocation/deallocation */
 106         NULL,
 107         NULL,
 108
 109         /* barrier */
 110         at91_barrier,
 111
 112         /* read (single) */
 113         generic_bs_r_1,
 114         generic_armv4_bs_r_2,
 115         generic_bs_r_4,
 116         NULL,
 117
 118         /* read multiple */
 119         generic_bs_rm_1,
 120         generic_armv4_bs_rm_2,
 121         generic_bs_rm_4,
 122         NULL,
 123
 124         /* read region */
 125         generic_bs_rr_1,
 126         generic_armv4_bs_rr_2,
 127         generic_bs_rr_4,
 128         NULL,
 129
 130         /* write (single) */
 131         generic_bs_w_1,
 132         generic_armv4_bs_w_2,
 133         generic_bs_w_4,
 134         NULL,
 135
 136         /* write multiple */
 137         generic_bs_wm_1,
 138         generic_armv4_bs_wm_2,
 139         generic_bs_wm_4,
 140         NULL,
 141
 142         /* write region */
 143         NULL,
 144         generic_armv4_bs_wr_2,
 145         generic_bs_wr_4,
 146         NULL,
 147
 148         /* set multiple */
 149         NULL,
 150         NULL,
 151         NULL,
 152         NULL,
 153
 154         /* set region */
 155         NULL,
 156         generic_armv4_bs_sr_2,
 157         generic_bs_sr_4,
 158         NULL,
 159
 160         /* copy */
 161         NULL,
 162         generic_armv4_bs_c_2,
 163         NULL,
 164         NULL,
 165 };
 166
 167 static int
 168 at91_probe(device_t dev)
 169 {
 170         device_set_desc(dev, "AT91RM9200 device bus");
 171         return (0);
 172 }
 173
 174 static void
 175 at91_identify(driver_t *drv, device_t parent)
 176 {
 177
 178         BUS_ADD_CHILD(parent, 0, "atmelarm", 0);
 179 }
 180
 181 struct arm32_dma_range *
 182 bus_dma_get_range(void)
 183 {
 184
 185         return (NULL);
 186 }
 187
 188 int
 189 bus_dma_get_range_nb(void)
 190 {
 191         return (0);
 192 }
 193
 194 extern void irq_entry(void);
 195
 196 static void
 197 at91_add_child(device_t dev, int prio, const char *name, int unit,
 198     bus_addr_t addr, bus_size_t size, int irq0, int irq1, int irq2)
 199 {
 200         device_t kid;
 201         struct at91_ivar *ivar;
 202
 203         kid = device_add_child_ordered(dev, prio, name, unit);
 204         if (kid == NULL) {
 205             printf("Can't add child %s%d ordered\n", name, unit);
 206             return;
 207         }
 208         ivar = malloc(sizeof(*ivar), M_DEVBUF, M_WAITOK | M_ZERO);
 209         if (ivar == NULL) {
 210                 device_delete_child(dev, kid);
 211                 printf("Can't add alloc ivar\n");
 212                 return;
 213         }
 214         device_set_ivars(kid, ivar);
 215         resource_list_init(&ivar->resources);
 216         if (irq0 != -1)
 217                 bus_set_resource(kid, SYS_RES_IRQ, 0, irq0, 1);
 218         if (irq1 != 0)
 219                 bus_set_resource(kid, SYS_RES_IRQ, 1, irq1, 1);
 220         if (irq2 != 0)
 221                 bus_set_resource(kid, SYS_RES_IRQ, 2, irq2, 1);
 222         if (addr != 0)
 223                 bus_set_resource(kid, SYS_RES_MEMORY, 0, addr, size);
 224 }
 225
 226 struct cpu_devs
 227 {
 228         const char *name;
 229         int unit;
 230         bus_addr_t mem_base;
 231         bus_size_t mem_len;
 232         int irq0;
 233         int irq1;
 234         int irq2;
 235 };
 236
 237 struct cpu_devs at91rm9200_devs[] =
 238 {
 239         // All the "system" devices
 240         {
 241                 "at91_st", 0,
 242                 AT91RM92_BASE + AT91RM92_ST_BASE, AT91RM92_ST_SIZE,
 243                 AT91RM92_IRQ_SYSTEM
 244         },
 245         {
 246                 "at91_pio", 0,
 247                 AT91RM92_BASE + AT91RM92_PIOA_BASE, AT91RM92_PIO_SIZE,
 248                 AT91RM92_IRQ_SYSTEM
 249         },
 250         {
 251                 "at91_pio", 1,
 252                 AT91RM92_BASE + AT91RM92_PIOB_BASE, AT91RM92_PIO_SIZE,
 253                 AT91RM92_IRQ_SYSTEM
 254         },
 255         {
 256                 "at91_pio", 2,
 257                 AT91RM92_BASE + AT91RM92_PIOC_BASE, AT91RM92_PIO_SIZE,
 258                 AT91RM92_IRQ_SYSTEM
 259         },
 260         {
 261                 "at91_pio", 3,
 262                 AT91RM92_BASE + AT91RM92_PIOD_BASE, AT91RM92_PIO_SIZE,
 263                 AT91RM92_IRQ_SYSTEM
 264         },
 265         {
 266                 "at91_pmc", 0,
 267                 AT91RM92_BASE + AT91RM92_PMC_BASE, AT91RM92_PMC_SIZE,
 268                 AT91RM92_IRQ_SYSTEM
 269         },
 270         {
 271                 "at91_aic", 0,
 272                 AT91RM92_BASE + AT91RM92_AIC_BASE, AT91RM92_AIC_SIZE,
 273                 0       // Interrupt controller has no interrupts!
 274         },
 275         {
 276                 "at91_rtc", 0,
 277                 AT91RM92_BASE + AT91RM92_RTC_BASE, AT91RM92_RTC_SIZE,
 278                 AT91RM92_IRQ_SYSTEM
 279         },
 280         {
 281                 "at91_mc", 0,
 282                 AT91RM92_BASE + AT91RM92_MC_BASE, AT91RM92_MC_SIZE,
 283                 AT91RM92_IRQ_SYSTEM
 284         },
 285
 286         // All other devices
 287         {
 288                 "at91_tc", 0,
 289                 AT91RM92_BASE + AT91RM92_TC0_BASE, AT91RM92_TC_SIZE,
 290                 AT91RM92_IRQ_TC0, AT91RM92_IRQ_TC1, AT91RM92_IRQ_TC2
 291         },
 292         {
 293                 "at91_tc", 1,
 294                 AT91RM92_BASE + AT91RM92_TC1_BASE, AT91RM92_TC_SIZE,
 295                 AT91RM92_IRQ_TC3, AT91RM92_IRQ_TC4, AT91RM92_IRQ_TC5
 296         },
 297         {
 298                 "at91_udp", 0,
 299                 AT91RM92_BASE + AT91RM92_UDP_BASE, AT91RM92_UDP_SIZE,
 300                 AT91RM92_IRQ_UDP
 301         },
 302         {
 303                 "at91_mci", 0,
 304                 AT91RM92_BASE + AT91RM92_MCI_BASE, AT91RM92_MCI_SIZE,
 305                 AT91RM92_IRQ_MCI
 306         },
 307         {
 308                 "at91_twi", 0,
 309                 AT91RM92_BASE + AT91RM92_TWI_BASE, AT91RM92_TWI_SIZE,
 310                 AT91RM92_IRQ_TWI
 311         },
 312         {
 313                 "ate", 0,
 314                 AT91RM92_BASE + AT91RM92_EMAC_BASE, AT91RM92_EMAC_SIZE,
 315                 AT91RM92_IRQ_EMAC
 316         },
 317 #ifndef SKYEYE_WORKAROUNDS
 318         {
 319                 "uart", 0,
 320                 AT91RM92_BASE + AT91RM92_DBGU_BASE, AT91RM92_DBGU_SIZE,
 321                 AT91RM92_IRQ_SYSTEM
 322         },
 323         {
 324                 "uart", 1,
 325                 AT91RM92_BASE + AT91RM92_USART0_BASE, AT91RM92_USART_SIZE,
 326                 AT91RM92_IRQ_USART0
 327         },
 328         {
 329                 "uart", 2,
 330                 AT91RM92_BASE + AT91RM92_USART1_BASE, AT91RM92_USART_SIZE,
 331                 AT91RM92_IRQ_USART1
 332         },
 333         {
 334                 "uart", 3,
 335                 AT91RM92_BASE + AT91RM92_USART2_BASE, AT91RM92_USART_SIZE,
 336                 AT91RM92_IRQ_USART2
 337         },
 338         {
 339                 "uart", 4,
 340                 AT91RM92_BASE + AT91RM92_USART3_BASE, AT91RM92_USART_SIZE,
 341                 AT91RM92_IRQ_USART3
 342         },
 343 #else
 344         {
 345                 "uart", 0,
 346                 AT91RM92_BASE + AT91RM92_USART0_BASE, AT91RM92_USART_SIZE,
 347                 AT91RM92_IRQ_USART0
 348         },
 349 #endif
 350         {
 351                 "at91_ssc", 0,
 352                 AT91RM92_BASE + AT91RM92_SSC0_BASE, AT91RM92_SSC_SIZE,
 353                 AT91RM92_IRQ_SSC0
 354         },
 355         {
 356                 "at91_ssc", 1,
 357                 AT91RM92_BASE + AT91RM92_SSC1_BASE, AT91RM92_SSC_SIZE,
 358                 AT91RM92_IRQ_SSC1
 359         },
 360         {
 361                 "at91_ssc", 2,
 362                 AT91RM92_BASE + AT91RM92_SSC2_BASE, AT91RM92_SSC_SIZE,
 363                 AT91RM92_IRQ_SSC2
 364         },
 365         {
 366                 "at91_spi", 0,
 367                 AT91RM92_BASE + AT91RM92_SPI_BASE, AT91RM92_SPI_SIZE,
 368                 AT91RM92_IRQ_SPI
 369         },
 370         {
 371                 "ohci", 0,
 372                 AT91RM92_OHCI_BASE, AT91RM92_OHCI_SIZE,
 373                 AT91RM92_IRQ_UHP
 374         },
 375         {       0, 0, 0, 0, 0 }
 376 };
 377
 378 static void
 379 at91_cpu_add_builtin_children(device_t dev, struct at91_softc *sc)
 380 {
 381         int i;
 382         struct cpu_devs *walker;
 383
 384         // XXX should look at the device id in the DBGU register and
 385         // XXX based on the CPU load in these devices
 386         for (i = 0, walker = at91rm9200_devs; walker->name; i++, walker++) {
 387                 at91_add_child(dev, i, walker->name, walker->unit,
 388                     walker->mem_base, walker->mem_len, walker->irq0,
 389                     walker->irq1, walker->irq2);
 390         }
 391 }
 392
 393 #define NORMDEV 50
 394
 395 static int
 396 at91_attach(device_t dev)
 397 {
 398         struct at91_softc *sc = device_get_softc(dev);
 399         int i;
 400
 401         at91_softc = sc;
 402         sc->sc_st = &at91_bs_tag;
 403         sc->sc_sh = AT91RM92_BASE;
 404         sc->dev = dev;
 405         if (bus_space_subregion(sc->sc_st, sc->sc_sh, AT91RM92_SYS_BASE,
 406             AT91RM92_SYS_SIZE, &sc->sc_sys_sh) != 0)
 407                 panic("Enable to map IRQ registers");
 408         sc->sc_irq_rman.rm_type = RMAN_ARRAY;
 409         sc->sc_irq_rman.rm_descr = "AT91RM92 IRQs";
 410         sc->sc_mem_rman.rm_type = RMAN_ARRAY;
 411         sc->sc_mem_rman.rm_descr = "AT91RM92 Memory";
 412 #if 0
 413         sc->sc_usbmem_rman.rm_type = RMAN_ARRAY;
 414         sc->sc_usbmem_rman.rm_descr = "AT91RM92 USB Memory-mapped regs";
 415 #endif
 416         if (rman_init(&sc->sc_irq_rman) != 0 ||
 417             rman_manage_region(&sc->sc_irq_rman, 1, 31) != 0)
 418                 panic("at91_attach: failed to set up IRQ rman");
 419         if (rman_init(&sc->sc_mem_rman) != 0 ||
 420             rman_manage_region(&sc->sc_mem_rman, 0xfff00000ul,
 421             0xfffffffful) != 0)
 422                 panic("at91_attach: failed to set up memory rman");
 423         if (rman_manage_region(&sc->sc_mem_rman, AT91RM92_OHCI_BASE,
 424             AT91RM92_OHCI_BASE + AT91RM92_OHCI_SIZE - 1) != 0)
 425                 panic("at91_attach: failed to set up ohci memory");
 426
 427         for (i = 0; i < 32; i++) {
 428                 bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_SVR +
 429                     i * 4, i);
 430                 /* Priority. */
 431                 /* XXX: Give better priorities to IRQs */
 432                 bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_SMR + i * 4,
 433                     0);
 434                 if (i < 8)
 435                         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_EOICR,
 436                             1);
 437
 438         }
 439         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_SPU, 32);
 440         /* No debug. */
 441         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_DCR, 0);
 442         /* Disable and clear all interrupts. */
 443         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_IDCR, 0xffffffff);
 444         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_ICCR, 0xffffffff);
 445
 446         /* XXX */
 447         /* Disable all interrupts for RTC (0xe24 == RTC_IDR) */
 448         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, 0xe24, 0xffffffff);
 449         /* DIsable all interrupts for DBGU */
 450         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, 0x20c, 0xffffffff);
 451         /* Disable all interrupts for the SDRAM controller */
 452         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, 0xfa8, 0xffffffff);
 453
 454         at91_cpu_add_builtin_children(dev, sc);
 455
 456         bus_generic_probe(dev);
 457         bus_generic_attach(dev);
 458         enable_interrupts(I32_bit | F32_bit);
 459         return (0);
 460 }
 461
 462 static struct resource *
 463 at91_alloc_resource(device_t dev, device_t child, int type, int *rid,
 464     u_long start, u_long end, u_long count, u_int flags)
 465 {
 466         struct at91_softc *sc = device_get_softc(dev);
 467         struct resource_list_entry *rle;
 468         struct at91_ivar *ivar = device_get_ivars(child);
 469         struct resource_list *rl = &ivar->resources;
 470
 471         if (device_get_parent(child) != dev)
 472                 return (BUS_ALLOC_RESOURCE(device_get_parent(dev), child,
 473                     type, rid, start, end, count, flags));
 474
 475         rle = resource_list_find(rl, type, *rid);
 476         if (rle == NULL)
 477                 return (NULL);
 478         if (rle->res)
 479                 panic("Resource rid %d type %d already in use", *rid, type);
 480         if (start == 0UL && end == ~0UL) {
 481                 start = rle->start;
 482                 count = ulmax(count, rle->count);
 483                 end = ulmax(rle->end, start + count - 1);
 484         }
 485         switch (type)
 486         {
 487         case SYS_RES_IRQ:
 488                 rle->res = rman_reserve_resource(&sc->sc_irq_rman,
 489                     start, end, count, flags, child);
 490                 break;
 491         case SYS_RES_MEMORY:
 492 #if 0
 493                 if (start >= 0x00300000 && start <= 0x003fffff)
 494                         rle->res = rman_reserve_resource(&sc->sc_usbmem_rman,
 495                             start, end, count, flags, child);
 496                 else
 497 #endif
 498                         rle->res = rman_reserve_resource(&sc->sc_mem_rman,
 499                             start, end, count, flags, child);
 500                 rman_set_bustag(rle->res, &at91_bs_tag);
 501                 rman_set_bushandle(rle->res, start);
 502                 break;
 503         }
 504         if (rle->res) {
 505                 rle->start = rman_get_start(rle->res);
 506                 rle->end = rman_get_end(rle->res);
 507                 rle->count = count;
 508                 rman_set_rid(rle->res, *rid);
 509         }
 510         return (rle->res);
 511 }
 512
 513 static struct resource_list *
 514 at91_get_resource_list(device_t dev, device_t child)
 515 {
 516         struct at91_ivar *ivar;
 517
 518         ivar = device_get_ivars(child);
 519         return (&(ivar->resources));
 520 }
 521
 522 static int
 523 at91_release_resource(device_t dev, device_t child, int type,
 524     int rid, struct resource *r)
 525 {
 526         struct resource_list *rl;
 527         struct resource_list_entry *rle;
 528
 529         rl = at91_get_resource_list(dev, child);
 530         if (rl == NULL)
 531                 return (EINVAL);
 532         rle = resource_list_find(rl, type, rid);
 533         if (rle == NULL)
 534                 return (EINVAL);
 535         rman_release_resource(r);
 536         rle->res = NULL;
 537         return (0);
 538 }
 539
 540 static int
 541 at91_setup_intr(device_t dev, device_t child,
 542     struct resource *ires, int flags, driver_intr_t *intr, void *arg,
 543     void **cookiep)
 544 {
 545         struct at91_softc *sc = device_get_softc(dev);
 546
 547         if (rman_get_start(ires) == AT91RM92_IRQ_SYSTEM && !(flags & INTR_FAST))
 548                 panic("All system interrupt ISRs must be type INTR_FAST");
 549         BUS_SETUP_INTR(device_get_parent(dev), child, ires, flags, intr, arg,
 550             cookiep);
 551         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_IECR,
 552             1 << rman_get_start(ires));
 553         return (0);
 554 }
 555
 556 static int
 557 at91_teardown_intr(device_t dev, device_t child, struct resource *res,
 558     void *cookie)
 559 {
 560         struct at91_softc *sc = device_get_softc(dev);
 561
 562         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_IDCR,
 563             1 << rman_get_start(res));
 564         return (BUS_TEARDOWN_INTR(device_get_parent(dev), child, res, cookie));
 565 }
 566
 567 static int
 568 at91_activate_resource(device_t bus, device_t child, int type, int rid,
 569     struct resource *r)
 570 {
 571 #if 0
 572         u_long p;
 573         int error;
 574
 575         if (type == SYS_RES_MEMORY) {
 576                 error = bus_space_map(rman_get_bustag(r),
 577                     rman_get_bushandle(r), rman_get_size(r), 0, &p);
 578                 if (error)
 579                         return (error);
 580                 rman_set_bushandle(r, p);
 581         }
 582 #endif
 583         return (rman_activate_resource(r));
 584 }
 585
 586 static int
 587 at91_print_child(device_t dev, device_t child)
 588 {
 589         struct at91_ivar *ivars;
 590         struct resource_list *rl;
 591         int retval = 0;
 592
 593         ivars = device_get_ivars(child);
 594         rl = &ivars->resources;
 595
 596         retval += bus_print_child_header(dev, child);
 597
 598         retval += resource_list_print_type(rl, "port", SYS_RES_IOPORT, "%#lx");
 599         retval += resource_list_print_type(rl, "mem", SYS_RES_MEMORY, "%#lx");
 600         retval += resource_list_print_type(rl, "irq", SYS_RES_IRQ, "%ld");
 601         if (device_get_flags(dev))
 602                 retval += printf(" flags %#x", device_get_flags(dev));
 603
 604         retval += bus_print_child_footer(dev, child);
 605
 606         return (retval);
 607 }
 608
 609 void
 610 arm_mask_irq(uintptr_t nb)
 611 {
 612
 613         bus_space_write_4(at91_softc->sc_st,
 614             at91_softc->sc_sys_sh, IC_IDCR, 1 << nb);
 615
 616 }
 617
 618 int
 619 arm_get_next_irq()
 620 {
 621
 622         int status;
 623         int irq;
 624
 625         irq = bus_space_read_4(at91_softc->sc_st,
 626             at91_softc->sc_sys_sh, IC_IVR);
 627         status = bus_space_read_4(at91_softc->sc_st,
 628             at91_softc->sc_sys_sh, IC_ISR);
 629         if (status == 0) {
 630                 bus_space_write_4(at91_softc->sc_st,
 631                     at91_softc->sc_sys_sh, IC_EOICR, 1);
 632                 return (-1);
 633         }
 634         return (irq);
 635 }
 636
 637 void
 638 arm_unmask_irq(uintptr_t nb)
 639 {
 640
 641         bus_space_write_4(at91_softc->sc_st,
 642         at91_softc->sc_sys_sh, IC_IECR, 1 << nb);
 643         bus_space_write_4(at91_softc->sc_st, at91_softc->sc_sys_sh,
 644             IC_EOICR, 0);
 645
 646 }
 647
 648 static device_method_t at91_methods[] = {
 649         DEVMETHOD(device_probe, at91_probe),
 650         DEVMETHOD(device_attach, at91_attach),
 651         DEVMETHOD(device_identify, at91_identify),
 652
 653         DEVMETHOD(bus_alloc_resource, at91_alloc_resource),
 654         DEVMETHOD(bus_setup_intr, at91_setup_intr),
 655         DEVMETHOD(bus_teardown_intr, at91_teardown_intr),
 656         DEVMETHOD(bus_activate_resource, at91_activate_resource),
 657         DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
 658         DEVMETHOD(bus_get_resource_list,at91_get_resource_list),
 659         DEVMETHOD(bus_set_resource,     bus_generic_rl_set_resource),
 660         DEVMETHOD(bus_get_resource,     bus_generic_rl_get_resource),
 661         DEVMETHOD(bus_release_resource, at91_release_resource),
 662         DEVMETHOD(bus_print_child,      at91_print_child),
 663
 664         {0, 0},
 665 };
 666
 667 static driver_t at91_driver = {
 668         "atmelarm",
 669         at91_methods,
 670         sizeof(struct at91_softc),
 671 };
 672 static devclass_t at91_devclass;
 673
 674 DRIVER_MODULE(atmelarm, nexus, at91_driver, at91_devclass, 0, 0);