a45d9127bd
for variables that live in the boot page. o Add bp_trace (yes, it's in the boot page) that gets zeroed before we try to wake a core and to which the core being woken can write markers so that we know where the core was in case it doesn't wake up. The boot code does not yet write markers (too follow). o Disable the boot page translation to allow the last 4K page to be used for whatever we please. It would get mapped otherwise. o Fix kernstart in the case of SMP. The start argument is typically page aligned due to the alignment requirements that come with having a boot page. The point of using trunc_page is that we get the actual load address given that the entry point is immediately following the ELF headers. In the SMP case this ended up exactly 4K after the load address. Hence subtracting 1 from start.
334 lines
7.9 KiB
C
334 lines
7.9 KiB
C
/*-
|
|
* Copyright (c) 2008-2009 Semihalf, Rafal Jaworowski
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
*
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/pcpu.h>
|
|
#include <sys/proc.h>
|
|
#include <sys/smp.h>
|
|
|
|
#include <machine/bus.h>
|
|
#include <machine/cpu.h>
|
|
#include <machine/hid.h>
|
|
#include <machine/platform.h>
|
|
#include <machine/platformvar.h>
|
|
#include <machine/smp.h>
|
|
#include <machine/spr.h>
|
|
#include <machine/vmparam.h>
|
|
|
|
#include <dev/fdt/fdt_common.h>
|
|
#include <dev/ofw/ofw_bus.h>
|
|
#include <dev/ofw/ofw_bus_subr.h>
|
|
#include <dev/ofw/openfirm.h>
|
|
|
|
#include <powerpc/mpc85xx/mpc85xx.h>
|
|
|
|
#include "platform_if.h"
|
|
|
|
#ifdef SMP
|
|
extern void *ap_pcpu;
|
|
extern uint8_t __boot_page[]; /* Boot page body */
|
|
extern uint32_t bp_kernload; /* Kernel physical load address */
|
|
extern uint32_t bp_trace; /* AP boot trace field */
|
|
#endif
|
|
|
|
extern uint32_t *bootinfo;
|
|
|
|
static int cpu, maxcpu;
|
|
|
|
static int bare_probe(platform_t);
|
|
static void bare_mem_regions(platform_t, struct mem_region **phys, int *physsz,
|
|
struct mem_region **avail, int *availsz);
|
|
static u_long bare_timebase_freq(platform_t, struct cpuref *cpuref);
|
|
static int bare_smp_first_cpu(platform_t, struct cpuref *cpuref);
|
|
static int bare_smp_next_cpu(platform_t, struct cpuref *cpuref);
|
|
static int bare_smp_get_bsp(platform_t, struct cpuref *cpuref);
|
|
static int bare_smp_start_cpu(platform_t, struct pcpu *cpu);
|
|
|
|
static void e500_reset(platform_t);
|
|
|
|
static platform_method_t bare_methods[] = {
|
|
PLATFORMMETHOD(platform_probe, bare_probe),
|
|
PLATFORMMETHOD(platform_mem_regions, bare_mem_regions),
|
|
PLATFORMMETHOD(platform_timebase_freq, bare_timebase_freq),
|
|
|
|
PLATFORMMETHOD(platform_smp_first_cpu, bare_smp_first_cpu),
|
|
PLATFORMMETHOD(platform_smp_next_cpu, bare_smp_next_cpu),
|
|
PLATFORMMETHOD(platform_smp_get_bsp, bare_smp_get_bsp),
|
|
PLATFORMMETHOD(platform_smp_start_cpu, bare_smp_start_cpu),
|
|
|
|
PLATFORMMETHOD(platform_reset, e500_reset),
|
|
|
|
{ 0, 0 }
|
|
};
|
|
|
|
static platform_def_t bare_platform = {
|
|
"bare metal",
|
|
bare_methods,
|
|
0
|
|
};
|
|
|
|
PLATFORM_DEF(bare_platform);
|
|
|
|
static int
|
|
bare_probe(platform_t plat)
|
|
{
|
|
uint32_t ver, sr;
|
|
int i, law_max, tgt;
|
|
|
|
ver = SVR_VER(mfspr(SPR_SVR));
|
|
switch (ver & ~0x0008) { /* Mask Security Enabled bit */
|
|
case SVR_P4080:
|
|
maxcpu = 8;
|
|
break;
|
|
case SVR_P4040:
|
|
maxcpu = 4;
|
|
break;
|
|
case SVR_MPC8572:
|
|
case SVR_P1020:
|
|
case SVR_P2020:
|
|
maxcpu = 2;
|
|
break;
|
|
default:
|
|
maxcpu = 1;
|
|
break;
|
|
}
|
|
|
|
/*
|
|
* Clear local access windows. Skip DRAM entries, so we don't shoot
|
|
* ourselves in the foot.
|
|
*/
|
|
law_max = law_getmax();
|
|
for (i = 0; i < law_max; i++) {
|
|
sr = ccsr_read4(OCP85XX_LAWSR(i));
|
|
if ((sr & 0x80000000) == 0)
|
|
continue;
|
|
tgt = (sr & 0x01f00000) >> 20;
|
|
if (tgt == OCP85XX_TGTIF_RAM1 || tgt == OCP85XX_TGTIF_RAM2 ||
|
|
tgt == OCP85XX_TGTIF_RAM_INTL)
|
|
continue;
|
|
|
|
ccsr_write4(OCP85XX_LAWSR(i), sr & 0x7fffffff);
|
|
}
|
|
|
|
return (BUS_PROBE_GENERIC);
|
|
}
|
|
|
|
#define MEM_REGIONS 8
|
|
static struct mem_region avail_regions[MEM_REGIONS];
|
|
|
|
void
|
|
bare_mem_regions(platform_t plat, struct mem_region **phys, int *physsz,
|
|
struct mem_region **avail, int *availsz)
|
|
{
|
|
uint32_t memsize;
|
|
int i, rv;
|
|
|
|
rv = fdt_get_mem_regions(avail_regions, availsz, &memsize);
|
|
|
|
if (rv != 0)
|
|
return;
|
|
|
|
for (i = 0; i < *availsz; i++) {
|
|
if (avail_regions[i].mr_start < 1048576) {
|
|
avail_regions[i].mr_size =
|
|
avail_regions[i].mr_size -
|
|
(1048576 - avail_regions[i].mr_start);
|
|
avail_regions[i].mr_start = 1048576;
|
|
}
|
|
}
|
|
*avail = avail_regions;
|
|
|
|
/* On the bare metal platform phys == avail memory */
|
|
*physsz = *availsz;
|
|
*phys = *avail;
|
|
}
|
|
|
|
static u_long
|
|
bare_timebase_freq(platform_t plat, struct cpuref *cpuref)
|
|
{
|
|
u_long ticks;
|
|
phandle_t cpus, child;
|
|
pcell_t freq;
|
|
|
|
if (bootinfo != NULL) {
|
|
if (bootinfo[0] == 1) {
|
|
/* Backward compatibility. See 8-STABLE. */
|
|
ticks = bootinfo[3] >> 3;
|
|
} else {
|
|
/* Compatibility with Juniper's loader. */
|
|
ticks = bootinfo[5] >> 3;
|
|
}
|
|
} else
|
|
ticks = 0;
|
|
|
|
if ((cpus = OF_finddevice("/cpus")) == -1)
|
|
goto out;
|
|
|
|
if ((child = OF_child(cpus)) == 0)
|
|
goto out;
|
|
|
|
freq = 0;
|
|
if (OF_getprop(child, "bus-frequency", (void *)&freq,
|
|
sizeof(freq)) <= 0)
|
|
goto out;
|
|
|
|
/*
|
|
* Time Base and Decrementer are updated every 8 CCB bus clocks.
|
|
* HID0[SEL_TBCLK] = 0
|
|
*/
|
|
if (freq != 0)
|
|
ticks = freq / 8;
|
|
|
|
out:
|
|
if (ticks <= 0)
|
|
panic("Unable to determine timebase frequency!");
|
|
|
|
return (ticks);
|
|
}
|
|
|
|
static int
|
|
bare_smp_first_cpu(platform_t plat, struct cpuref *cpuref)
|
|
{
|
|
|
|
cpu = 0;
|
|
cpuref->cr_cpuid = cpu;
|
|
cpuref->cr_hwref = cpuref->cr_cpuid;
|
|
if (bootverbose)
|
|
printf("powerpc_smp_first_cpu: cpuid %d\n", cpuref->cr_cpuid);
|
|
cpu++;
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
bare_smp_next_cpu(platform_t plat, struct cpuref *cpuref)
|
|
{
|
|
|
|
if (cpu >= maxcpu)
|
|
return (ENOENT);
|
|
|
|
cpuref->cr_cpuid = cpu++;
|
|
cpuref->cr_hwref = cpuref->cr_cpuid;
|
|
if (bootverbose)
|
|
printf("powerpc_smp_next_cpu: cpuid %d\n", cpuref->cr_cpuid);
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
bare_smp_get_bsp(platform_t plat, struct cpuref *cpuref)
|
|
{
|
|
|
|
cpuref->cr_cpuid = mfspr(SPR_PIR);
|
|
cpuref->cr_hwref = cpuref->cr_cpuid;
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
bare_smp_start_cpu(platform_t plat, struct pcpu *pc)
|
|
{
|
|
#ifdef SMP
|
|
uint32_t bptr, eebpcr;
|
|
int timeout;
|
|
|
|
eebpcr = ccsr_read4(OCP85XX_EEBPCR);
|
|
if ((eebpcr & (1 << (pc->pc_cpuid + 24))) != 0) {
|
|
printf("SMP: CPU %d already out of hold-off state!\n",
|
|
pc->pc_cpuid);
|
|
return (ENXIO);
|
|
}
|
|
|
|
ap_pcpu = pc;
|
|
__asm __volatile("msync; isync");
|
|
|
|
/*
|
|
* Set BPTR to the physical address of the boot page
|
|
*/
|
|
bptr = ((uint32_t)__boot_page - KERNBASE) + bp_kernload;
|
|
ccsr_write4(OCP85XX_BPTR, (bptr >> 12) | 0x80000000);
|
|
|
|
/*
|
|
* Release AP from hold-off state
|
|
*/
|
|
bp_trace = 0;
|
|
eebpcr |= (1 << (pc->pc_cpuid + 24));
|
|
ccsr_write4(OCP85XX_EEBPCR, eebpcr);
|
|
__asm __volatile("isync; msync");
|
|
|
|
timeout = 500;
|
|
while (!pc->pc_awake && timeout--)
|
|
DELAY(1000); /* wait 1ms */
|
|
|
|
/*
|
|
* Disable boot page translation so that the 4K page at the default
|
|
* address (= 0xfffff000) isn't permanently remapped and thus not
|
|
* usable otherwise.
|
|
*/
|
|
ccsr_write4(OCP85XX_BPTR, 0);
|
|
|
|
if (!pc->pc_awake)
|
|
printf("SMP: CPU %d didn't wake up (trace code %#x).\n",
|
|
pc->pc_awake, bp_trace);
|
|
return ((pc->pc_awake) ? 0 : EBUSY);
|
|
#else
|
|
/* No SMP support */
|
|
return (ENXIO);
|
|
#endif
|
|
}
|
|
|
|
static void
|
|
e500_reset(platform_t plat)
|
|
{
|
|
|
|
/*
|
|
* Try the dedicated reset register first.
|
|
* If the SoC doesn't have one, we'll fall
|
|
* back to using the debug control register.
|
|
*/
|
|
ccsr_write4(OCP85XX_RSTCR, 2);
|
|
|
|
/* Clear DBCR0, disables debug interrupts and events. */
|
|
mtspr(SPR_DBCR0, 0);
|
|
__asm __volatile("isync");
|
|
|
|
/* Enable Debug Interrupts in MSR. */
|
|
mtmsr(mfmsr() | PSL_DE);
|
|
|
|
/* Enable debug interrupts and issue reset. */
|
|
mtspr(SPR_DBCR0, mfspr(SPR_DBCR0) | DBCR0_IDM | DBCR0_RST_SYSTEM);
|
|
|
|
printf("Reset failed...\n");
|
|
while (1);
|
|
}
|
|
|