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                 *bshp = pa - 0xf0000000 + 0xd0000000;
  59                 return (0);
  60         }
  61         if (pa >= 0xdff00000)
  62                 return (0);
  63         endpa = round_page(bpa + size);
  64
  65         *bshp = (vm_offset_t)pmap_mapdev(pa, endpa - pa);
  66
  67         return (0);
  68 }
  69
  70 static void
  71 at91_bs_unmap(void *t, bus_space_handle_t h, bus_size_t size)
  72 {
  73         vm_offset_t va, endva;
  74
  75         va = trunc_page((vm_offset_t)t);
  76         endva = va + round_page(size);
  77
  78         /* Free the kernel virtual mapping. */
  79         kmem_free(kernel_map, va, endva - va);
  80 }
  81
  82 static int
  83 at91_bs_subregion(void *t, bus_space_handle_t bsh, bus_size_t offset,
  84     bus_size_t size, bus_space_handle_t *nbshp)
  85 {
  86
  87         *nbshp = bsh + offset;
  88         return (0);
  89 }
  90
  91 static void
  92 at91_barrier(void *t, bus_space_handle_t bsh, bus_size_t size, bus_size_t b,
  93     int a)
  94 {
  95 }
  96
  97 bs_protos(generic);
  98 bs_protos(generic_armv4);
  99
 100 struct bus_space at91_bs_tag = {
 101         /* cookie */
 102         (void *) 0,
 103
 104         /* mapping/unmapping */
 105         at91_bs_map,
 106         at91_bs_unmap,
 107         at91_bs_subregion,
 108
 109         /* allocation/deallocation */
 110         NULL,
 111         NULL,
 112
 113         /* barrier */
 114         at91_barrier,
 115
 116         /* read (single) */
 117         generic_bs_r_1,
 118         generic_armv4_bs_r_2,
 119         generic_bs_r_4,
 120         NULL,
 121
 122         /* read multiple */
 123         generic_bs_rm_1,
 124         generic_armv4_bs_rm_2,
 125         generic_bs_rm_4,
 126         NULL,
 127
 128         /* read region */
 129         generic_bs_rr_1,
 130         generic_armv4_bs_rr_2,
 131         generic_bs_rr_4,
 132         NULL,
 133
 134         /* write (single) */
 135         generic_bs_w_1,
 136         generic_armv4_bs_w_2,
 137         generic_bs_w_4,
 138         NULL,
 139
 140         /* write multiple */
 141         generic_bs_wm_1,
 142         generic_armv4_bs_wm_2,
 143         generic_bs_wm_4,
 144         NULL,
 145
 146         /* write region */
 147         NULL,
 148         generic_armv4_bs_wr_2,
 149         generic_bs_wr_4,
 150         NULL,
 151
 152         /* set multiple */
 153         NULL,
 154         NULL,
 155         NULL,
 156         NULL,
 157
 158         /* set region */
 159         NULL,
 160         generic_armv4_bs_sr_2,
 161         generic_bs_sr_4,
 162         NULL,
 163
 164         /* copy */
 165         NULL,
 166         generic_armv4_bs_c_2,
 167         NULL,
 168         NULL,
 169
 170         /* read (single) stream */
 171         generic_bs_r_1,
 172         generic_armv4_bs_r_2,
 173         generic_bs_r_4,
 174         NULL,
 175
 176         /* read multiple stream */
 177         generic_bs_rm_1,
 178         generic_armv4_bs_rm_2,
 179         generic_bs_rm_4,
 180         NULL,
 181
 182         /* read region stream */
 183         generic_bs_rr_1,
 184         generic_armv4_bs_rr_2,
 185         generic_bs_rr_4,
 186         NULL,
 187
 188         /* write (single) stream */
 189         generic_bs_w_1,
 190         generic_armv4_bs_w_2,
 191         generic_bs_w_4,
 192         NULL,
 193
 194         /* write multiple stream */
 195         generic_bs_wm_1,
 196         generic_armv4_bs_wm_2,
 197         generic_bs_wm_4,
 198         NULL,
 199
 200         /* write region stream */
 201         NULL,
 202         generic_armv4_bs_wr_2,
 203         generic_bs_wr_4,
 204         NULL,
 205 };
 206
 207 static int
 208 at91_probe(device_t dev)
 209 {
 210         device_set_desc(dev, "AT91 device bus");
 211         return (0);
 212 }
 213
 214 static void
 215 at91_identify(driver_t *drv, device_t parent)
 216 {
 217
 218         BUS_ADD_CHILD(parent, 0, "atmelarm", 0);
 219 }
 220
 221 struct arm32_dma_range *
 222 bus_dma_get_range(void)
 223 {
 224
 225         return (NULL);
 226 }
 227
 228 int
 229 bus_dma_get_range_nb(void)
 230 {
 231         return (0);
 232 }
 233
 234 extern void irq_entry(void);
 235
 236 static void
 237 at91_add_child(device_t dev, int prio, const char *name, int unit,
 238     bus_addr_t addr, bus_size_t size, int irq0, int irq1, int irq2)
 239 {
 240         device_t kid;
 241         struct at91_ivar *ivar;
 242
 243         kid = device_add_child_ordered(dev, prio, name, unit);
 244         if (kid == NULL) {
 245             printf("Can't add child %s%d ordered\n", name, unit);
 246             return;
 247         }
 248         ivar = malloc(sizeof(*ivar), M_DEVBUF, M_NOWAIT | M_ZERO);
 249         if (ivar == NULL) {
 250                 device_delete_child(dev, kid);
 251                 printf("Can't add alloc ivar\n");
 252                 return;
 253         }
 254         device_set_ivars(kid, ivar);
 255         resource_list_init(&ivar->resources);
 256         if (irq0 != -1)
 257                 bus_set_resource(kid, SYS_RES_IRQ, 0, irq0, 1);
 258         if (irq1 != 0)
 259                 bus_set_resource(kid, SYS_RES_IRQ, 1, irq1, 1);
 260         if (irq2 != 0)
 261                 bus_set_resource(kid, SYS_RES_IRQ, 2, irq2, 1);
 262         if (addr != 0)
 263                 bus_set_resource(kid, SYS_RES_MEMORY, 0, addr, size);
 264 }
 265
 266 struct cpu_devs
 267 {
 268         const char *name;
 269         int unit;
 270         bus_addr_t mem_base;
 271         bus_size_t mem_len;
 272         int irq0;
 273         int irq1;
 274         int irq2;
 275 };
 276
 277 struct cpu_devs at91rm9200_devs[] =
 278 {
 279         // All the "system" devices
 280         {
 281                 "at91_st", 0,
 282                 AT91RM92_BASE + AT91RM92_ST_BASE, AT91RM92_ST_SIZE,
 283                 AT91RM92_IRQ_SYSTEM
 284         },
 285         {
 286                 "at91_pio", 0,
 287                 AT91RM92_BASE + AT91RM92_PIOA_BASE, AT91RM92_PIO_SIZE,
 288                 AT91RM92_IRQ_SYSTEM
 289         },
 290         {
 291                 "at91_pio", 1,
 292                 AT91RM92_BASE + AT91RM92_PIOB_BASE, AT91RM92_PIO_SIZE,
 293                 AT91RM92_IRQ_SYSTEM
 294         },
 295         {
 296                 "at91_pio", 2,
 297                 AT91RM92_BASE + AT91RM92_PIOC_BASE, AT91RM92_PIO_SIZE,
 298                 AT91RM92_IRQ_SYSTEM
 299         },
 300         {
 301                 "at91_pio", 3,
 302                 AT91RM92_BASE + AT91RM92_PIOD_BASE, AT91RM92_PIO_SIZE,
 303                 AT91RM92_IRQ_SYSTEM
 304         },
 305         {
 306                 "at91_pmc", 0,
 307                 AT91RM92_BASE + AT91RM92_PMC_BASE, AT91RM92_PMC_SIZE,
 308                 AT91RM92_IRQ_SYSTEM
 309         },
 310         {
 311                 "at91_aic", 0,
 312                 AT91RM92_BASE + AT91RM92_AIC_BASE, AT91RM92_AIC_SIZE,
 313                 0       // Interrupt controller has no interrupts!
 314         },
 315         {
 316                 "at91_rtc", 0,
 317                 AT91RM92_BASE + AT91RM92_RTC_BASE, AT91RM92_RTC_SIZE,
 318                 AT91RM92_IRQ_SYSTEM
 319         },
 320         {
 321                 "at91_mc", 0,
 322                 AT91RM92_BASE + AT91RM92_MC_BASE, AT91RM92_MC_SIZE,
 323                 AT91RM92_IRQ_SYSTEM
 324         },
 325
 326         // All other devices
 327         {
 328                 "at91_tc", 0,
 329                 AT91RM92_BASE + AT91RM92_TC0_BASE, AT91RM92_TC_SIZE,
 330                 AT91RM92_IRQ_TC0, AT91RM92_IRQ_TC1, AT91RM92_IRQ_TC2
 331         },
 332         {
 333                 "at91_tc", 1,
 334                 AT91RM92_BASE + AT91RM92_TC1_BASE, AT91RM92_TC_SIZE,
 335                 AT91RM92_IRQ_TC3, AT91RM92_IRQ_TC4, AT91RM92_IRQ_TC5
 336         },
 337         {
 338                 "at91_udp", 0,
 339                 AT91RM92_BASE + AT91RM92_UDP_BASE, AT91RM92_UDP_SIZE,
 340                 AT91RM92_IRQ_UDP
 341         },
 342         {
 343                 "at91_mci", 0,
 344                 AT91RM92_BASE + AT91RM92_MCI_BASE, AT91RM92_MCI_SIZE,
 345                 AT91RM92_IRQ_MCI
 346         },
 347         {
 348                 "at91_twi", 0,
 349                 AT91RM92_BASE + AT91RM92_TWI_BASE, AT91RM92_TWI_SIZE,
 350                 AT91RM92_IRQ_TWI
 351         },
 352         {
 353                 "ate", 0,
 354                 AT91RM92_BASE + AT91RM92_EMAC_BASE, AT91RM92_EMAC_SIZE,
 355                 AT91RM92_IRQ_EMAC
 356         },
 357 #ifndef SKYEYE_WORKAROUNDS
 358         {
 359                 "uart", 0,
 360                 AT91RM92_BASE + AT91RM92_DBGU_BASE, AT91RM92_DBGU_SIZE,
 361                 AT91RM92_IRQ_SYSTEM
 362         },
 363         {
 364                 "uart", 1,
 365                 AT91RM92_BASE + AT91RM92_USART0_BASE, AT91RM92_USART_SIZE,
 366                 AT91RM92_IRQ_USART0
 367         },
 368         {
 369                 "uart", 2,
 370                 AT91RM92_BASE + AT91RM92_USART1_BASE, AT91RM92_USART_SIZE,
 371                 AT91RM92_IRQ_USART1
 372         },
 373         {
 374                 "uart", 3,
 375                 AT91RM92_BASE + AT91RM92_USART2_BASE, AT91RM92_USART_SIZE,
 376                 AT91RM92_IRQ_USART2
 377         },
 378         {
 379                 "uart", 4,
 380                 AT91RM92_BASE + AT91RM92_USART3_BASE, AT91RM92_USART_SIZE,
 381                 AT91RM92_IRQ_USART3
 382         },
 383 #else
 384         {
 385                 "uart", 0,
 386                 AT91RM92_BASE + AT91RM92_USART0_BASE, AT91RM92_USART_SIZE,
 387                 AT91RM92_IRQ_USART0
 388         },
 389 #endif
 390         {
 391                 "at91_ssc", 0,
 392                 AT91RM92_BASE + AT91RM92_SSC0_BASE, AT91RM92_SSC_SIZE,
 393                 AT91RM92_IRQ_SSC0
 394         },
 395         {
 396                 "at91_ssc", 1,
 397                 AT91RM92_BASE + AT91RM92_SSC1_BASE, AT91RM92_SSC_SIZE,
 398                 AT91RM92_IRQ_SSC1
 399         },
 400         {
 401                 "at91_ssc", 2,
 402                 AT91RM92_BASE + AT91RM92_SSC2_BASE, AT91RM92_SSC_SIZE,
 403                 AT91RM92_IRQ_SSC2
 404         },
 405         {
 406                 "at91_spi", 0,
 407                 AT91RM92_BASE + AT91RM92_SPI_BASE, AT91RM92_SPI_SIZE,
 408                 AT91RM92_IRQ_SPI
 409         },
 410         {
 411                 "ohci", 0,
 412                 AT91RM92_OHCI_BASE, AT91RM92_OHCI_SIZE,
 413                 AT91RM92_IRQ_UHP
 414         },
 415         {       0, 0, 0, 0, 0 }
 416 };
 417
 418 static void
 419 at91_cpu_add_builtin_children(device_t dev, struct at91_softc *sc)
 420 {
 421         int i;
 422         struct cpu_devs *walker;
 423
 424         // XXX should look at the device id in the DBGU register and
 425         // XXX based on the CPU load in these devices
 426         for (i = 0, walker = at91rm9200_devs; walker->name; i++, walker++) {
 427                 at91_add_child(dev, i, walker->name, walker->unit,
 428                     walker->mem_base, walker->mem_len, walker->irq0,
 429                     walker->irq1, walker->irq2);
 430         }
 431 }
 432
 433 #define NORMDEV 50
 434
 435 /*
 436  * Standard priority levels for the system.  0 is lowest and 7 is highest.
 437  * These values are the ones Atmel uses for its Linux port, which differ
 438  * a little form the ones that are in the standard distribution.  Also,
 439  * the ones marked with 'TWEEK' are different based on experience.
 440  */
 441 static int irq_prio[32] =
 442 {
 443         7,      /* Advanced Interrupt Controller (FIQ) */
 444         7,      /* System Peripherals */
 445         1,      /* Parallel IO Controller A */
 446         1,      /* Parallel IO Controller B */
 447         1,      /* Parallel IO Controller C */
 448         1,      /* Parallel IO Controller D */
 449         5,      /* USART 0 */
 450         5,      /* USART 1 */
 451         5,      /* USART 2 */
 452         5,      /* USART 3 */
 453         0,      /* Multimedia Card Interface */
 454         2,      /* USB Device Port */
 455         4,      /* Two-Wire Interface */                /* TWEEK */
 456         5,      /* Serial Peripheral Interface */
 457         4,      /* Serial Synchronous Controller 0 */
 458         6,      /* Serial Synchronous Controller 1 */   /* TWEEK */
 459         4,      /* Serial Synchronous Controller 2 */
 460         0,      /* Timer Counter 0 */
 461         6,      /* Timer Counter 1 */                   /* TWEEK */
 462         0,      /* Timer Counter 2 */
 463         0,      /* Timer Counter 3 */
 464         0,      /* Timer Counter 4 */
 465         0,      /* Timer Counter 5 */
 466         2,      /* USB Host port */
 467         3,      /* Ethernet MAC */
 468         0,      /* Advanced Interrupt Controller (IRQ0) */
 469         0,      /* Advanced Interrupt Controller (IRQ1) */
 470         0,      /* Advanced Interrupt Controller (IRQ2) */
 471         0,      /* Advanced Interrupt Controller (IRQ3) */
 472         0,      /* Advanced Interrupt Controller (IRQ4) */
 473         0,      /* Advanced Interrupt Controller (IRQ5) */
 474         0       /* Advanced Interrupt Controller (IRQ6) */
 475 };
 476
 477 static int
 478 at91_attach(device_t dev)
 479 {
 480         struct at91_softc *sc = device_get_softc(dev);
 481         int i;
 482
 483         at91_softc = sc;
 484         sc->sc_st = &at91_bs_tag;
 485         sc->sc_sh = AT91RM92_BASE;
 486         sc->dev = dev;
 487         if (bus_space_subregion(sc->sc_st, sc->sc_sh, AT91RM92_SYS_BASE,
 488             AT91RM92_SYS_SIZE, &sc->sc_sys_sh) != 0)
 489                 panic("Enable to map IRQ registers");
 490         sc->sc_irq_rman.rm_type = RMAN_ARRAY;
 491         sc->sc_irq_rman.rm_descr = "AT91 IRQs";
 492         sc->sc_mem_rman.rm_type = RMAN_ARRAY;
 493         sc->sc_mem_rman.rm_descr = "AT91 Memory";
 494 #if 0
 495         sc->sc_usbmem_rman.rm_type = RMAN_ARRAY;
 496         sc->sc_usbmem_rman.rm_descr = "AT91RM9200 USB Memory-mapped regs";
 497 #endif
 498         if (rman_init(&sc->sc_irq_rman) != 0 ||
 499             rman_manage_region(&sc->sc_irq_rman, 1, 31) != 0)
 500                 panic("at91_attach: failed to set up IRQ rman");
 501         if (rman_init(&sc->sc_mem_rman) != 0 ||
 502             rman_manage_region(&sc->sc_mem_rman, 0xdff00000ul,
 503             0xdffffffful) != 0)
 504                 panic("at91_attach: failed to set up memory rman");
 505         if (rman_manage_region(&sc->sc_mem_rman, AT91RM92_OHCI_BASE,
 506             AT91RM92_OHCI_BASE + AT91RM92_OHCI_SIZE - 1) != 0)
 507                 panic("at91_attach: failed to set up ohci memory");
 508
 509         for (i = 0; i < 32; i++) {
 510                 bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_SVR +
 511                     i * 4, i);
 512                 /* Priority. */
 513                 bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_SMR + i * 4,
 514                     irq_prio[i]);
 515                 if (i < 8)
 516                         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_EOICR,
 517                             1);
 518         }
 519         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_SPU, 32);
 520         /* No debug. */
 521         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_DCR, 0);
 522         /* Disable and clear all interrupts. */
 523         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_IDCR, 0xffffffff);
 524         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_ICCR, 0xffffffff);
 525
 526         /* XXX */
 527         /* Disable all interrupts for RTC (0xe24 == RTC_IDR) */
 528         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, 0xe24, 0xffffffff);
 529         /* DIsable all interrupts for DBGU */
 530         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, 0x20c, 0xffffffff);
 531         /* Disable all interrupts for the SDRAM controller */
 532         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, 0xfa8, 0xffffffff);
 533
 534         at91_cpu_add_builtin_children(dev, sc);
 535
 536         bus_generic_probe(dev);
 537         bus_generic_attach(dev);
 538         enable_interrupts(I32_bit | F32_bit);
 539         return (0);
 540 }
 541
 542 static struct resource *
 543 at91_alloc_resource(device_t dev, device_t child, int type, int *rid,
 544     u_long start, u_long end, u_long count, u_int flags)
 545 {
 546         struct at91_softc *sc = device_get_softc(dev);
 547         struct resource_list_entry *rle;
 548         struct at91_ivar *ivar = device_get_ivars(child);
 549         struct resource_list *rl = &ivar->resources;
 550
 551         if (device_get_parent(child) != dev)
 552                 return (BUS_ALLOC_RESOURCE(device_get_parent(dev), child,
 553                     type, rid, start, end, count, flags));
 554
 555         rle = resource_list_find(rl, type, *rid);
 556         if (rle == NULL)
 557                 return (NULL);
 558         if (rle->res)
 559                 panic("Resource rid %d type %d already in use", *rid, type);
 560         if (start == 0UL && end == ~0UL) {
 561                 start = rle->start;
 562                 count = ulmax(count, rle->count);
 563                 end = ulmax(rle->end, start + count - 1);
 564         }
 565         switch (type)
 566         {
 567         case SYS_RES_IRQ:
 568                 rle->res = rman_reserve_resource(&sc->sc_irq_rman,
 569                     start, end, count, flags, child);
 570                 break;
 571         case SYS_RES_MEMORY:
 572 #if 0
 573                 if (start >= 0x00300000 && start <= 0x003fffff)
 574                         rle->res = rman_reserve_resource(&sc->sc_usbmem_rman,
 575                             start, end, count, flags, child);
 576                 else
 577 #endif
 578                         rle->res = rman_reserve_resource(&sc->sc_mem_rman,
 579                             start, end, count, flags, child);
 580                 if (rle->res != NULL) {
 581                         rman_set_bustag(rle->res, &at91_bs_tag);
 582                         rman_set_bushandle(rle->res, start);
 583                 }
 584                 break;
 585         }
 586         if (rle->res) {
 587                 rle->start = rman_get_start(rle->res);
 588                 rle->end = rman_get_end(rle->res);
 589                 rle->count = count;
 590                 rman_set_rid(rle->res, *rid);
 591         }
 592         return (rle->res);
 593 }
 594
 595 static struct resource_list *
 596 at91_get_resource_list(device_t dev, device_t child)
 597 {
 598         struct at91_ivar *ivar;
 599
 600         ivar = device_get_ivars(child);
 601         return (&(ivar->resources));
 602 }
 603
 604 static int
 605 at91_release_resource(device_t dev, device_t child, int type,
 606     int rid, struct resource *r)
 607 {
 608         struct resource_list *rl;
 609         struct resource_list_entry *rle;
 610
 611         rl = at91_get_resource_list(dev, child);
 612         if (rl == NULL)
 613                 return (EINVAL);
 614         rle = resource_list_find(rl, type, rid);
 615         if (rle == NULL)
 616                 return (EINVAL);
 617         rman_release_resource(r);
 618         rle->res = NULL;
 619         return (0);
 620 }
 621
 622 static int
 623 at91_setup_intr(device_t dev, device_t child,
 624     struct resource *ires, int flags, driver_filter_t *filt,
 625     driver_intr_t *intr, void *arg, void **cookiep)
 626 {
 627         struct at91_softc *sc = device_get_softc(dev);
 628
 629         if (rman_get_start(ires) == AT91RM92_IRQ_SYSTEM && filt == NULL)
 630                 panic("All system interrupt ISRs must be FILTER");
 631         BUS_SETUP_INTR(device_get_parent(dev), child, ires, flags, filt,
 632             intr, arg, cookiep);
 633         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_IECR,
 634             1 << rman_get_start(ires));
 635         return (0);
 636 }
 637
 638 static int
 639 at91_teardown_intr(device_t dev, device_t child, struct resource *res,
 640     void *cookie)
 641 {
 642         struct at91_softc *sc = device_get_softc(dev);
 643
 644         bus_space_write_4(sc->sc_st, sc->sc_sys_sh, IC_IDCR,
 645             1 << rman_get_start(res));
 646         return (BUS_TEARDOWN_INTR(device_get_parent(dev), child, res, cookie));
 647 }
 648
 649 static int
 650 at91_activate_resource(device_t bus, device_t child, int type, int rid,
 651     struct resource *r)
 652 {
 653 #if 0
 654         u_long p;
 655         int error;
 656
 657         if (type == SYS_RES_MEMORY) {
 658                 error = bus_space_map(rman_get_bustag(r),
 659                     rman_get_bushandle(r), rman_get_size(r), 0, &p);
 660                 if (error)
 661                         return (error);
 662                 rman_set_bushandle(r, p);
 663         }
 664 #endif
 665         return (rman_activate_resource(r));
 666 }
 667
 668 static int
 669 at91_print_child(device_t dev, device_t child)
 670 {
 671         struct at91_ivar *ivars;
 672         struct resource_list *rl;
 673         int retval = 0;
 674
 675         ivars = device_get_ivars(child);
 676         rl = &ivars->resources;
 677
 678         retval += bus_print_child_header(dev, child);
 679
 680         retval += resource_list_print_type(rl, "port", SYS_RES_IOPORT, "%#lx");
 681         retval += resource_list_print_type(rl, "mem", SYS_RES_MEMORY, "%#lx");
 682         retval += resource_list_print_type(rl, "irq", SYS_RES_IRQ, "%ld");
 683         if (device_get_flags(dev))
 684                 retval += printf(" flags %#x", device_get_flags(dev));
 685
 686         retval += bus_print_child_footer(dev, child);
 687
 688         return (retval);
 689 }
 690
 691 void
 692 arm_mask_irq(uintptr_t nb)
 693 {
 694
 695         bus_space_write_4(at91_softc->sc_st,
 696             at91_softc->sc_sys_sh, IC_IDCR, 1 << nb);
 697
 698 }
 699
 700 int
 701 arm_get_next_irq()
 702 {
 703
 704         int status;
 705         int irq;
 706
 707         irq = bus_space_read_4(at91_softc->sc_st,
 708             at91_softc->sc_sys_sh, IC_IVR);
 709         status = bus_space_read_4(at91_softc->sc_st,
 710             at91_softc->sc_sys_sh, IC_ISR);
 711         if (status == 0) {
 712                 bus_space_write_4(at91_softc->sc_st,
 713                     at91_softc->sc_sys_sh, IC_EOICR, 1);
 714                 return (-1);
 715         }
 716         return (irq);
 717 }
 718
 719 void
 720 arm_unmask_irq(uintptr_t nb)
 721 {
 722
 723         bus_space_write_4(at91_softc->sc_st,
 724         at91_softc->sc_sys_sh, IC_IECR, 1 << nb);
 725         bus_space_write_4(at91_softc->sc_st, at91_softc->sc_sys_sh,
 726             IC_EOICR, 0);
 727
 728 }
 729
 730 static device_method_t at91_methods[] = {
 731         DEVMETHOD(device_probe, at91_probe),
 732         DEVMETHOD(device_attach, at91_attach),
 733         DEVMETHOD(device_identify, at91_identify),
 734
 735         DEVMETHOD(bus_alloc_resource, at91_alloc_resource),
 736         DEVMETHOD(bus_setup_intr, at91_setup_intr),
 737         DEVMETHOD(bus_teardown_intr, at91_teardown_intr),
 738         DEVMETHOD(bus_activate_resource, at91_activate_resource),
 739         DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
 740         DEVMETHOD(bus_get_resource_list,at91_get_resource_list),
 741         DEVMETHOD(bus_set_resource,     bus_generic_rl_set_resource),
 742         DEVMETHOD(bus_get_resource,     bus_generic_rl_get_resource),
 743         DEVMETHOD(bus_release_resource, at91_release_resource),
 744         DEVMETHOD(bus_print_child,      at91_print_child),
 745
 746         {0, 0},
 747 };
 748
 749 static driver_t at91_driver = {
 750         "atmelarm",
 751         at91_methods,
 752         sizeof(struct at91_softc),
 753 };
 754 static devclass_t at91_devclass;
 755
 756 DRIVER_MODULE(atmelarm, nexus, at91_driver, at91_devclass, 0, 0);