nexus.c revision 266128
1/*- 2 * Copyright 1998 Massachusetts Institute of Technology 3 * 4 * Permission to use, copy, modify, and distribute this software and 5 * its documentation for any purpose and without fee is hereby 6 * granted, provided that both the above copyright notice and this 7 * permission notice appear in all copies, that both the above 8 * copyright notice and this permission notice appear in all 9 * supporting documentation, and that the name of M.I.T. not be used 10 * in advertising or publicity pertaining to distribution of the 11 * software without specific, written prior permission. M.I.T. makes 12 * no representations about the suitability of this software for any 13 * purpose. It is provided "as is" without express or implied 14 * warranty. 15 * 16 * THIS SOFTWARE IS PROVIDED BY M.I.T. ``AS IS''. M.I.T. DISCLAIMS 17 * ALL EXPRESS OR IMPLIED WARRANTIES WITH REGARD TO THIS SOFTWARE, 18 * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 19 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. IN NO EVENT 20 * SHALL M.I.T. BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 21 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 22 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF 23 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 24 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 25 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT 26 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 27 * SUCH DAMAGE. 28 * 29 */ 30 31/* 32 * This code implements a `root nexus' for Arm Architecture 33 * machines. The function of the root nexus is to serve as an 34 * attachment point for both processors and buses, and to manage 35 * resources which are common to all of them. In particular, 36 * this code implements the core resource managers for interrupt 37 * requests, DMA requests (which rightfully should be a part of the 38 * ISA code but it's easier to do it here for now), I/O port addresses, 39 * and I/O memory address space. 40 */ 41 42#include <sys/cdefs.h> 43__FBSDID("$FreeBSD: stable/10/sys/arm/arm/nexus.c 266128 2014-05-15 14:26:11Z ian $"); 44 45#include <sys/param.h> 46#include <sys/systm.h> 47#include <sys/bus.h> 48#include <sys/kernel.h> 49#include <sys/malloc.h> 50#include <sys/module.h> 51#include <machine/bus.h> 52#include <sys/rman.h> 53#include <sys/interrupt.h> 54 55#include <machine/vmparam.h> 56#include <machine/pcb.h> 57#include <vm/vm.h> 58#include <vm/pmap.h> 59 60#include <machine/resource.h> 61#include <machine/intr.h> 62 63#include "opt_platform.h" 64 65#ifdef FDT 66#include <dev/ofw/ofw_nexus.h> 67#include <dev/fdt/fdt_common.h> 68#include <machine/fdt.h> 69#include "ofw_bus_if.h" 70#else 71static MALLOC_DEFINE(M_NEXUSDEV, "nexusdev", "Nexus device"); 72 73struct nexus_device { 74 struct resource_list nx_resources; 75}; 76 77#define DEVTONX(dev) ((struct nexus_device *)device_get_ivars(dev)) 78 79static struct rman mem_rman; 80 81static int nexus_probe(device_t); 82static int nexus_attach(device_t); 83static int nexus_print_child(device_t, device_t); 84static device_t nexus_add_child(device_t, u_int, const char *, int); 85static struct resource *nexus_alloc_resource(device_t, device_t, int, int *, 86 u_long, u_long, u_long, u_int); 87#endif 88static int nexus_activate_resource(device_t, device_t, int, int, 89 struct resource *); 90static int nexus_config_intr(device_t dev, int irq, enum intr_trigger trig, 91 enum intr_polarity pol); 92static int nexus_deactivate_resource(device_t, device_t, int, int, 93 struct resource *); 94 95static int nexus_setup_intr(device_t dev, device_t child, struct resource *res, 96 int flags, driver_filter_t *filt, driver_intr_t *intr, void *arg, void **cookiep); 97static int nexus_teardown_intr(device_t, device_t, struct resource *, void *); 98 99#ifdef FDT 100static int nexus_ofw_map_intr(device_t dev, device_t child, phandle_t iparent, 101 int icells, pcell_t *intr); 102#endif 103 104static device_method_t nexus_methods[] = { 105#ifndef FDT 106 /* Device interface */ 107 DEVMETHOD(device_probe, nexus_probe), 108 DEVMETHOD(device_attach, nexus_attach), 109 /* Bus interface */ 110 DEVMETHOD(bus_print_child, nexus_print_child), 111 DEVMETHOD(bus_add_child, nexus_add_child), 112 DEVMETHOD(bus_alloc_resource, nexus_alloc_resource), 113#endif 114 DEVMETHOD(bus_activate_resource, nexus_activate_resource), 115 DEVMETHOD(bus_config_intr, nexus_config_intr), 116 DEVMETHOD(bus_deactivate_resource, nexus_deactivate_resource), 117 DEVMETHOD(bus_setup_intr, nexus_setup_intr), 118 DEVMETHOD(bus_teardown_intr, nexus_teardown_intr), 119#ifdef FDT 120 DEVMETHOD(ofw_bus_map_intr, nexus_ofw_map_intr), 121#endif 122 { 0, 0 } 123}; 124 125static devclass_t nexus_devclass; 126#ifndef FDT 127static driver_t nexus_driver = { 128 "nexus", 129 nexus_methods, 130 1 /* no softc */ 131}; 132#else 133DEFINE_CLASS_1(nexus, nexus_driver, nexus_methods, 134 sizeof(struct ofw_nexus_softc), ofw_nexus_driver); 135#endif 136DRIVER_MODULE(nexus, root, nexus_driver, nexus_devclass, 0, 0); 137 138#ifndef FDT 139static int 140nexus_probe(device_t dev) 141{ 142 143 device_quiet(dev); /* suppress attach message for neatness */ 144 145 return (BUS_PROBE_DEFAULT); 146} 147 148static int 149nexus_attach(device_t dev) 150{ 151 152 mem_rman.rm_start = 0; 153 mem_rman.rm_end = ~0ul; 154 mem_rman.rm_type = RMAN_ARRAY; 155 mem_rman.rm_descr = "I/O memory addresses"; 156 if (rman_init(&mem_rman) || rman_manage_region(&mem_rman, 0, ~0)) 157 panic("nexus_probe mem_rman"); 158 159 /* 160 * First, deal with the children we know about already 161 */ 162 bus_generic_probe(dev); 163 bus_generic_attach(dev); 164 165 return (0); 166} 167 168static int 169nexus_print_child(device_t bus, device_t child) 170{ 171 int retval = 0; 172 173 retval += bus_print_child_header(bus, child); 174 retval += printf("\n"); 175 176 return (retval); 177} 178 179static device_t 180nexus_add_child(device_t bus, u_int order, const char *name, int unit) 181{ 182 device_t child; 183 struct nexus_device *ndev; 184 185 ndev = malloc(sizeof(struct nexus_device), M_NEXUSDEV, M_NOWAIT|M_ZERO); 186 if (!ndev) 187 return (0); 188 resource_list_init(&ndev->nx_resources); 189 190 child = device_add_child_ordered(bus, order, name, unit); 191 192 /* should we free this in nexus_child_detached? */ 193 device_set_ivars(child, ndev); 194 195 return (child); 196} 197 198 199/* 200 * Allocate a resource on behalf of child. NB: child is usually going to be a 201 * child of one of our descendants, not a direct child of nexus0. 202 * (Exceptions include footbridge.) 203 */ 204static struct resource * 205nexus_alloc_resource(device_t bus, device_t child, int type, int *rid, 206 u_long start, u_long end, u_long count, u_int flags) 207{ 208 struct resource *rv; 209 struct rman *rm; 210 int needactivate = flags & RF_ACTIVE; 211 212 switch (type) { 213 case SYS_RES_MEMORY: 214 case SYS_RES_IOPORT: 215 rm = &mem_rman; 216 break; 217 218 default: 219 return (0); 220 } 221 222 rv = rman_reserve_resource(rm, start, end, count, flags, child); 223 if (rv == 0) 224 return (0); 225 226 rman_set_rid(rv, *rid); 227 rman_set_bushandle(rv, rman_get_start(rv)); 228 229 if (needactivate) { 230 if (bus_activate_resource(child, type, *rid, rv)) { 231 rman_release_resource(rv); 232 return (0); 233 } 234 } 235 236 return (rv); 237} 238#endif 239 240static int 241nexus_config_intr(device_t dev, int irq, enum intr_trigger trig, 242 enum intr_polarity pol) 243{ 244 int ret = ENODEV; 245 246 if (arm_config_irq) 247 ret = (*arm_config_irq)(irq, trig, pol); 248 249 return (ret); 250} 251 252static int 253nexus_setup_intr(device_t dev, device_t child, struct resource *res, int flags, 254 driver_filter_t *filt, driver_intr_t *intr, void *arg, void **cookiep) 255{ 256 int irq; 257 258 if ((rman_get_flags(res) & RF_SHAREABLE) == 0) 259 flags |= INTR_EXCL; 260 261 for (irq = rman_get_start(res); irq <= rman_get_end(res); irq++) { 262 arm_setup_irqhandler(device_get_nameunit(child), 263 filt, intr, arg, irq, flags, cookiep); 264 arm_unmask_irq(irq); 265 } 266 return (0); 267} 268 269static int 270nexus_teardown_intr(device_t dev, device_t child, struct resource *r, void *ih) 271{ 272 273 return (arm_remove_irqhandler(rman_get_start(r), ih)); 274} 275 276 277static int 278nexus_activate_resource(device_t bus, device_t child, int type, int rid, 279 struct resource *r) 280{ 281 int err; 282 bus_addr_t paddr; 283 bus_size_t psize; 284 bus_space_handle_t vaddr; 285 286 if ((err = rman_activate_resource(r)) != 0) 287 return (err); 288 289 /* 290 * If this is a memory resource, map it into the kernel. 291 */ 292 if (type == SYS_RES_MEMORY || type == SYS_RES_IOPORT) { 293 paddr = (bus_addr_t)rman_get_start(r); 294 psize = (bus_size_t)rman_get_size(r); 295#ifdef FDT 296 err = bus_space_map(fdtbus_bs_tag, paddr, psize, 0, &vaddr); 297 if (err != 0) { 298 rman_deactivate_resource(r); 299 return (err); 300 } 301 rman_set_bustag(r, fdtbus_bs_tag); 302#else 303 vaddr = (bus_space_handle_t)pmap_mapdev((vm_offset_t)paddr, 304 (vm_size_t)psize); 305 if (vaddr == 0) { 306 rman_deactivate_resource(r); 307 return (ENOMEM); 308 } 309 rman_set_bustag(r, (void *)1); 310#endif 311 rman_set_virtual(r, (void *)vaddr); 312 rman_set_bushandle(r, vaddr); 313 } 314 return (0); 315} 316 317static int 318nexus_deactivate_resource(device_t bus, device_t child, int type, int rid, 319 struct resource *r) 320{ 321 bus_size_t psize; 322 bus_space_handle_t vaddr; 323 324 psize = (bus_size_t)rman_get_size(r); 325 vaddr = rman_get_bushandle(r); 326 327 if (vaddr != 0) { 328#ifdef FDT 329 bus_space_unmap(fdtbus_bs_tag, vaddr, psize); 330#else 331 pmap_unmapdev((vm_offset_t)vaddr, (vm_size_t)psize); 332#endif 333 rman_set_virtual(r, NULL); 334 rman_set_bushandle(r, 0); 335 } 336 337 return (rman_deactivate_resource(r)); 338} 339 340#ifdef FDT 341static int 342nexus_ofw_map_intr(device_t dev, device_t child, phandle_t iparent, int icells, 343 pcell_t *intr) 344{ 345 fdt_pic_decode_t intr_decode; 346 phandle_t intr_offset; 347 int i, rv, interrupt, trig, pol; 348 349 intr_offset = OF_xref_phandle(iparent); 350 for (i = 0; i < icells; i++) 351 intr[i] = cpu_to_fdt32(intr[i]); 352 353 for (i = 0; fdt_pic_table[i] != NULL; i++) { 354 intr_decode = fdt_pic_table[i]; 355 rv = intr_decode(intr_offset, intr, &interrupt, &trig, &pol); 356 357 if (rv == 0) { 358 /* This was recognized as our PIC and decoded. */ 359 interrupt = FDT_MAP_IRQ(intr_parent, interrupt); 360 return (interrupt); 361 } 362 } 363 364 /* Not in table, so guess */ 365 interrupt = FDT_MAP_IRQ(intr_parent, fdt32_to_cpu(intr[0])); 366 367 return (interrupt); 368} 369#endif 370 371