1 /*- 2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 3 * 4 * Copyright (c) 2008 Marcel Moolenaar 5 * Copyright (c) 2009 Nathan Whitehorn 6 * All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 12 * 1. Redistributions of source code must retain the above copyright 13 * notice, this list of conditions and the following disclaimer. 14 * 2. Redistributions in binary form must reproduce the above copyright 15 * notice, this list of conditions and the following disclaimer in the 16 * documentation and/or other materials provided with the distribution. 17 * 18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 19 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 20 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 21 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 22 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 23 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 24 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 25 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 26 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 27 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 28 */ 29 30 #include <sys/cdefs.h> 31 __FBSDID("$FreeBSD$"); 32 33 #include <sys/param.h> 34 #include <sys/systm.h> 35 #include <sys/kernel.h> 36 #include <sys/bus.h> 37 #include <sys/pcpu.h> 38 #include <sys/proc.h> 39 #include <sys/smp.h> 40 #include <vm/vm.h> 41 #include <vm/pmap.h> 42 43 #include <machine/altivec.h> /* For save_vec() */ 44 #include <machine/bus.h> 45 #include <machine/cpu.h> 46 #include <machine/fpu.h> /* For save_fpu() */ 47 #include <machine/hid.h> 48 #include <machine/platformvar.h> 49 #include <machine/setjmp.h> 50 #include <machine/smp.h> 51 #include <machine/spr.h> 52 53 #include <dev/ofw/openfirm.h> 54 #include <machine/ofw_machdep.h> 55 56 #include <powerpc/powermac/platform_powermac.h> 57 58 #include "platform_if.h" 59 60 extern volatile void *ap_pcpu; 61 62 static void dummy_timebase(device_t, bool); 63 static device_t powermac_tb_dev; 64 static void (*freeze_timebase)(device_t, bool) = dummy_timebase; 65 66 static int powermac_probe(platform_t); 67 static int powermac_attach(platform_t); 68 void powermac_mem_regions(platform_t, struct mem_region *phys, int *physsz, 69 struct mem_region *avail, int *availsz); 70 static u_long powermac_timebase_freq(platform_t, struct cpuref *cpuref); 71 static int powermac_smp_first_cpu(platform_t, struct cpuref *cpuref); 72 static int powermac_smp_next_cpu(platform_t, struct cpuref *cpuref); 73 static int powermac_smp_get_bsp(platform_t, struct cpuref *cpuref); 74 static int powermac_smp_start_cpu(platform_t, struct pcpu *cpu); 75 static void powermac_smp_timebase_sync(platform_t, u_long tb, int ap); 76 static void powermac_reset(platform_t); 77 #ifndef __powerpc64__ 78 static void powermac_sleep(platform_t); 79 #endif 80 81 static platform_method_t powermac_methods[] = { 82 PLATFORMMETHOD(platform_probe, powermac_probe), 83 PLATFORMMETHOD(platform_attach, powermac_attach), 84 PLATFORMMETHOD(platform_mem_regions, powermac_mem_regions), 85 PLATFORMMETHOD(platform_timebase_freq, powermac_timebase_freq), 86 87 PLATFORMMETHOD(platform_smp_first_cpu, powermac_smp_first_cpu), 88 PLATFORMMETHOD(platform_smp_next_cpu, powermac_smp_next_cpu), 89 PLATFORMMETHOD(platform_smp_get_bsp, powermac_smp_get_bsp), 90 PLATFORMMETHOD(platform_smp_start_cpu, powermac_smp_start_cpu), 91 PLATFORMMETHOD(platform_smp_timebase_sync, powermac_smp_timebase_sync), 92 93 PLATFORMMETHOD(platform_reset, powermac_reset), 94 #ifndef __powerpc64__ 95 PLATFORMMETHOD(platform_sleep, powermac_sleep), 96 #endif 97 98 PLATFORMMETHOD_END 99 }; 100 101 static platform_def_t powermac_platform = { 102 "powermac", 103 powermac_methods, 104 0 105 }; 106 107 PLATFORM_DEF(powermac_platform); 108 109 static int 110 powermac_probe(platform_t plat) 111 { 112 char compat[255]; 113 ssize_t compatlen; 114 char *curstr; 115 phandle_t root; 116 117 root = OF_peer(0); 118 if (root == 0) 119 return (ENXIO); 120 121 compatlen = OF_getprop(root, "compatible", compat, sizeof(compat)); 122 123 for (curstr = compat; curstr < compat + compatlen; 124 curstr += strlen(curstr) + 1) { 125 if (strncmp(curstr, "MacRISC", 7) == 0) 126 return (BUS_PROBE_SPECIFIC); 127 } 128 129 return (ENXIO); 130 } 131 132 void 133 powermac_mem_regions(platform_t plat, struct mem_region *phys, int *physsz, 134 struct mem_region *avail, int *availsz) 135 { 136 phandle_t memory; 137 cell_t memoryprop[PHYS_AVAIL_SZ * 2]; 138 ssize_t propsize, i, j; 139 int physacells = 1; 140 141 memory = OF_finddevice("/memory"); 142 if (memory == -1) 143 memory = OF_finddevice("/memory@0"); 144 145 /* "reg" has variable #address-cells, but #size-cells is always 1 */ 146 OF_getprop(OF_parent(memory), "#address-cells", &physacells, 147 sizeof(physacells)); 148 149 propsize = OF_getprop(memory, "reg", memoryprop, sizeof(memoryprop)); 150 propsize /= sizeof(cell_t); 151 for (i = 0, j = 0; i < propsize; i += physacells+1, j++) { 152 phys[j].mr_start = memoryprop[i]; 153 if (physacells == 2) { 154 #ifndef __powerpc64__ 155 /* On 32-bit PPC, ignore regions starting above 4 GB */ 156 if (memoryprop[i] != 0) { 157 j--; 158 continue; 159 } 160 #else 161 phys[j].mr_start <<= 32; 162 #endif 163 phys[j].mr_start |= memoryprop[i+1]; 164 } 165 phys[j].mr_size = memoryprop[i + physacells]; 166 } 167 *physsz = j; 168 169 /* "available" always has #address-cells = 1 */ 170 propsize = OF_getprop(memory, "available", memoryprop, 171 sizeof(memoryprop)); 172 if (propsize <= 0) { 173 for (i = 0; i < *physsz; i++) { 174 avail[i].mr_start = phys[i].mr_start; 175 avail[i].mr_size = phys[i].mr_size; 176 } 177 178 *availsz = *physsz; 179 } else { 180 propsize /= sizeof(cell_t); 181 for (i = 0, j = 0; i < propsize; i += 2, j++) { 182 avail[j].mr_start = memoryprop[i]; 183 avail[j].mr_size = memoryprop[i + 1]; 184 } 185 186 #ifdef __powerpc64__ 187 /* Add in regions above 4 GB to the available list */ 188 for (i = 0; i < *physsz; i++) { 189 if (phys[i].mr_start > BUS_SPACE_MAXADDR_32BIT) { 190 avail[j].mr_start = phys[i].mr_start; 191 avail[j].mr_size = phys[i].mr_size; 192 j++; 193 } 194 } 195 #endif 196 *availsz = j; 197 } 198 } 199 200 static int 201 powermac_attach(platform_t plat) 202 { 203 phandle_t rootnode; 204 char model[32]; 205 206 /* 207 * Quiesce Open Firmware on PowerMac11,2 and 12,1. It is 208 * necessary there to shut down a background thread doing fan 209 * management, and is harmful on other machines (it will make OF 210 * shut off power to various system components it had turned on). 211 * 212 * Note: we don't need to worry about which OF module we are 213 * using since this is called only from very early boot, within 214 * OF's boot context. 215 */ 216 217 rootnode = OF_finddevice("/"); 218 if (OF_getprop(rootnode, "model", model, sizeof(model)) > 0) { 219 if (strcmp(model, "PowerMac11,2") == 0 || 220 strcmp(model, "PowerMac12,1") == 0) { 221 ofw_quiesce(); 222 } 223 } 224 225 return (0); 226 } 227 228 static u_long 229 powermac_timebase_freq(platform_t plat, struct cpuref *cpuref) 230 { 231 phandle_t phandle; 232 int32_t ticks = -1; 233 234 phandle = cpuref->cr_hwref; 235 236 OF_getprop(phandle, "timebase-frequency", &ticks, sizeof(ticks)); 237 238 if (ticks <= 0) 239 panic("Unable to determine timebase frequency!"); 240 241 return (ticks); 242 } 243 244 static int 245 powermac_smp_fill_cpuref(struct cpuref *cpuref, phandle_t cpu) 246 { 247 cell_t cpuid; 248 int res; 249 250 cpuref->cr_hwref = cpu; 251 res = OF_getprop(cpu, "reg", &cpuid, sizeof(cpuid)); 252 253 /* 254 * psim doesn't have a reg property, so assume 0 as for the 255 * uniprocessor case in the CHRP spec. 256 */ 257 if (res < 0) { 258 cpuid = 0; 259 } 260 261 cpuref->cr_cpuid = cpuid & 0xff; 262 return (0); 263 } 264 265 static int 266 powermac_smp_first_cpu(platform_t plat, struct cpuref *cpuref) 267 { 268 char buf[8]; 269 phandle_t cpu, dev, root; 270 int res; 271 272 root = OF_peer(0); 273 274 dev = OF_child(root); 275 while (dev != 0) { 276 res = OF_getprop(dev, "name", buf, sizeof(buf)); 277 if (res > 0 && strcmp(buf, "cpus") == 0) 278 break; 279 dev = OF_peer(dev); 280 } 281 if (dev == 0) { 282 /* 283 * psim doesn't have a name property on the /cpus node, 284 * but it can be found directly 285 */ 286 dev = OF_finddevice("/cpus"); 287 if (dev == -1) 288 return (ENOENT); 289 } 290 291 cpu = OF_child(dev); 292 293 while (cpu != 0) { 294 res = OF_getprop(cpu, "device_type", buf, sizeof(buf)); 295 if (res > 0 && strcmp(buf, "cpu") == 0) 296 break; 297 cpu = OF_peer(cpu); 298 } 299 if (cpu == 0) 300 return (ENOENT); 301 302 return (powermac_smp_fill_cpuref(cpuref, cpu)); 303 } 304 305 static int 306 powermac_smp_next_cpu(platform_t plat, struct cpuref *cpuref) 307 { 308 char buf[8]; 309 phandle_t cpu; 310 int res; 311 312 cpu = OF_peer(cpuref->cr_hwref); 313 while (cpu != 0) { 314 res = OF_getprop(cpu, "device_type", buf, sizeof(buf)); 315 if (res > 0 && strcmp(buf, "cpu") == 0) 316 break; 317 cpu = OF_peer(cpu); 318 } 319 if (cpu == 0) 320 return (ENOENT); 321 322 return (powermac_smp_fill_cpuref(cpuref, cpu)); 323 } 324 325 static int 326 powermac_smp_get_bsp(platform_t plat, struct cpuref *cpuref) 327 { 328 ihandle_t inst; 329 phandle_t bsp, chosen; 330 int res; 331 332 chosen = OF_finddevice("/chosen"); 333 if (chosen == -1) 334 return (ENXIO); 335 336 res = OF_getprop(chosen, "cpu", &inst, sizeof(inst)); 337 if (res < 0) 338 return (ENXIO); 339 340 bsp = OF_instance_to_package(inst); 341 return (powermac_smp_fill_cpuref(cpuref, bsp)); 342 } 343 344 static int 345 powermac_smp_start_cpu(platform_t plat, struct pcpu *pc) 346 { 347 #ifdef SMP 348 phandle_t cpu; 349 volatile uint8_t *rstvec; 350 static volatile uint8_t *rstvec_virtbase = NULL; 351 int res, reset, timeout; 352 353 cpu = pc->pc_hwref; 354 res = OF_getprop(cpu, "soft-reset", &reset, sizeof(reset)); 355 if (res < 0) { 356 reset = 0x58; 357 358 switch (pc->pc_cpuid) { 359 case 0: 360 reset += 0x03; 361 break; 362 case 1: 363 reset += 0x04; 364 break; 365 case 2: 366 reset += 0x0f; 367 break; 368 case 3: 369 reset += 0x10; 370 break; 371 default: 372 return (ENXIO); 373 } 374 } 375 376 ap_pcpu = pc; 377 378 if (rstvec_virtbase == NULL) 379 rstvec_virtbase = pmap_mapdev(0x80000000, PAGE_SIZE); 380 381 rstvec = rstvec_virtbase + reset; 382 383 *rstvec = 4; 384 powerpc_sync(); 385 (void)(*rstvec); 386 powerpc_sync(); 387 DELAY(1); 388 *rstvec = 0; 389 powerpc_sync(); 390 (void)(*rstvec); 391 powerpc_sync(); 392 393 timeout = 10000; 394 while (!pc->pc_awake && timeout--) 395 DELAY(100); 396 397 return ((pc->pc_awake) ? 0 : EBUSY); 398 #else 399 /* No SMP support */ 400 return (ENXIO); 401 #endif 402 } 403 404 void 405 powermac_register_timebase(device_t dev, powermac_tb_disable_t cb) 406 { 407 powermac_tb_dev = dev; 408 freeze_timebase = cb; 409 } 410 411 static void 412 powermac_smp_timebase_sync(platform_t plat, u_long tb, int ap) 413 { 414 static volatile bool tb_ready; 415 static volatile int cpu_done; 416 417 /* 418 * XXX Temporary fallback for platforms we don't know how to freeze. 419 * 420 * This needs to be replaced with a cpu-to-cpu software sync 421 * protocol, because this is not a consistent way to sync timebase. 422 */ 423 mttb(tb); 424 if (freeze_timebase == dummy_timebase) 425 return; 426 427 if (ap) { 428 /* APs. Hold off until we get a stable timebase. */ 429 critical_enter(); 430 while (!tb_ready) 431 atomic_thread_fence_seq_cst(); 432 mttb(tb); 433 atomic_add_int(&cpu_done, 1); 434 while (cpu_done < mp_ncpus) 435 atomic_thread_fence_seq_cst(); 436 critical_exit(); 437 } else { 438 /* BSP */ 439 critical_enter(); 440 /* Ensure cpu_done is zeroed so we can resync at runtime */ 441 atomic_set_int(&cpu_done, 0); 442 freeze_timebase(powermac_tb_dev, true); 443 tb_ready = true; 444 mttb(tb); 445 atomic_add_int(&cpu_done, 1); 446 while (cpu_done < mp_ncpus) 447 atomic_thread_fence_seq_cst(); 448 freeze_timebase(powermac_tb_dev, false); 449 /* Reset tb_ready so we can resync at runtime */ 450 tb_ready = false; 451 critical_exit(); 452 } 453 } 454 455 /* Fallback freeze. In case no real handler is found in the device tree. */ 456 static void 457 dummy_timebase(device_t dev, bool freeze) 458 { 459 /* Nothing to do here, move along. */ 460 } 461 462 static void 463 powermac_reset(platform_t platform) 464 { 465 OF_reboot(); 466 } 467 468 #ifndef __powerpc64__ 469 void 470 powermac_sleep(platform_t platform) 471 { 472 /* Only supports MPC745x for now. */ 473 if (!MPC745X_P(mfspr(SPR_PVR) >> 16)) { 474 printf("sleep only supported for G4 PowerMac hardware.\n"); 475 return; 476 } 477 478 *(unsigned long *)0x80 = 0x100; 479 mpc745x_sleep(); 480 } 481 #endif 482