apb.c revision 257338
1130803Smarcel/*- 2130803Smarcel * Copyright (c) 2009, Oleksandr Tymoshenko <gonzo@FreeBSD.org> 3130803Smarcel * All rights reserved. 4130803Smarcel * 5130803Smarcel * Redistribution and use in source and binary forms, with or without 6130803Smarcel * modification, are permitted provided that the following conditions 7130803Smarcel * are met: 8130803Smarcel * 1. Redistributions of source code must retain the above copyright 9130803Smarcel * notice unmodified, this list of conditions, and the following 10130803Smarcel * disclaimer. 11130803Smarcel * 2. Redistributions in binary form must reproduce the above copyright 12130803Smarcel * notice, this list of conditions and the following disclaimer in the 13130803Smarcel * documentation and/or other materials provided with the distribution. 14130803Smarcel * 15130803Smarcel * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 16130803Smarcel * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17130803Smarcel * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18130803Smarcel * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 19130803Smarcel * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20130803Smarcel * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 21130803Smarcel * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22130803Smarcel * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23130803Smarcel * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24130803Smarcel * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25130803Smarcel * SUCH DAMAGE. 26130803Smarcel */ 27130803Smarcel 28130803Smarcel#include <sys/cdefs.h> 29130803Smarcel__FBSDID("$FreeBSD: head/sys/mips/atheros/apb.c 257338 2013-10-29 14:07:31Z nwhitehorn $"); 30130803Smarcel 31130803Smarcel#include <sys/param.h> 32130803Smarcel#include <sys/systm.h> 33130803Smarcel#include <sys/bus.h> 34130803Smarcel#include <sys/interrupt.h> 35130803Smarcel#include <sys/kernel.h> 36130803Smarcel#include <sys/module.h> 37130803Smarcel#include <sys/rman.h> 38130803Smarcel#include <sys/malloc.h> 39130803Smarcel#include <sys/pcpu.h> 40130803Smarcel#include <sys/proc.h> 41130803Smarcel#include <sys/pmc.h> 42130803Smarcel#include <sys/pmckern.h> 43130803Smarcel 44130803Smarcel#include <machine/bus.h> 45130803Smarcel#include <machine/intr_machdep.h> 46130803Smarcel 47130803Smarcel#include <mips/atheros/apbvar.h> 48130803Smarcel#include <mips/atheros/ar71xxreg.h> 49130803Smarcel#include <mips/atheros/ar71xx_setup.h> 50130803Smarcel 51130803Smarcel#define APB_INTR_PMC 5 52130803Smarcel 53130803Smarcel#undef APB_DEBUG 54130803Smarcel#ifdef APB_DEBUG 55130803Smarcel#define dprintf printf 56130803Smarcel#else 57130803Smarcel#define dprintf(x, arg...) 58130803Smarcel#endif /* APB_DEBUG */ 59130803Smarcel 60130803Smarcelstatic int apb_activate_resource(device_t, device_t, int, int, 61130803Smarcel struct resource *); 62130803Smarcelstatic device_t apb_add_child(device_t, u_int, const char *, int); 63130803Smarcelstatic struct resource * 64130803Smarcel apb_alloc_resource(device_t, device_t, int, int *, u_long, 65130803Smarcel u_long, u_long, u_int); 66130803Smarcelstatic int apb_attach(device_t); 67130803Smarcelstatic int apb_deactivate_resource(device_t, device_t, int, int, 68130803Smarcel struct resource *); 69130803Smarcelstatic struct resource_list * 70130803Smarcel apb_get_resource_list(device_t, device_t); 71130803Smarcelstatic void apb_hinted_child(device_t, const char *, int); 72130803Smarcelstatic int apb_filter(void *); 73130803Smarcelstatic int apb_probe(device_t); 74130803Smarcelstatic int apb_release_resource(device_t, device_t, int, int, 75130803Smarcel struct resource *); 76130803Smarcelstatic int apb_setup_intr(device_t, device_t, struct resource *, int, 77130803Smarcel driver_filter_t *, driver_intr_t *, void *, void **); 78130803Smarcelstatic int apb_teardown_intr(device_t, device_t, struct resource *, 79130803Smarcel void *); 80130803Smarcel 81130803Smarcelstatic void 82130803Smarcelapb_mask_irq(void *source) 83130803Smarcel{ 84130803Smarcel unsigned int irq = (unsigned int)source; 85130803Smarcel uint32_t reg; 86130803Smarcel 87130803Smarcel reg = ATH_READ_REG(AR71XX_MISC_INTR_MASK); 88130803Smarcel ATH_WRITE_REG(AR71XX_MISC_INTR_MASK, reg & ~(1 << irq)); 89130803Smarcel 90130803Smarcel} 91130803Smarcel 92130803Smarcelstatic void 93130803Smarcelapb_unmask_irq(void *source) 94130803Smarcel{ 95130803Smarcel uint32_t reg; 96130803Smarcel unsigned int irq = (unsigned int)source; 97130803Smarcel 98130803Smarcel reg = ATH_READ_REG(AR71XX_MISC_INTR_MASK); 99130803Smarcel ATH_WRITE_REG(AR71XX_MISC_INTR_MASK, reg | (1 << irq)); 100130803Smarcel} 101130803Smarcel 102130803Smarcelstatic int 103130803Smarcelapb_probe(device_t dev) 104130803Smarcel{ 105130803Smarcel 106130803Smarcel return (BUS_PROBE_NOWILDCARD); 107130803Smarcel} 108130803Smarcel 109130803Smarcelstatic int 110130803Smarcelapb_attach(device_t dev) 111130803Smarcel{ 112130803Smarcel struct apb_softc *sc = device_get_softc(dev); 113130803Smarcel int rid = 0; 114130803Smarcel 115130803Smarcel device_set_desc(dev, "APB Bus bridge"); 116130803Smarcel 117130803Smarcel sc->apb_mem_rman.rm_type = RMAN_ARRAY; 118130803Smarcel sc->apb_mem_rman.rm_descr = "APB memory window"; 119130803Smarcel 120130803Smarcel if (rman_init(&sc->apb_mem_rman) != 0 || 121130803Smarcel rman_manage_region(&sc->apb_mem_rman, 122130803Smarcel AR71XX_APB_BASE, 123130803Smarcel AR71XX_APB_BASE + AR71XX_APB_SIZE - 1) != 0) 124130803Smarcel panic("apb_attach: failed to set up memory rman"); 125130803Smarcel 126130803Smarcel sc->apb_irq_rman.rm_type = RMAN_ARRAY; 127130803Smarcel sc->apb_irq_rman.rm_descr = "APB IRQ"; 128130803Smarcel 129130803Smarcel if (rman_init(&sc->apb_irq_rman) != 0 || 130130803Smarcel rman_manage_region(&sc->apb_irq_rman, 131130803Smarcel APB_IRQ_BASE, APB_IRQ_END) != 0) 132130803Smarcel panic("apb_attach: failed to set up IRQ rman"); 133130803Smarcel 134130803Smarcel if ((sc->sc_misc_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, 135130803Smarcel RF_SHAREABLE | RF_ACTIVE)) == NULL) { 136130803Smarcel device_printf(dev, "unable to allocate IRQ resource\n"); 137130803Smarcel return (ENXIO); 138130803Smarcel } 139130803Smarcel 140130803Smarcel if ((bus_setup_intr(dev, sc->sc_misc_irq, INTR_TYPE_MISC, 141130803Smarcel apb_filter, NULL, sc, &sc->sc_misc_ih))) { 142130803Smarcel device_printf(dev, 143130803Smarcel "WARNING: unable to register interrupt handler\n"); 144130803Smarcel return (ENXIO); 145130803Smarcel } 146130803Smarcel 147130803Smarcel bus_generic_probe(dev); 148130803Smarcel bus_enumerate_hinted_children(dev); 149130803Smarcel bus_generic_attach(dev); 150130803Smarcel 151130803Smarcel /* 152130803Smarcel * Unmask performance counter IRQ 153130803Smarcel */ 154130803Smarcel apb_unmask_irq((void*)APB_INTR_PMC); 155130803Smarcel sc->sc_intr_counter[APB_INTR_PMC] = mips_intrcnt_create("apb irq5: pmc"); 156130803Smarcel 157130803Smarcel return (0); 158} 159 160static struct resource * 161apb_alloc_resource(device_t bus, device_t child, int type, int *rid, 162 u_long start, u_long end, u_long count, u_int flags) 163{ 164 struct apb_softc *sc = device_get_softc(bus); 165 struct apb_ivar *ivar = device_get_ivars(child); 166 struct resource *rv; 167 struct resource_list_entry *rle; 168 struct rman *rm; 169 int isdefault, needactivate, passthrough; 170 171 isdefault = (start == 0UL && end == ~0UL); 172 needactivate = flags & RF_ACTIVE; 173 /* 174 * Pass memory requests to nexus device 175 */ 176 passthrough = (device_get_parent(child) != bus); 177 rle = NULL; 178 179 dprintf("%s: entry (%p, %p, %d, %d, %p, %p, %ld, %d)\n", 180 __func__, bus, child, type, *rid, (void *)(intptr_t)start, 181 (void *)(intptr_t)end, count, flags); 182 183 if (passthrough) 184 return (BUS_ALLOC_RESOURCE(device_get_parent(bus), child, type, 185 rid, start, end, count, flags)); 186 187 /* 188 * If this is an allocation of the "default" range for a given RID, 189 * and we know what the resources for this device are (ie. they aren't 190 * maintained by a child bus), then work out the start/end values. 191 */ 192 193 if (isdefault) { 194 rle = resource_list_find(&ivar->resources, type, *rid); 195 if (rle == NULL) { 196 return (NULL); 197 } 198 199 if (rle->res != NULL) { 200 panic("%s: resource entry is busy", __func__); 201 } 202 start = rle->start; 203 end = rle->end; 204 count = rle->count; 205 206 dprintf("%s: default resource (%p, %p, %ld)\n", 207 __func__, (void *)(intptr_t)start, 208 (void *)(intptr_t)end, count); 209 } 210 211 switch (type) { 212 case SYS_RES_IRQ: 213 rm = &sc->apb_irq_rman; 214 break; 215 case SYS_RES_MEMORY: 216 rm = &sc->apb_mem_rman; 217 break; 218 default: 219 printf("%s: unknown resource type %d\n", __func__, type); 220 return (0); 221 } 222 223 rv = rman_reserve_resource(rm, start, end, count, flags, child); 224 if (rv == 0) { 225 printf("%s: could not reserve resource\n", __func__); 226 return (0); 227 } 228 229 rman_set_rid(rv, *rid); 230 231 if (needactivate) { 232 if (bus_activate_resource(child, type, *rid, rv)) { 233 printf("%s: could not activate resource\n", __func__); 234 rman_release_resource(rv); 235 return (0); 236 } 237 } 238 239 return (rv); 240} 241 242static int 243apb_activate_resource(device_t bus, device_t child, int type, int rid, 244 struct resource *r) 245{ 246 247 /* XXX: should we mask/unmask IRQ here? */ 248 return (BUS_ACTIVATE_RESOURCE(device_get_parent(bus), child, 249 type, rid, r)); 250} 251 252static int 253apb_deactivate_resource(device_t bus, device_t child, int type, int rid, 254 struct resource *r) 255{ 256 257 /* XXX: should we mask/unmask IRQ here? */ 258 return (BUS_DEACTIVATE_RESOURCE(device_get_parent(bus), child, 259 type, rid, r)); 260} 261 262static int 263apb_release_resource(device_t dev, device_t child, int type, 264 int rid, struct resource *r) 265{ 266 struct resource_list *rl; 267 struct resource_list_entry *rle; 268 269 rl = apb_get_resource_list(dev, child); 270 if (rl == NULL) 271 return (EINVAL); 272 rle = resource_list_find(rl, type, rid); 273 if (rle == NULL) 274 return (EINVAL); 275 rman_release_resource(r); 276 rle->res = NULL; 277 278 return (0); 279} 280 281static int 282apb_setup_intr(device_t bus, device_t child, struct resource *ires, 283 int flags, driver_filter_t *filt, driver_intr_t *handler, 284 void *arg, void **cookiep) 285{ 286 struct apb_softc *sc = device_get_softc(bus); 287 struct intr_event *event; 288 int irq, error; 289 290 irq = rman_get_start(ires); 291 292 if (irq > APB_IRQ_END) 293 panic("%s: bad irq %d", __func__, irq); 294 295 event = sc->sc_eventstab[irq]; 296 if (event == NULL) { 297 error = intr_event_create(&event, (void *)irq, 0, irq, 298 apb_mask_irq, apb_unmask_irq, 299 NULL, NULL, 300 "apb intr%d:", irq); 301 302 if (error == 0) { 303 sc->sc_eventstab[irq] = event; 304 sc->sc_intr_counter[irq] = 305 mips_intrcnt_create(event->ie_name); 306 } 307 else 308 return (error); 309 } 310 311 intr_event_add_handler(event, device_get_nameunit(child), filt, 312 handler, arg, intr_priority(flags), flags, cookiep); 313 mips_intrcnt_setname(sc->sc_intr_counter[irq], event->ie_fullname); 314 315 apb_unmask_irq((void*)irq); 316 317 return (0); 318} 319 320static int 321apb_teardown_intr(device_t dev, device_t child, struct resource *ires, 322 void *cookie) 323{ 324 struct apb_softc *sc = device_get_softc(dev); 325 int irq, result; 326 327 irq = rman_get_start(ires); 328 if (irq > APB_IRQ_END) 329 panic("%s: bad irq %d", __func__, irq); 330 331 if (sc->sc_eventstab[irq] == NULL) 332 panic("Trying to teardown unoccupied IRQ"); 333 334 apb_mask_irq((void*)irq); 335 336 result = intr_event_remove_handler(cookie); 337 if (!result) 338 sc->sc_eventstab[irq] = NULL; 339 340 return (result); 341} 342 343static int 344apb_filter(void *arg) 345{ 346 struct apb_softc *sc = arg; 347 struct intr_event *event; 348 uint32_t reg, irq; 349 struct thread *td; 350 struct trapframe *tf; 351 352 reg = ATH_READ_REG(AR71XX_MISC_INTR_STATUS); 353 for (irq = 0; irq < APB_NIRQS; irq++) { 354 if (reg & (1 << irq)) { 355 356 switch (ar71xx_soc) { 357 case AR71XX_SOC_AR7240: 358 case AR71XX_SOC_AR7241: 359 case AR71XX_SOC_AR7242: 360 case AR71XX_SOC_AR9330: 361 case AR71XX_SOC_AR9331: 362 case AR71XX_SOC_AR9341: 363 case AR71XX_SOC_AR9342: 364 case AR71XX_SOC_AR9344: 365 /* Ack/clear the irq on status register for AR724x */ 366 ATH_WRITE_REG(AR71XX_MISC_INTR_STATUS, 367 reg & ~(1 << irq)); 368 break; 369 default: 370 /* fallthrough */ 371 break; 372 } 373 374 event = sc->sc_eventstab[irq]; 375 if (!event || TAILQ_EMPTY(&event->ie_handlers)) { 376 if (irq == APB_INTR_PMC) { 377 td = PCPU_GET(curthread); 378 tf = td->td_intr_frame; 379 380 if (pmc_intr) 381 (*pmc_intr)(PCPU_GET(cpuid), tf); 382 383 mips_intrcnt_inc(sc->sc_intr_counter[irq]); 384 385 continue; 386 } 387 /* Ignore timer interrupts */ 388 if (irq != 0) 389 printf("Stray APB IRQ %d\n", irq); 390 continue; 391 } 392 393 intr_event_handle(event, PCPU_GET(curthread)->td_intr_frame); 394 mips_intrcnt_inc(sc->sc_intr_counter[irq]); 395 } 396 } 397 398 return (FILTER_HANDLED); 399} 400 401static void 402apb_hinted_child(device_t bus, const char *dname, int dunit) 403{ 404 device_t child; 405 long maddr; 406 int msize; 407 int irq; 408 int result; 409 int mem_hints_count; 410 411 child = BUS_ADD_CHILD(bus, 0, dname, dunit); 412 413 /* 414 * Set hard-wired resources for hinted child using 415 * specific RIDs. 416 */ 417 mem_hints_count = 0; 418 if (resource_long_value(dname, dunit, "maddr", &maddr) == 0) 419 mem_hints_count++; 420 if (resource_int_value(dname, dunit, "msize", &msize) == 0) 421 mem_hints_count++; 422 423 /* check if all info for mem resource has been provided */ 424 if ((mem_hints_count > 0) && (mem_hints_count < 2)) { 425 printf("Either maddr or msize hint is missing for %s%d\n", 426 dname, dunit); 427 } else if (mem_hints_count) { 428 result = bus_set_resource(child, SYS_RES_MEMORY, 0, 429 maddr, msize); 430 if (result != 0) 431 device_printf(bus, 432 "warning: bus_set_resource() failed\n"); 433 } 434 435 if (resource_int_value(dname, dunit, "irq", &irq) == 0) { 436 result = bus_set_resource(child, SYS_RES_IRQ, 0, irq, 1); 437 if (result != 0) 438 device_printf(bus, 439 "warning: bus_set_resource() failed\n"); 440 } 441} 442 443static device_t 444apb_add_child(device_t bus, u_int order, const char *name, int unit) 445{ 446 device_t child; 447 struct apb_ivar *ivar; 448 449 ivar = malloc(sizeof(struct apb_ivar), M_DEVBUF, M_WAITOK | M_ZERO); 450 if (ivar == NULL) { 451 printf("Failed to allocate ivar\n"); 452 return (0); 453 } 454 resource_list_init(&ivar->resources); 455 456 child = device_add_child_ordered(bus, order, name, unit); 457 if (child == NULL) { 458 printf("Can't add child %s%d ordered\n", name, unit); 459 return (0); 460 } 461 462 device_set_ivars(child, ivar); 463 464 return (child); 465} 466 467/* 468 * Helper routine for bus_generic_rl_get_resource/bus_generic_rl_set_resource 469 * Provides pointer to resource_list for these routines 470 */ 471static struct resource_list * 472apb_get_resource_list(device_t dev, device_t child) 473{ 474 struct apb_ivar *ivar; 475 476 ivar = device_get_ivars(child); 477 return (&(ivar->resources)); 478} 479 480static device_method_t apb_methods[] = { 481 DEVMETHOD(bus_activate_resource, apb_activate_resource), 482 DEVMETHOD(bus_add_child, apb_add_child), 483 DEVMETHOD(bus_alloc_resource, apb_alloc_resource), 484 DEVMETHOD(bus_deactivate_resource, apb_deactivate_resource), 485 DEVMETHOD(bus_get_resource_list, apb_get_resource_list), 486 DEVMETHOD(bus_hinted_child, apb_hinted_child), 487 DEVMETHOD(bus_release_resource, apb_release_resource), 488 DEVMETHOD(bus_setup_intr, apb_setup_intr), 489 DEVMETHOD(bus_teardown_intr, apb_teardown_intr), 490 DEVMETHOD(device_attach, apb_attach), 491 DEVMETHOD(device_probe, apb_probe), 492 DEVMETHOD(bus_get_resource, bus_generic_rl_get_resource), 493 DEVMETHOD(bus_set_resource, bus_generic_rl_set_resource), 494 495 DEVMETHOD_END 496}; 497 498static driver_t apb_driver = { 499 "apb", 500 apb_methods, 501 sizeof(struct apb_softc), 502}; 503static devclass_t apb_devclass; 504 505DRIVER_MODULE(apb, nexus, apb_driver, apb_devclass, 0, 0); 506