sys/powerpc/aim/ofw_machdep.c

   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>
  35 __FBSDID("$FreeBSD$");
  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
  50 #include <vm/vm.h>
  51 #include <vm/vm_param.h>
  52 #include <vm/vm_page.h>
  53
  54 #include <machine/bus.h>
  55 #include <machine/md_var.h>
  56 #include <machine/powerpc.h>
  57 #include <machine/ofw_machdep.h>
  58 #include <powerpc/ofw/ofw_pci.h>
  59
  60 #define OFMEM_REGIONS   32
  61 static struct mem_region OFmem[OFMEM_REGIONS + 1], OFavail[OFMEM_REGIONS + 3];
  62 static struct mem_region OFfree[OFMEM_REGIONS + 3];
  63
  64 extern register_t ofmsr[5];
  65 extern struct   pcpu __pcpu[MAXCPU];
  66 extern struct   pmap ofw_pmap;
  67 static int      (*ofwcall)(void *);
  68
  69 /*
  70  * Saved SPRG0-3 from OpenFirmware. Will be restored prior to the callback.
  71  */
  72 register_t      ofw_sprg0_save;
  73
  74 static __inline void
  75 ofw_sprg_prepare(void)
  76 {
  77         /*
  78          * Assume that interrupt are disabled at this point, or
  79          * SPRG1-3 could be trashed
  80          */
  81         __asm __volatile("mfsprg0 %0\n\t"
  82                          "mtsprg0 %1\n\t"
  83                          "mtsprg1 %2\n\t"
  84                          "mtsprg2 %3\n\t"
  85                          "mtsprg3 %4\n\t"
  86                          : "=&r"(ofw_sprg0_save)
  87                          : "r"(ofmsr[1]),
  88                          "r"(ofmsr[2]),
  89                          "r"(ofmsr[3]),
  90                          "r"(ofmsr[4]));
  91 }
  92
  93 static __inline void
  94 ofw_sprg_restore(void)
  95 {
  96         /*
  97          * Note that SPRG1-3 contents are irrelevant. They are scratch
  98          * registers used in the early portion of trap handling when
  99          * interrupts are disabled.
 100          *
 101          * PCPU data cannot be used until this routine is called !
 102          */
 103         __asm __volatile("mtsprg0 %0" :: "r"(ofw_sprg0_save));
 104 }
 105
 106 /*
 107  * Memory region utilities: determine if two regions overlap,
 108  * and merge two overlapping regions into one
 109  */
 110 static int
 111 memr_overlap(struct mem_region *r1, struct mem_region *r2)
 112 {
 113         if ((r1->mr_start + r1->mr_size) < r2->mr_start ||
 114             (r2->mr_start + r2->mr_size) < r1->mr_start)
 115                 return (FALSE);
 116
 117         return (TRUE);
 118 }
 119
 120 static void
 121 memr_merge(struct mem_region *from, struct mem_region *to)
 122 {
 123         int end;
 124         end = imax(to->mr_start + to->mr_size, from->mr_start + from->mr_size);
 125         to->mr_start = imin(from->mr_start, to->mr_start);
 126         to->mr_size = end - to->mr_start;
 127 }
 128
 129 /*
 130  * This is called during powerpc_init, before the system is really initialized.
 131  * It shall provide the total and the available regions of RAM.
 132  * Both lists must have a zero-size entry as terminator.
 133  * The available regions need not take the kernel into account, but needs
 134  * to provide space for two additional entry beyond the terminating one.
 135  */
 136 void
 137 mem_regions(struct mem_region **memp, int *memsz,
 138                 struct mem_region **availp, int *availsz)
 139 {
 140         int phandle;
 141         int asz, msz, fsz;
 142         int i, j;
 143         int still_merging;
 144
 145         /*
 146          * Get memory.
 147          */
 148         if ((phandle = OF_finddevice("/memory")) == -1
 149             || (msz = OF_getprop(phandle, "reg",
 150                           OFmem, sizeof OFmem[0] * OFMEM_REGIONS))
 151                <= 0
 152             || (asz = OF_getprop(phandle, "available",
 153                           OFavail, sizeof OFavail[0] * OFMEM_REGIONS))
 154                <= 0)
 155                 panic("no memory?");
 156         *memp = OFmem;
 157         *memsz = msz / sizeof(struct mem_region);
 158
 159         /*
 160          * OFavail may have overlapping regions - collapse these
 161          * and copy out remaining regions to OFfree
 162          */
 163         asz /= sizeof(struct mem_region);
 164         do {
 165                 still_merging = FALSE;
 166                 for (i = 0; i < asz; i++) {
 167                         if (OFavail[i].mr_size == 0)
 168                                 continue;
 169                         for (j = i+1; j < asz; j++) {
 170                                 if (OFavail[j].mr_size == 0)
 171                                         continue;
 172                                 if (memr_overlap(&OFavail[j], &OFavail[i])) {
 173                                         memr_merge(&OFavail[j], &OFavail[i]);
 174                                         /* mark inactive */
 175                                         OFavail[j].mr_size = 0;
 176                                         still_merging = TRUE;
 177                                 }
 178                         }
 179                 }
 180         } while (still_merging == TRUE);
 181
 182         /* evict inactive ranges */
 183         for (i = 0, fsz = 0; i < asz; i++) {
 184                 if (OFavail[i].mr_size != 0) {
 185                         OFfree[fsz] = OFavail[i];
 186                         fsz++;
 187                 }
 188         }
 189
 190         *availp = OFfree;
 191         *availsz = fsz;
 192 }
 193
 194 void
 195 set_openfirm_callback(int (*openfirm)(void *))
 196 {
 197
 198         ofwcall = openfirm;
 199 }
 200
 201 int
 202 openfirmware(void *args)
 203 {
 204         long    oldmsr;
 205         int     result;
 206         u_int   srsave[16];
 207         u_int   i;
 208
 209         __asm __volatile(       "\t"
 210                 "sync\n\t"
 211                 "mfmsr  %0\n\t"
 212                 "mtmsr  %1\n\t"
 213                 "isync\n"
 214                 : "=r" (oldmsr)
 215                 : "r" (ofmsr[0])
 216         );
 217
 218         ofw_sprg_prepare();
 219
 220         if (pmap_bootstrapped) {
 221                 /*
 222                  * Swap the kernel's address space with Open Firmware's
 223                  */
 224                 for (i = 0; i < 16; i++) {
 225                         srsave[i] = mfsrin(i << ADDR_SR_SHFT);
 226                         mtsrin(i << ADDR_SR_SHFT, ofw_pmap.pm_sr[i]);
 227                 }
 228
 229                 /*
 230                  * Clear battable[] translations
 231                  */
 232                 __asm __volatile("mtdbatu 2, %0\n"
 233                                  "mtdbatu 3, %0" : : "r" (0));
 234                 isync();
 235         }
 236
 237         result = ofwcall(args);
 238
 239         if (pmap_bootstrapped) {
 240                 /*
 241                  * Restore the kernel's addr space. The isync() doesn;t
 242                  * work outside the loop unless mtsrin() is open-coded
 243                  * in an asm statement :(
 244                  */
 245                 for (i = 0; i < 16; i++) {
 246                         mtsrin(i << ADDR_SR_SHFT, srsave[i]);
 247                         isync();
 248                 }
 249         }
 250
 251         ofw_sprg_restore();
 252
 253         __asm(  "\t"
 254                 "mtmsr  %0\n\t"
 255                 "isync\n"
 256                 : : "r" (oldmsr)
 257         );
 258
 259         return (result);
 260 }
 261
 262 void
 263 OF_halt()
 264 {
 265         int retval;     /* dummy, this may not be needed */
 266
 267         OF_interpret("shut-down", 1, &retval);
 268         for (;;);       /* just in case */
 269 }
 270
 271 void
 272 OF_reboot()
 273 {
 274         int retval;     /* dummy, this may not be needed */
 275
 276         OF_interpret("reset-all", 1, &retval);
 277         for (;;);       /* just in case */
 278 }
 279
 280 void
 281 OF_getetheraddr(device_t dev, u_char *addr)
 282 {
 283         phandle_t       node;
 284
 285         node = ofw_pci_find_node(dev);
 286         OF_getprop(node, "local-mac-address", addr, ETHER_ADDR_LEN);
 287 }
 288
 289 /*
 290  * Return the physical address and the bus space to use for a node
 291  * referenced by its package handle and the index of the register bank
 292  * to decode. Intended to be used by console drivers in early boot only.
 293  * Works by mapping the address of the node's bank given in the address
 294  * space of its parent upward in the device tree at each bridge along the
 295  * path.
 296  */
 297 int
 298 OF_decode_addr(phandle_t node, int bank, bus_space_tag_t *tag,
 299     bus_space_handle_t *handle)
 300 {
 301
 302         return (ENXIO);
 303 }
 304
 305 int
 306 mem_valid(vm_offset_t addr, int len)
 307 {
 308         int i;
 309
 310         for (i = 0; i < OFMEM_REGIONS; i++)
 311                 if ((addr >= OFmem[i].mr_start)
 312                     && (addr + len < OFmem[i].mr_start + OFmem[i].mr_size))
 313                         return (0);
 314
 315         return (EFAULT);
 316 }