302acc2e5f
add actual platform probing based on PVR. Still needs a little more work: in particular, the CCRS setup should move here. Also turn "bare" into a truly bare platform that doesn't pretend to know how to do anything except get the memory map. This should also be enhanced to process the FDT reserved memory list, but that is for another day.
357 lines
8.5 KiB
C
357 lines
8.5 KiB
C
/*-
|
|
* Copyright (c) 2008-2012 Semihalf.
|
|
* 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 vm_paddr_t kernload; /* Kernel physical load address */
|
|
extern uint8_t __boot_page[]; /* Boot page body */
|
|
extern uint32_t bp_ntlb1s;
|
|
extern uint32_t bp_tlb1[];
|
|
extern uint32_t bp_tlb1_end[];
|
|
#endif
|
|
|
|
extern uint32_t *bootinfo;
|
|
|
|
static int cpu, maxcpu;
|
|
|
|
static int mpc85xx_probe(platform_t);
|
|
static int mpc85xx_attach(platform_t);
|
|
static void mpc85xx_mem_regions(platform_t, struct mem_region **phys,
|
|
int *physsz, struct mem_region **avail, int *availsz);
|
|
static u_long mpc85xx_timebase_freq(platform_t, struct cpuref *cpuref);
|
|
static int mpc85xx_smp_first_cpu(platform_t, struct cpuref *cpuref);
|
|
static int mpc85xx_smp_next_cpu(platform_t, struct cpuref *cpuref);
|
|
static int mpc85xx_smp_get_bsp(platform_t, struct cpuref *cpuref);
|
|
static int mpc85xx_smp_start_cpu(platform_t, struct pcpu *cpu);
|
|
|
|
static void mpc85xx_reset(platform_t);
|
|
|
|
static platform_method_t mpc85xx_methods[] = {
|
|
PLATFORMMETHOD(platform_probe, mpc85xx_probe),
|
|
PLATFORMMETHOD(platform_attach, mpc85xx_attach),
|
|
PLATFORMMETHOD(platform_mem_regions, mpc85xx_mem_regions),
|
|
PLATFORMMETHOD(platform_timebase_freq, mpc85xx_timebase_freq),
|
|
|
|
PLATFORMMETHOD(platform_smp_first_cpu, mpc85xx_smp_first_cpu),
|
|
PLATFORMMETHOD(platform_smp_next_cpu, mpc85xx_smp_next_cpu),
|
|
PLATFORMMETHOD(platform_smp_get_bsp, mpc85xx_smp_get_bsp),
|
|
PLATFORMMETHOD(platform_smp_start_cpu, mpc85xx_smp_start_cpu),
|
|
|
|
PLATFORMMETHOD(platform_reset, mpc85xx_reset),
|
|
|
|
PLATFORMMETHOD_END
|
|
};
|
|
|
|
static platform_def_t mpc85xx_platform = {
|
|
"mpc85xx",
|
|
mpc85xx_methods,
|
|
0
|
|
};
|
|
|
|
PLATFORM_DEF(mpc85xx_platform);
|
|
|
|
static int
|
|
mpc85xx_probe(platform_t plat)
|
|
{
|
|
u_int pvr = mfpvr() >> 16;
|
|
|
|
if ((pvr & 0xfff0) == FSL_E500v1)
|
|
return (BUS_PROBE_DEFAULT);
|
|
|
|
return (ENXIO);
|
|
}
|
|
|
|
static int
|
|
mpc85xx_attach(platform_t plat)
|
|
{
|
|
phandle_t cpus, child;
|
|
uint32_t sr;
|
|
int i, law_max, tgt;
|
|
|
|
if ((cpus = OF_finddevice("/cpus")) != -1) {
|
|
for (maxcpu = 0, child = OF_child(cpus); child != 0;
|
|
child = OF_peer(child), maxcpu++)
|
|
;
|
|
} else
|
|
maxcpu = 1;
|
|
|
|
/*
|
|
* 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 (0);
|
|
}
|
|
|
|
void
|
|
mpc85xx_mem_regions(platform_t plat, struct mem_region **phys, int *physsz,
|
|
struct mem_region **avail, int *availsz)
|
|
{
|
|
|
|
ofw_mem_regions(phys, physsz, avail, availsz);
|
|
}
|
|
|
|
static u_long
|
|
mpc85xx_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;
|
|
|
|
switch (OF_getproplen(child, "timebase-frequency")) {
|
|
case 4:
|
|
{
|
|
uint32_t tbase;
|
|
OF_getprop(child, "timebase-frequency", &tbase, sizeof(tbase));
|
|
ticks = tbase;
|
|
return (ticks);
|
|
}
|
|
case 8:
|
|
{
|
|
uint64_t tbase;
|
|
OF_getprop(child, "timebase-frequency", &tbase, sizeof(tbase));
|
|
ticks = tbase;
|
|
return (ticks);
|
|
}
|
|
default:
|
|
break;
|
|
}
|
|
|
|
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
|
|
mpc85xx_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
|
|
mpc85xx_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
|
|
mpc85xx_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
|
|
mpc85xx_smp_start_cpu(platform_t plat, struct pcpu *pc)
|
|
{
|
|
#ifdef SMP
|
|
uint32_t *tlb1;
|
|
uint32_t bptr, eebpcr;
|
|
int i, 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;
|
|
|
|
i = 0;
|
|
tlb1 = bp_tlb1;
|
|
while (i < bp_ntlb1s && tlb1 < bp_tlb1_end) {
|
|
mtspr(SPR_MAS0, MAS0_TLBSEL(1) | MAS0_ESEL(i));
|
|
__asm __volatile("isync; tlbre");
|
|
tlb1[0] = mfspr(SPR_MAS1);
|
|
tlb1[1] = mfspr(SPR_MAS2);
|
|
tlb1[2] = mfspr(SPR_MAS3);
|
|
i++;
|
|
tlb1 += 3;
|
|
}
|
|
if (i < bp_ntlb1s)
|
|
bp_ntlb1s = i;
|
|
|
|
/*
|
|
* Set BPTR to the physical address of the boot page
|
|
*/
|
|
bptr = ((uint32_t)__boot_page - KERNBASE) + kernload;
|
|
KASSERT((bptr & 0xfff) == 0,
|
|
("%s: boot page is not aligned (%#x)", __func__, bptr));
|
|
bptr = (bptr >> 12) | 0x80000000u;
|
|
ccsr_write4(OCP85XX_BPTR, bptr);
|
|
__asm __volatile("isync; msync");
|
|
|
|
/* Flush caches to have our changes hit DRAM. */
|
|
cpu_flush_dcache(__boot_page, 4096);
|
|
|
|
/*
|
|
* Release AP from hold-off state
|
|
*/
|
|
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);
|
|
__asm __volatile("isync; msync");
|
|
|
|
if (!pc->pc_awake)
|
|
printf("SMP: CPU %d didn't wake up.\n", pc->pc_cpuid);
|
|
return ((pc->pc_awake) ? 0 : EBUSY);
|
|
#else
|
|
/* No SMP support */
|
|
return (ENXIO);
|
|
#endif
|
|
}
|
|
|
|
static void
|
|
mpc85xx_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)
|
|
;
|
|
}
|
|
|