1/*- 2 * Copyright (C) 1996 Wolfgang Solfrank. 3 * Copyright (C) 1996 TooLs GmbH. 4 * All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 3. All advertising materials mentioning features or use of this software 15 * must display the following acknowledgement: 16 * This product includes software developed by TooLs GmbH. 17 * 4. The name of TooLs GmbH may not be used to endorse or promote products 18 * derived from this software without specific prior written permission. 19 * 20 * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR 21 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 22 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 23 * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 24 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 25 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; 26 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, 27 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR 28 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF 29 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 30 * 31 * $NetBSD: ofw_machdep.c,v 1.5 2000/05/23 13:25:43 tsubai Exp $ 32 */ 33 34#include <sys/cdefs.h>
|
36 37#include <sys/param.h> 38#include <sys/bus.h> 39#include <sys/systm.h> 40#include <sys/conf.h> 41#include <sys/disk.h> 42#include <sys/fcntl.h> 43#include <sys/malloc.h> 44#include <sys/stat.h> 45 46#include <net/ethernet.h> 47 48#include <dev/ofw/openfirm.h> 49#include <dev/ofw/ofw_pci.h> 50 51#include <vm/vm.h> 52#include <vm/vm_param.h> 53#include <vm/vm_page.h> 54 55#include <machine/bus.h> 56#include <machine/md_var.h> 57#include <machine/powerpc.h> 58#include <machine/ofw_machdep.h> 59#include <powerpc/ofw/ofw_pci.h> 60 61#define OFMEM_REGIONS 32 62static struct mem_region OFmem[OFMEM_REGIONS + 1], OFavail[OFMEM_REGIONS + 3]; 63static struct mem_region OFfree[OFMEM_REGIONS + 3]; 64 65extern register_t ofmsr[5]; 66extern struct pcpu __pcpu[MAXCPU]; 67extern struct pmap ofw_pmap; 68static int (*ofwcall)(void *); 69 70/* 71 * Saved SPRG0-3 from OpenFirmware. Will be restored prior to the callback. 72 */ 73register_t ofw_sprg0_save; 74 75static __inline void 76ofw_sprg_prepare(void) 77{ 78 /* 79 * Assume that interrupt are disabled at this point, or 80 * SPRG1-3 could be trashed 81 */ 82 __asm __volatile("mfsprg0 %0\n\t" 83 "mtsprg0 %1\n\t" 84 "mtsprg1 %2\n\t" 85 "mtsprg2 %3\n\t" 86 "mtsprg3 %4\n\t" 87 : "=&r"(ofw_sprg0_save) 88 : "r"(ofmsr[1]), 89 "r"(ofmsr[2]), 90 "r"(ofmsr[3]), 91 "r"(ofmsr[4])); 92} 93 94static __inline void 95ofw_sprg_restore(void) 96{ 97 /* 98 * Note that SPRG1-3 contents are irrelevant. They are scratch 99 * registers used in the early portion of trap handling when 100 * interrupts are disabled. 101 * 102 * PCPU data cannot be used until this routine is called ! 103 */ 104 __asm __volatile("mtsprg0 %0" :: "r"(ofw_sprg0_save)); 105} 106 107/* 108 * Memory region utilities: determine if two regions overlap, 109 * and merge two overlapping regions into one 110 */ 111static int 112memr_overlap(struct mem_region *r1, struct mem_region *r2) 113{ 114 if ((r1->mr_start + r1->mr_size) < r2->mr_start || 115 (r2->mr_start + r2->mr_size) < r1->mr_start) 116 return (FALSE); 117 118 return (TRUE); 119} 120 121static void 122memr_merge(struct mem_region *from, struct mem_region *to) 123{ 124 int end; 125 end = imax(to->mr_start + to->mr_size, from->mr_start + from->mr_size); 126 to->mr_start = imin(from->mr_start, to->mr_start); 127 to->mr_size = end - to->mr_start; 128} 129 130/* 131 * This is called during powerpc_init, before the system is really initialized. 132 * It shall provide the total and the available regions of RAM. 133 * Both lists must have a zero-size entry as terminator. 134 * The available regions need not take the kernel into account, but needs 135 * to provide space for two additional entry beyond the terminating one. 136 */ 137void 138mem_regions(struct mem_region **memp, int *memsz, 139 struct mem_region **availp, int *availsz) 140{ 141 int phandle; 142 int asz, msz, fsz; 143 int i, j; 144 int still_merging; 145 146 /* 147 * Get memory. 148 */ 149 if ((phandle = OF_finddevice("/memory")) == -1 150 || (msz = OF_getprop(phandle, "reg", 151 OFmem, sizeof OFmem[0] * OFMEM_REGIONS)) 152 <= 0 153 || (asz = OF_getprop(phandle, "available", 154 OFavail, sizeof OFavail[0] * OFMEM_REGIONS)) 155 <= 0) 156 panic("no memory?"); 157 *memp = OFmem; 158 *memsz = msz / sizeof(struct mem_region); 159 160 /* 161 * OFavail may have overlapping regions - collapse these 162 * and copy out remaining regions to OFfree 163 */ 164 asz /= sizeof(struct mem_region); 165 do { 166 still_merging = FALSE; 167 for (i = 0; i < asz; i++) { 168 if (OFavail[i].mr_size == 0) 169 continue; 170 for (j = i+1; j < asz; j++) { 171 if (OFavail[j].mr_size == 0) 172 continue; 173 if (memr_overlap(&OFavail[j], &OFavail[i])) { 174 memr_merge(&OFavail[j], &OFavail[i]); 175 /* mark inactive */ 176 OFavail[j].mr_size = 0; 177 still_merging = TRUE; 178 } 179 } 180 } 181 } while (still_merging == TRUE); 182 183 /* evict inactive ranges */ 184 for (i = 0, fsz = 0; i < asz; i++) { 185 if (OFavail[i].mr_size != 0) { 186 OFfree[fsz] = OFavail[i]; 187 fsz++; 188 } 189 } 190 191 *availp = OFfree; 192 *availsz = fsz; 193} 194 195void 196set_openfirm_callback(int (*openfirm)(void *)) 197{ 198 199 ofwcall = openfirm; 200} 201 202int 203openfirmware(void *args) 204{ 205 long oldmsr; 206 int result; 207 u_int srsave[16]; 208 u_int i; 209 210 __asm __volatile( "\t" 211 "sync\n\t" 212 "mfmsr %0\n\t" 213 "mtmsr %1\n\t" 214 "isync\n" 215 : "=r" (oldmsr) 216 : "r" (ofmsr[0]) 217 ); 218 219 ofw_sprg_prepare(); 220 221 if (pmap_bootstrapped) { 222 /* 223 * Swap the kernel's address space with Open Firmware's 224 */ 225 for (i = 0; i < 16; i++) { 226 srsave[i] = mfsrin(i << ADDR_SR_SHFT); 227 mtsrin(i << ADDR_SR_SHFT, ofw_pmap.pm_sr[i]); 228 } 229 230 /* 231 * Clear battable[] translations 232 */ 233 __asm __volatile("mtdbatu 2, %0\n" 234 "mtdbatu 3, %0" : : "r" (0)); 235 isync(); 236 } 237 238 result = ofwcall(args); 239 240 if (pmap_bootstrapped) { 241 /* 242 * Restore the kernel's addr space. The isync() doesn;t 243 * work outside the loop unless mtsrin() is open-coded 244 * in an asm statement :( 245 */ 246 for (i = 0; i < 16; i++) { 247 mtsrin(i << ADDR_SR_SHFT, srsave[i]); 248 isync(); 249 } 250 } 251 252 ofw_sprg_restore(); 253 254 __asm( "\t" 255 "mtmsr %0\n\t" 256 "isync\n" 257 : : "r" (oldmsr) 258 ); 259 260 return (result); 261} 262 263void 264OF_halt() 265{ 266 int retval; /* dummy, this may not be needed */ 267 268 OF_interpret("shut-down", 1, &retval); 269 for (;;); /* just in case */ 270} 271 272void 273OF_reboot() 274{ 275 int retval; /* dummy, this may not be needed */ 276 277 OF_interpret("reset-all", 1, &retval); 278 for (;;); /* just in case */ 279} 280 281void 282OF_getetheraddr(device_t dev, u_char *addr) 283{ 284 phandle_t node; 285 286 node = ofw_pci_find_node(dev); 287 OF_getprop(node, "local-mac-address", addr, ETHER_ADDR_LEN); 288} 289 290/* 291 * Return a bus handle and bus tag that corresponds to the register 292 * numbered regno for the device referenced by the package handle 293 * dev. This function is intended to be used by console drivers in 294 * early boot only. It works by mapping the address of the device's 295 * register in the address space of its parent and recursively walk 296 * the device tree upward this way. 297 */ 298static void 299OF_get_addr_props(phandle_t node, uint32_t *addrp, uint32_t *sizep, int *pcip) 300{ 301 char name[16]; 302 uint32_t addr, size; 303 int pci, res; 304 305 res = OF_getprop(node, "#address-cells", &addr, sizeof(addr)); 306 if (res == -1) 307 addr = 2; 308 res = OF_getprop(node, "#size-cells", &size, sizeof(size)); 309 if (res == -1) 310 size = 1; 311 pci = 0; 312 if (addr == 3 && size == 2) { 313 res = OF_getprop(node, "name", name, sizeof(name)); 314 if (res != -1) { 315 name[sizeof(name) - 1] = '\0'; 316 pci = (strcmp(name, "pci") == 0) ? 1 : 0; 317 } 318 } 319 if (addrp != NULL) 320 *addrp = addr; 321 if (sizep != NULL) 322 *sizep = size; 323 if (pcip != NULL) 324 *pcip = pci; 325} 326 327int 328OF_decode_addr(phandle_t dev, int regno, bus_space_tag_t *tag, 329 bus_space_handle_t *handle) 330{ 331 uint32_t cell[32]; 332 bus_addr_t addr, raddr, baddr; 333 bus_size_t size, rsize; 334 uint32_t c, nbridge, naddr, nsize; 335 phandle_t bridge, parent; 336 u_int spc, rspc; 337 int pci, pcib, res; 338 339 /* Sanity checking. */ 340 if (dev == 0) 341 return (EINVAL); 342 bridge = OF_parent(dev); 343 if (bridge == 0) 344 return (EINVAL); 345 if (regno < 0) 346 return (EINVAL); 347 if (tag == NULL || handle == NULL) 348 return (EINVAL); 349 350 /* Get the requested register. */ 351 OF_get_addr_props(bridge, &naddr, &nsize, &pci); 352 res = OF_getprop(dev, (pci) ? "assigned-addresses" : "reg", 353 cell, sizeof(cell)); 354 if (res == -1) 355 return (ENXIO); 356 if (res % sizeof(cell[0])) 357 return (ENXIO); 358 res /= sizeof(cell[0]); 359 regno *= naddr + nsize; 360 if (regno + naddr + nsize > res) 361 return (EINVAL); 362 spc = (pci) ? cell[regno] & OFW_PCI_PHYS_HI_SPACEMASK : ~0; 363 addr = 0; 364 for (c = 0; c < naddr; c++) 365 addr = ((uint64_t)addr << 32) | cell[regno++]; 366 size = 0; 367 for (c = 0; c < nsize; c++) 368 size = ((uint64_t)size << 32) | cell[regno++]; 369 370 /* 371 * Map the address range in the bridge's decoding window as given 372 * by the "ranges" property. If a node doesn't have such property 373 * then no mapping is done. 374 */ 375 parent = OF_parent(bridge); 376 while (parent != 0) { 377 OF_get_addr_props(parent, &nbridge, NULL, &pcib); 378 res = OF_getprop(bridge, "ranges", cell, sizeof(cell)); 379 if (res == -1) 380 goto next; 381 if (res % sizeof(cell[0])) 382 return (ENXIO); 383 res /= sizeof(cell[0]); 384 regno = 0; 385 while (regno < res) { 386 rspc = (pci) 387 ? cell[regno] & OFW_PCI_PHYS_HI_SPACEMASK 388 : ~0; 389 if (rspc != spc) { 390 regno += naddr + nbridge + nsize; 391 continue; 392 } 393 raddr = 0; 394 for (c = 0; c < naddr; c++) 395 raddr = ((uint64_t)raddr << 32) | cell[regno++]; 396 rspc = (pcib) 397 ? cell[regno] & OFW_PCI_PHYS_HI_SPACEMASK 398 : ~0; 399 baddr = 0; 400 for (c = 0; c < nbridge; c++) 401 baddr = ((uint64_t)baddr << 32) | cell[regno++]; 402 rsize = 0; 403 for (c = 0; c < nsize; c++) 404 rsize = ((uint64_t)rsize << 32) | cell[regno++]; 405 if (addr < raddr || addr >= raddr + rsize) 406 continue; 407 addr = addr - raddr + baddr; 408 if (rspc != ~0) 409 spc = rspc; 410 } 411 412 next: 413 bridge = parent; 414 parent = OF_parent(bridge); 415 OF_get_addr_props(bridge, &naddr, &nsize, &pci); 416 } 417
|