| nexus.c (182933) | nexus.c (182934) |
|---|---|
| 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. | 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 * | 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 --- 11 unchanged lines hidden (view full) --- 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> | 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 --- 11 unchanged lines hidden (view full) --- 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: head/sys/arm/arm/nexus.c 182933 2008-09-11 12:36:13Z raj $"); | 43__FBSDID("$FreeBSD: head/sys/arm/arm/nexus.c 182934 2008-09-11 12:39:54Z raj $"); |
| 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> --- 19 unchanged lines hidden (view full) --- 71 72static struct rman mem_rman; 73 74static int nexus_probe(device_t); 75static int nexus_attach(device_t); 76static int nexus_print_child(device_t, device_t); 77static device_t nexus_add_child(device_t, int, const char *, int); 78static struct resource *nexus_alloc_resource(device_t, device_t, int, int *, | 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> --- 19 unchanged lines hidden (view full) --- 71 72static struct rman mem_rman; 73 74static int nexus_probe(device_t); 75static int nexus_attach(device_t); 76static int nexus_print_child(device_t, device_t); 77static device_t nexus_add_child(device_t, int, const char *, int); 78static struct resource *nexus_alloc_resource(device_t, device_t, int, int *, |
| 79 u_long, u_long, u_long, u_int); | 79 u_long, u_long, u_long, u_int); |
| 80static int nexus_activate_resource(device_t, device_t, int, int, | 80static int nexus_activate_resource(device_t, device_t, int, int, |
| 81 struct resource *); 82static int 83nexus_setup_intr(device_t dev, device_t child, struct resource *res, int flags, 84 driver_filter_t *filt, driver_intr_t *intr, void *arg, void **cookiep); 85static int 86nexus_teardown_intr(device_t, device_t, struct resource *, void *); | 81 struct resource *); 82static int nexus_setup_intr(device_t dev, device_t child, struct resource *res, 83 int flags, driver_filter_t *filt, driver_intr_t *intr, void *arg, void **cookiep); 84static int nexus_teardown_intr(device_t, device_t, struct resource *, void *); |
| 87 88static device_method_t nexus_methods[] = { 89 /* Device interface */ 90 DEVMETHOD(device_probe, nexus_probe), 91 DEVMETHOD(device_attach, nexus_attach), 92 /* Bus interface */ 93 DEVMETHOD(bus_print_child, nexus_print_child), 94 DEVMETHOD(bus_add_child, nexus_add_child), --- 10 unchanged lines hidden (view full) --- 105 1 /* no softc */ 106}; 107static devclass_t nexus_devclass; 108 109static int 110nexus_probe(device_t dev) 111{ 112 device_quiet(dev); /* suppress attach message for neatness */ | 85 86static device_method_t nexus_methods[] = { 87 /* Device interface */ 88 DEVMETHOD(device_probe, nexus_probe), 89 DEVMETHOD(device_attach, nexus_attach), 90 /* Bus interface */ 91 DEVMETHOD(bus_print_child, nexus_print_child), 92 DEVMETHOD(bus_add_child, nexus_add_child), --- 10 unchanged lines hidden (view full) --- 103 1 /* no softc */ 104}; 105static devclass_t nexus_devclass; 106 107static int 108nexus_probe(device_t dev) 109{ 110 device_quiet(dev); /* suppress attach message for neatness */ |
| 113 | 111 |
| 114 mem_rman.rm_start = 0; 115 mem_rman.rm_end = ~0u; 116 mem_rman.rm_type = RMAN_ARRAY; 117 mem_rman.rm_descr = "I/O memory addresses"; | 112 mem_rman.rm_start = 0; 113 mem_rman.rm_end = ~0u; 114 mem_rman.rm_type = RMAN_ARRAY; 115 mem_rman.rm_descr = "I/O memory addresses"; |
| 118 if (rman_init(&mem_rman) 119 || rman_manage_region(&mem_rman, 0, ~0u)) | 116 if (rman_init(&mem_rman) || rman_manage_region(&mem_rman, 0, ~0u)) |
| 120 panic("nexus_probe mem_rman"); | 117 panic("nexus_probe mem_rman"); |
| 121 | 118 |
| 122 return (0); 123} 124 125static int 126nexus_setup_intr(device_t dev, device_t child, struct resource *res, int flags, 127 driver_filter_t *filt, driver_intr_t *intr, void *arg, void **cookiep) 128{ 129 --- 10 unchanged lines hidden (view full) --- 140{ 141 142 return (arm_remove_irqhandler(rman_get_start(r), ih)); 143} 144 145static int 146nexus_attach(device_t dev) 147{ | 119 return (0); 120} 121 122static int 123nexus_setup_intr(device_t dev, device_t child, struct resource *res, int flags, 124 driver_filter_t *filt, driver_intr_t *intr, void *arg, void **cookiep) 125{ 126 --- 10 unchanged lines hidden (view full) --- 137{ 138 139 return (arm_remove_irqhandler(rman_get_start(r), ih)); 140} 141 142static int 143nexus_attach(device_t dev) 144{ |
| 145 |
|
| 148 /* 149 * First, deal with the children we know about already 150 */ 151 bus_generic_probe(dev); 152 bus_generic_attach(dev); | 146 /* 147 * First, deal with the children we know about already 148 */ 149 bus_generic_probe(dev); 150 bus_generic_attach(dev); |
| 153 154 return 0; | 151 152 return (0); |
| 155} 156 157 158static int 159nexus_print_child(device_t bus, device_t child) 160{ 161 int retval = 0; | 153} 154 155 156static int 157nexus_print_child(device_t bus, device_t child) 158{ 159 int retval = 0; |
| 162 | 160 |
| 163 retval += bus_print_child_header(bus, child); 164 retval += printf(" on motherboard\n"); /* XXX "motherboard", ick */ | 161 retval += bus_print_child_header(bus, child); 162 retval += printf(" on motherboard\n"); /* XXX "motherboard", ick */ |
| 165 | 163 |
| 166 return (retval); 167} 168 | 164 return (retval); 165} 166 |
| 169 | |
| 170static device_t 171nexus_add_child(device_t bus, int order, const char *name, int unit) 172{ | 167static device_t 168nexus_add_child(device_t bus, int order, const char *name, int unit) 169{ |
| 173 device_t child; | 170 device_t child; |
| 174 struct nexus_device *ndev; | 171 struct nexus_device *ndev; |
| 175 | 172 |
| 176 ndev = malloc(sizeof(struct nexus_device), M_NEXUSDEV, M_NOWAIT|M_ZERO); 177 if (!ndev) | 173 ndev = malloc(sizeof(struct nexus_device), M_NEXUSDEV, M_NOWAIT|M_ZERO); 174 if (!ndev) |
| 178 return(0); | 175 return (0); |
| 179 resource_list_init(&ndev->nx_resources); 180 181 child = device_add_child_ordered(bus, order, name, unit); | 176 resource_list_init(&ndev->nx_resources); 177 178 child = device_add_child_ordered(bus, order, name, unit); |
| 182 | 179 |
| 183 /* should we free this in nexus_child_detached? */ 184 device_set_ivars(child, ndev); | 180 /* should we free this in nexus_child_detached? */ 181 device_set_ivars(child, ndev); |
| 185 186 return(child); | 182 183 return (child); |
| 187} 188 189 190/* 191 * Allocate a resource on behalf of child. NB: child is usually going to be a 192 * child of one of our descendants, not a direct child of nexus0. 193 * (Exceptions include footbridge.) 194 */ 195#define ARM_BUS_SPACE_MEM 1 196static struct resource * 197nexus_alloc_resource(device_t bus, device_t child, int type, int *rid, | 184} 185 186 187/* 188 * Allocate a resource on behalf of child. NB: child is usually going to be a 189 * child of one of our descendants, not a direct child of nexus0. 190 * (Exceptions include footbridge.) 191 */ 192#define ARM_BUS_SPACE_MEM 1 193static struct resource * 194nexus_alloc_resource(device_t bus, device_t child, int type, int *rid, |
| 198 u_long start, u_long end, u_long count, u_int flags) | 195 u_long start, u_long end, u_long count, u_int flags) |
| 199{ 200 struct resource *rv; 201 struct rman *rm; 202 int needactivate = flags & RF_ACTIVE; 203 204 switch (type) { 205 case SYS_RES_MEMORY: 206 rm = &mem_rman; 207 break; | 196{ 197 struct resource *rv; 198 struct rman *rm; 199 int needactivate = flags & RF_ACTIVE; 200 201 switch (type) { 202 case SYS_RES_MEMORY: 203 rm = &mem_rman; 204 break; |
| 208 | 205 |
| 209 default: | 206 default: |
| 210 return 0; | 207 return (0); |
| 211 } 212 213 rv = rman_reserve_resource(rm, start, end, count, flags, child); 214 if (rv == 0) | 208 } 209 210 rv = rman_reserve_resource(rm, start, end, count, flags, child); 211 if (rv == 0) |
| 215 return 0; | 212 return (0); |
| 216 217 rman_set_rid(rv, *rid); 218 rman_set_bustag(rv, (void*)ARM_BUS_SPACE_MEM); | 213 214 rman_set_rid(rv, *rid); 215 rman_set_bustag(rv, (void*)ARM_BUS_SPACE_MEM); |
| 219 rman_set_bushandle(rv, rman_get_start(rv)); 220 | 216 rman_set_bushandle(rv, rman_get_start(rv)); 217 |
| 221 if (needactivate) { 222 if (bus_activate_resource(child, type, *rid, rv)) { 223 rman_release_resource(rv); | 218 if (needactivate) { 219 if (bus_activate_resource(child, type, *rid, rv)) { 220 rman_release_resource(rv); |
| 224 return 0; | 221 return (0); |
| 225 } 226 } | 222 } 223 } |
| 227 228 return rv; | 224 225 return (rv); |
| 229} 230 231 232static int 233nexus_activate_resource(device_t bus, device_t child, int type, int rid, | 226} 227 228 229static int 230nexus_activate_resource(device_t bus, device_t child, int type, int rid, |
| 234 struct resource *r) | 231 struct resource *r) |
| 235{ 236 /* 237 * If this is a memory resource, map it into the kernel. 238 */ 239 if (rman_get_bustag(r) == (void*)ARM_BUS_SPACE_MEM) { 240 caddr_t vaddr = 0; 241 u_int32_t paddr; 242 u_int32_t psize; 243 u_int32_t poffs; | 232{ 233 /* 234 * If this is a memory resource, map it into the kernel. 235 */ 236 if (rman_get_bustag(r) == (void*)ARM_BUS_SPACE_MEM) { 237 caddr_t vaddr = 0; 238 u_int32_t paddr; 239 u_int32_t psize; 240 u_int32_t poffs; |
| 244 | 241 |
| 245 paddr = rman_get_start(r); 246 psize = rman_get_size(r); 247 poffs = paddr - trunc_page(paddr); 248 vaddr = (caddr_t) pmap_mapdev(paddr-poffs, psize+poffs) + poffs; 249 rman_set_virtual(r, vaddr); 250 rman_set_bushandle(r, (bus_space_handle_t) vaddr); 251 } 252 return (rman_activate_resource(r)); 253} 254 255DRIVER_MODULE(nexus, root, nexus_driver, nexus_devclass, 0, 0); | 242 paddr = rman_get_start(r); 243 psize = rman_get_size(r); 244 poffs = paddr - trunc_page(paddr); 245 vaddr = (caddr_t) pmap_mapdev(paddr-poffs, psize+poffs) + poffs; 246 rman_set_virtual(r, vaddr); 247 rman_set_bushandle(r, (bus_space_handle_t) vaddr); 248 } 249 return (rman_activate_resource(r)); 250} 251 252DRIVER_MODULE(nexus, root, nexus_driver, nexus_devclass, 0, 0); |