The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/arm/at91/at91.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    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: releng/7.3/sys/arm/at91/at91.c 187389 2009-01-18 12:12:38Z stas $");
   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);

Cache object: a6eb22a02e58c3c2db716a06c83e3fc5


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.