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