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