at91.c revision 238334
1155324Simp/*- 2155324Simp * Copyright (c) 2005 Olivier Houchard. All rights reserved. 3213496Scognet * Copyright (c) 2010 Greg Ansley. All rights reserved. 4155324Simp * 5155324Simp * Redistribution and use in source and binary forms, with or without 6155324Simp * modification, are permitted provided that the following conditions 7155324Simp * are met: 8155324Simp * 1. Redistributions of source code must retain the above copyright 9155324Simp * notice, this list of conditions and the following disclaimer. 10155324Simp * 2. Redistributions in binary form must reproduce the above copyright 11155324Simp * notice, this list of conditions and the following disclaimer in the 12155324Simp * documentation and/or other materials provided with the distribution. 13155324Simp * 14185265Simp * THIS SOFTWARE IS PROVIDED BY AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15185265Simp * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16185265Simp * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17185265Simp * ARE DISCLAIMED. IN NO EVENT SHALL AUTHOR OR CONTRIBUTORS BE LIABLE 18185265Simp * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19185265Simp * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20185265Simp * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21185265Simp * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22185265Simp * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23185265Simp * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24185265Simp * SUCH DAMAGE. 25155324Simp */ 26155324Simp 27155324Simp#include <sys/cdefs.h> 28155324Simp__FBSDID("$FreeBSD: head/sys/arm/at91/at91.c 238334 2012-07-10 04:17:49Z imp $"); 29155324Simp 30155324Simp#include <sys/param.h> 31155324Simp#include <sys/systm.h> 32155324Simp#include <sys/bus.h> 33155324Simp#include <sys/kernel.h> 34155324Simp#include <sys/malloc.h> 35155324Simp#include <sys/module.h> 36155324Simp 37155324Simp#include <vm/vm.h> 38155324Simp#include <vm/vm_kern.h> 39155324Simp#include <vm/pmap.h> 40155324Simp#include <vm/vm_page.h> 41155324Simp#include <vm/vm_extern.h> 42155324Simp 43155324Simp#define _ARM32_BUS_DMA_PRIVATE 44155324Simp#include <machine/bus.h> 45155324Simp#include <machine/intr.h> 46155324Simp 47155324Simp#include <arm/at91/at91var.h> 48213496Scognet#include <arm/at91/at91_pmcvar.h> 49213496Scognet#include <arm/at91/at91_aicreg.h> 50155324Simp 51155324Simpstatic struct at91_softc *at91_softc; 52155324Simp 53178366Scognetstatic void at91_eoi(void *); 54178366Scognet 55213496Scognetextern const struct pmap_devmap at91_devmap[]; 56213496Scognet 57213496Scognetuint32_t at91_master_clock; 58187599Simp 59155324Simpstatic int 60155324Simpat91_bs_map(void *t, bus_addr_t bpa, bus_size_t size, int flags, 61155324Simp bus_space_handle_t *bshp) 62155324Simp{ 63155324Simp vm_paddr_t pa, endpa; 64155324Simp 65155324Simp pa = trunc_page(bpa); 66235718Simp if (pa >= AT91_PA_BASE + 0xff00000) { 67235718Simp *bshp = pa - AT91_PA_BASE + AT91_BASE; 68155324Simp return (0); 69161704Scognet } 70235718Simp if (pa >= AT91_BASE + 0xff00000) 71161704Scognet return (0); 72155324Simp endpa = round_page(bpa + size); 73155324Simp 74155324Simp *bshp = (vm_offset_t)pmap_mapdev(pa, endpa - pa); 75236989Simp 76155324Simp return (0); 77155324Simp} 78155324Simp 79155324Simpstatic void 80164425Ssamat91_bs_unmap(void *t, bus_space_handle_t h, bus_size_t size) 81155324Simp{ 82155324Simp vm_offset_t va, endva; 83155324Simp 84155324Simp va = trunc_page((vm_offset_t)t); 85155324Simp endva = va + round_page(size); 86155324Simp 87155324Simp /* Free the kernel virtual mapping. */ 88155324Simp kmem_free(kernel_map, va, endva - va); 89155324Simp} 90155324Simp 91155324Simpstatic int 92155324Simpat91_bs_subregion(void *t, bus_space_handle_t bsh, bus_size_t offset, 93155324Simp bus_size_t size, bus_space_handle_t *nbshp) 94155324Simp{ 95155324Simp 96155324Simp *nbshp = bsh + offset; 97155324Simp return (0); 98155324Simp} 99155324Simp 100156828Simpstatic void 101236989Simpat91_barrier(void *t, bus_space_handle_t bsh, bus_size_t size, bus_size_t b, 102156828Simp int a) 103156828Simp{ 104156828Simp} 105156828Simp 106213496Scognetstruct arm32_dma_range * 107213496Scognetbus_dma_get_range(void) 108213496Scognet{ 109213496Scognet 110213496Scognet return (NULL); 111213496Scognet} 112213496Scognet 113213496Scognetint 114213496Scognetbus_dma_get_range_nb(void) 115213496Scognet{ 116213496Scognet return (0); 117213496Scognet} 118213496Scognet 119155324Simpbs_protos(generic); 120155324Simpbs_protos(generic_armv4); 121155324Simp 122155324Simpstruct bus_space at91_bs_tag = { 123155324Simp /* cookie */ 124155324Simp (void *) 0, 125155324Simp 126155324Simp /* mapping/unmapping */ 127155324Simp at91_bs_map, 128155324Simp at91_bs_unmap, 129155324Simp at91_bs_subregion, 130155324Simp 131155324Simp /* allocation/deallocation */ 132155324Simp NULL, 133155324Simp NULL, 134155324Simp 135155324Simp /* barrier */ 136156828Simp at91_barrier, 137155324Simp 138155324Simp /* read (single) */ 139155324Simp generic_bs_r_1, 140155324Simp generic_armv4_bs_r_2, 141155324Simp generic_bs_r_4, 142155324Simp NULL, 143155324Simp 144155324Simp /* read multiple */ 145155324Simp generic_bs_rm_1, 146155324Simp generic_armv4_bs_rm_2, 147155324Simp generic_bs_rm_4, 148155324Simp NULL, 149155324Simp 150155324Simp /* read region */ 151158746Scognet generic_bs_rr_1, 152155324Simp generic_armv4_bs_rr_2, 153155324Simp generic_bs_rr_4, 154155324Simp NULL, 155155324Simp 156155324Simp /* write (single) */ 157155324Simp generic_bs_w_1, 158155324Simp generic_armv4_bs_w_2, 159155324Simp generic_bs_w_4, 160155324Simp NULL, 161155324Simp 162155324Simp /* write multiple */ 163155324Simp generic_bs_wm_1, 164155324Simp generic_armv4_bs_wm_2, 165155324Simp generic_bs_wm_4, 166155324Simp NULL, 167155324Simp 168155324Simp /* write region */ 169155324Simp NULL, 170155324Simp generic_armv4_bs_wr_2, 171155324Simp generic_bs_wr_4, 172155324Simp NULL, 173155324Simp 174155324Simp /* set multiple */ 175155324Simp NULL, 176155324Simp NULL, 177155324Simp NULL, 178155324Simp NULL, 179155324Simp 180155324Simp /* set region */ 181155324Simp NULL, 182155324Simp generic_armv4_bs_sr_2, 183155324Simp generic_bs_sr_4, 184155324Simp NULL, 185155324Simp 186155324Simp /* copy */ 187155324Simp NULL, 188155324Simp generic_armv4_bs_c_2, 189155324Simp NULL, 190155324Simp NULL, 191184310Sstas 192184310Sstas /* read (single) stream */ 193184310Sstas generic_bs_r_1, 194184310Sstas generic_armv4_bs_r_2, 195184310Sstas generic_bs_r_4, 196184310Sstas NULL, 197184310Sstas 198184310Sstas /* read multiple stream */ 199184310Sstas generic_bs_rm_1, 200184310Sstas generic_armv4_bs_rm_2, 201184310Sstas generic_bs_rm_4, 202184310Sstas NULL, 203184310Sstas 204184310Sstas /* read region stream */ 205184310Sstas generic_bs_rr_1, 206184310Sstas generic_armv4_bs_rr_2, 207184310Sstas generic_bs_rr_4, 208184310Sstas NULL, 209184310Sstas 210184310Sstas /* write (single) stream */ 211184310Sstas generic_bs_w_1, 212184310Sstas generic_armv4_bs_w_2, 213184310Sstas generic_bs_w_4, 214184310Sstas NULL, 215184310Sstas 216184310Sstas /* write multiple stream */ 217184310Sstas generic_bs_wm_1, 218184310Sstas generic_armv4_bs_wm_2, 219184310Sstas generic_bs_wm_4, 220184310Sstas NULL, 221184310Sstas 222184310Sstas /* write region stream */ 223184310Sstas NULL, 224184310Sstas generic_armv4_bs_wr_2, 225184310Sstas generic_bs_wr_4, 226184310Sstas NULL, 227155324Simp}; 228155324Simp 229155324Simpstatic int 230155324Simpat91_probe(device_t dev) 231155324Simp{ 232213496Scognet 233164432Simp device_set_desc(dev, "AT91 device bus"); 234178366Scognet arm_post_filter = at91_eoi; 235155324Simp return (0); 236155324Simp} 237155324Simp 238155324Simpstatic void 239155324Simpat91_identify(driver_t *drv, device_t parent) 240155324Simp{ 241155324Simp 242155324Simp BUS_ADD_CHILD(parent, 0, "atmelarm", 0); 243155324Simp} 244155324Simp 245155324Simpstatic int 246155324Simpat91_attach(device_t dev) 247155324Simp{ 248155324Simp struct at91_softc *sc = device_get_softc(dev); 249213496Scognet const struct pmap_devmap *pdevmap; 250155324Simp 251155324Simp at91_softc = sc; 252155324Simp sc->sc_st = &at91_bs_tag; 253213496Scognet sc->sc_sh = AT91_BASE; 254155324Simp sc->dev = dev; 255213496Scognet 256155324Simp sc->sc_irq_rman.rm_type = RMAN_ARRAY; 257164432Simp sc->sc_irq_rman.rm_descr = "AT91 IRQs"; 258155324Simp if (rman_init(&sc->sc_irq_rman) != 0 || 259155324Simp rman_manage_region(&sc->sc_irq_rman, 1, 31) != 0) 260155324Simp panic("at91_attach: failed to set up IRQ rman"); 261213496Scognet 262213496Scognet sc->sc_mem_rman.rm_type = RMAN_ARRAY; 263213496Scognet sc->sc_mem_rman.rm_descr = "AT91 Memory"; 264213496Scognet if (rman_init(&sc->sc_mem_rman) != 0) 265155324Simp panic("at91_attach: failed to set up memory rman"); 266235718Simp for (pdevmap = at91_devmap; pdevmap->pd_va != 0; pdevmap++) { 267213496Scognet if (rman_manage_region(&sc->sc_mem_rman, pdevmap->pd_va, 268213496Scognet pdevmap->pd_va + pdevmap->pd_size - 1) != 0) 269213496Scognet panic("at91_attach: failed to set up memory rman"); 270155324Simp } 271155324Simp 272156828Simp 273238334Simp /* 274238334Simp * Our device list will be added automatically by the cpu device 275213496Scognet * e.g. at91rm9200.c when it is identified. To ensure that the 276236989Simp * CPU and PMC are attached first any other "identified" devices 277238334Simp * call BUS_ADD_CHILD(9) with an "order" of at least 2. 278238334Simp */ 279156828Simp 280155324Simp bus_generic_probe(dev); 281155324Simp bus_generic_attach(dev); 282155324Simp enable_interrupts(I32_bit | F32_bit); 283155324Simp return (0); 284155324Simp} 285155324Simp 286155324Simpstatic struct resource * 287155324Simpat91_alloc_resource(device_t dev, device_t child, int type, int *rid, 288155324Simp u_long start, u_long end, u_long count, u_int flags) 289155324Simp{ 290155324Simp struct at91_softc *sc = device_get_softc(dev); 291155324Simp struct resource_list_entry *rle; 292155324Simp struct at91_ivar *ivar = device_get_ivars(child); 293155324Simp struct resource_list *rl = &ivar->resources; 294155324Simp 295155324Simp if (device_get_parent(child) != dev) 296155324Simp return (BUS_ALLOC_RESOURCE(device_get_parent(dev), child, 297155324Simp type, rid, start, end, count, flags)); 298155324Simp 299155324Simp rle = resource_list_find(rl, type, *rid); 300155324Simp if (rle == NULL) 301155324Simp return (NULL); 302155324Simp if (rle->res) 303155324Simp panic("Resource rid %d type %d already in use", *rid, type); 304155324Simp if (start == 0UL && end == ~0UL) { 305155324Simp start = rle->start; 306155324Simp count = ulmax(count, rle->count); 307155324Simp end = ulmax(rle->end, start + count - 1); 308155324Simp } 309155324Simp switch (type) 310155324Simp { 311155324Simp case SYS_RES_IRQ: 312155324Simp rle->res = rman_reserve_resource(&sc->sc_irq_rman, 313155324Simp start, end, count, flags, child); 314155324Simp break; 315155324Simp case SYS_RES_MEMORY: 316182805Simp rle->res = rman_reserve_resource(&sc->sc_mem_rman, 317182805Simp start, end, count, flags, child); 318184309Sstas if (rle->res != NULL) { 319184309Sstas rman_set_bustag(rle->res, &at91_bs_tag); 320184309Sstas rman_set_bushandle(rle->res, start); 321184309Sstas } 322155324Simp break; 323155324Simp } 324155324Simp if (rle->res) { 325155324Simp rle->start = rman_get_start(rle->res); 326155324Simp rle->end = rman_get_end(rle->res); 327155324Simp rle->count = count; 328157891Simp rman_set_rid(rle->res, *rid); 329155324Simp } 330155324Simp return (rle->res); 331155324Simp} 332155324Simp 333155324Simpstatic struct resource_list * 334155324Simpat91_get_resource_list(device_t dev, device_t child) 335155324Simp{ 336155324Simp struct at91_ivar *ivar; 337155324Simp 338155324Simp ivar = device_get_ivars(child); 339155324Simp return (&(ivar->resources)); 340155324Simp} 341155324Simp 342155324Simpstatic int 343155324Simpat91_release_resource(device_t dev, device_t child, int type, 344155324Simp int rid, struct resource *r) 345155324Simp{ 346155324Simp struct resource_list *rl; 347155324Simp struct resource_list_entry *rle; 348155324Simp 349155324Simp rl = at91_get_resource_list(dev, child); 350155324Simp if (rl == NULL) 351155324Simp return (EINVAL); 352155324Simp rle = resource_list_find(rl, type, rid); 353155324Simp if (rle == NULL) 354155324Simp return (EINVAL); 355155324Simp rman_release_resource(r); 356155324Simp rle->res = NULL; 357155324Simp return (0); 358155324Simp} 359155324Simp 360155324Simpstatic int 361155324Simpat91_setup_intr(device_t dev, device_t child, 362236989Simp struct resource *ires, int flags, driver_filter_t *filt, 363236989Simp driver_intr_t *intr, void *arg, void **cookiep) 364155324Simp{ 365155324Simp struct at91_softc *sc = device_get_softc(dev); 366226832Skevlo int error; 367161704Scognet 368213496Scognet if (rman_get_start(ires) == sc->sc_irq_system && filt == NULL) 369167261Spiso panic("All system interrupt ISRs must be FILTER"); 370226832Skevlo error = BUS_SETUP_INTR(device_get_parent(dev), child, ires, flags, 371226832Skevlo filt, intr, arg, cookiep); 372226832Skevlo if (error) 373226832Skevlo return (error); 374226832Skevlo 375213496Scognet bus_space_write_4(sc->sc_st, sc->sc_aic_sh, IC_IECR, 376155324Simp 1 << rman_get_start(ires)); 377155324Simp return (0); 378155324Simp} 379155324Simp 380155324Simpstatic int 381155324Simpat91_teardown_intr(device_t dev, device_t child, struct resource *res, 382155324Simp void *cookie) 383155324Simp{ 384155324Simp struct at91_softc *sc = device_get_softc(dev); 385155324Simp 386236989Simp bus_space_write_4(sc->sc_st, sc->sc_aic_sh, IC_IDCR, 387155324Simp 1 << rman_get_start(res)); 388155324Simp return (BUS_TEARDOWN_INTR(device_get_parent(dev), child, res, cookie)); 389155324Simp} 390155324Simp 391155324Simpstatic int 392155324Simpat91_activate_resource(device_t bus, device_t child, int type, int rid, 393155324Simp struct resource *r) 394155324Simp{ 395155324Simp#if 0 396155324Simp u_long p; 397155324Simp int error; 398155324Simp 399155324Simp if (type == SYS_RES_MEMORY) { 400155324Simp error = bus_space_map(rman_get_bustag(r), 401155324Simp rman_get_bushandle(r), rman_get_size(r), 0, &p); 402236989Simp if (error) 403155324Simp return (error); 404155324Simp rman_set_bushandle(r, p); 405155324Simp } 406155324Simp#endif 407155324Simp return (rman_activate_resource(r)); 408155324Simp} 409155324Simp 410155324Simpstatic int 411155324Simpat91_print_child(device_t dev, device_t child) 412155324Simp{ 413155324Simp struct at91_ivar *ivars; 414155324Simp struct resource_list *rl; 415155324Simp int retval = 0; 416155324Simp 417155324Simp ivars = device_get_ivars(child); 418155324Simp rl = &ivars->resources; 419155324Simp 420155324Simp retval += bus_print_child_header(dev, child); 421155324Simp 422155324Simp retval += resource_list_print_type(rl, "port", SYS_RES_IOPORT, "%#lx"); 423155324Simp retval += resource_list_print_type(rl, "mem", SYS_RES_MEMORY, "%#lx"); 424155324Simp retval += resource_list_print_type(rl, "irq", SYS_RES_IRQ, "%ld"); 425155324Simp if (device_get_flags(dev)) 426155324Simp retval += printf(" flags %#x", device_get_flags(dev)); 427155324Simp 428155324Simp retval += bus_print_child_footer(dev, child); 429155324Simp 430155324Simp return (retval); 431155324Simp} 432155324Simp 433155324Simpvoid 434155324Simparm_mask_irq(uintptr_t nb) 435155324Simp{ 436155324Simp 437236989Simp bus_space_write_4(at91_softc->sc_st, 438213496Scognet at91_softc->sc_aic_sh, IC_IDCR, 1 << nb); 439155324Simp} 440155324Simp 441155324Simpint 442193847Smarcelarm_get_next_irq(int last __unused) 443155324Simp{ 444155324Simp int status; 445155324Simp int irq; 446155324Simp 447155324Simp irq = bus_space_read_4(at91_softc->sc_st, 448213496Scognet at91_softc->sc_aic_sh, IC_IVR); 449155324Simp status = bus_space_read_4(at91_softc->sc_st, 450213496Scognet at91_softc->sc_aic_sh, IC_ISR); 451155324Simp if (status == 0) { 452155324Simp bus_space_write_4(at91_softc->sc_st, 453213496Scognet at91_softc->sc_aic_sh, IC_EOICR, 1); 454155324Simp return (-1); 455155324Simp } 456155324Simp return (irq); 457155324Simp} 458155324Simp 459155324Simpvoid 460155324Simparm_unmask_irq(uintptr_t nb) 461155324Simp{ 462155324Simp 463236989Simp bus_space_write_4(at91_softc->sc_st, 464213496Scognet at91_softc->sc_aic_sh, IC_IECR, 1 << nb); 465213496Scognet bus_space_write_4(at91_softc->sc_st, at91_softc->sc_aic_sh, 466155324Simp IC_EOICR, 0); 467155324Simp} 468155324Simp 469178366Scognetstatic void 470178366Scognetat91_eoi(void *unused) 471178366Scognet{ 472213496Scognet bus_space_write_4(at91_softc->sc_st, at91_softc->sc_aic_sh, 473178366Scognet IC_EOICR, 0); 474178366Scognet} 475178366Scognet 476238334Simpvoid 477238334Simpat91_add_child(device_t dev, int prio, const char *name, int unit, 478238334Simp bus_addr_t addr, bus_size_t size, int irq0, int irq1, int irq2) 479238334Simp{ 480238334Simp device_t kid; 481238334Simp struct at91_ivar *ivar; 482238334Simp 483238334Simp kid = device_add_child_ordered(dev, prio, name, unit); 484238334Simp if (kid == NULL) { 485238334Simp printf("Can't add child %s%d ordered\n", name, unit); 486238334Simp return; 487238334Simp } 488238334Simp ivar = malloc(sizeof(*ivar), M_DEVBUF, M_NOWAIT | M_ZERO); 489238334Simp if (ivar == NULL) { 490238334Simp device_delete_child(dev, kid); 491238334Simp printf("Can't add alloc ivar\n"); 492238334Simp return; 493238334Simp } 494238334Simp device_set_ivars(kid, ivar); 495238334Simp resource_list_init(&ivar->resources); 496238334Simp if (irq0 != -1) { 497238334Simp bus_set_resource(kid, SYS_RES_IRQ, 0, irq0, 1); 498238334Simp if (irq0 != AT91_IRQ_SYSTEM) 499238334Simp at91_pmc_clock_add(device_get_nameunit(kid), irq0, 0); 500238334Simp } 501238334Simp if (irq1 != 0) 502238334Simp bus_set_resource(kid, SYS_RES_IRQ, 1, irq1, 1); 503238334Simp if (irq2 != 0) 504238334Simp bus_set_resource(kid, SYS_RES_IRQ, 2, irq2, 1); 505238334Simp if (addr != 0 && addr < AT91_BASE) 506238334Simp addr += AT91_BASE; 507238334Simp if (addr != 0) 508238334Simp bus_set_resource(kid, SYS_RES_MEMORY, 0, addr, size); 509238334Simp} 510238334Simp 511155324Simpstatic device_method_t at91_methods[] = { 512155324Simp DEVMETHOD(device_probe, at91_probe), 513155324Simp DEVMETHOD(device_attach, at91_attach), 514155324Simp DEVMETHOD(device_identify, at91_identify), 515155324Simp 516155324Simp DEVMETHOD(bus_alloc_resource, at91_alloc_resource), 517155324Simp DEVMETHOD(bus_setup_intr, at91_setup_intr), 518155324Simp DEVMETHOD(bus_teardown_intr, at91_teardown_intr), 519155324Simp DEVMETHOD(bus_activate_resource, at91_activate_resource), 520155324Simp DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 521155324Simp DEVMETHOD(bus_get_resource_list,at91_get_resource_list), 522155324Simp DEVMETHOD(bus_set_resource, bus_generic_rl_set_resource), 523155324Simp DEVMETHOD(bus_get_resource, bus_generic_rl_get_resource), 524155324Simp DEVMETHOD(bus_release_resource, at91_release_resource), 525155324Simp DEVMETHOD(bus_print_child, at91_print_child), 526155324Simp 527155324Simp {0, 0}, 528155324Simp}; 529155324Simp 530155324Simpstatic driver_t at91_driver = { 531155324Simp "atmelarm", 532155324Simp at91_methods, 533155324Simp sizeof(struct at91_softc), 534155324Simp}; 535213496Scognet 536155324Simpstatic devclass_t at91_devclass; 537155324Simp 538155324SimpDRIVER_MODULE(atmelarm, nexus, at91_driver, at91_devclass, 0, 0); 539