| Current Path : /sys/amd64/compile/hs32/modules/usr/src/sys/modules/runfw/@/mips/mips/ |
FreeBSD hs32.drive.ne.jp 9.1-RELEASE FreeBSD 9.1-RELEASE #1: Wed Jan 14 12:18:08 JST 2015 root@hs32.drive.ne.jp:/sys/amd64/compile/hs32 amd64 |
| Current File : //sys/amd64/compile/hs32/modules/usr/src/sys/modules/runfw/@/mips/mips/cpu.c |
/*-
* Copyright (c) 2004 Juli Mallett. 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 AND CONTRIBUTORS ``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 OR CONTRIBUTORS 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: release/9.1.0/sys/mips/mips/cpu.c 224115 2011-07-16 20:31:29Z jchandra $");
#include "opt_cputype.h"
#include <sys/param.h>
#include <sys/kernel.h>
#include <sys/module.h>
#include <sys/stdint.h>
#include <sys/bus.h>
#include <sys/rman.h>
#include <sys/sysctl.h>
#include <sys/systm.h>
#include <vm/vm.h>
#include <vm/vm_page.h>
#include <machine/cache.h>
#include <machine/cpufunc.h>
#include <machine/cpuinfo.h>
#include <machine/cpuregs.h>
#include <machine/intr_machdep.h>
#include <machine/locore.h>
#include <machine/pte.h>
#include <machine/tlb.h>
#include <machine/hwfunc.h>
#if defined(CPU_CNMIPS)
#include <contrib/octeon-sdk/cvmx.h>
#include <contrib/octeon-sdk/octeon-model.h>
#endif
static void cpu_identify(void);
struct mips_cpuinfo cpuinfo;
/*
* Attempt to identify the MIPS CPU as much as possible.
*
* XXX: Assumes the CPU is MIPS{32,64}{,r2} compliant.
* XXX: For now, skip config register selections 2 and 3
* as we don't currently use L2/L3 cache or additional
* MIPS32 processor features.
*/
static void
mips_get_identity(struct mips_cpuinfo *cpuinfo)
{
u_int32_t prid;
u_int32_t cfg0;
u_int32_t cfg1;
#if defined(CPU_CNMIPS)
u_int32_t cfg4;
#endif
u_int32_t tmp;
memset(cpuinfo, 0, sizeof(struct mips_cpuinfo));
/* Read and store the PrID ID for CPU identification. */
prid = mips_rd_prid();
cpuinfo->cpu_vendor = MIPS_PRID_CID(prid);
cpuinfo->cpu_rev = MIPS_PRID_REV(prid);
cpuinfo->cpu_impl = MIPS_PRID_IMPL(prid);
/* Read config register selection 0 to learn TLB type. */
cfg0 = mips_rd_config();
cpuinfo->tlb_type =
((cfg0 & MIPS_CONFIG0_MT_MASK) >> MIPS_CONFIG0_MT_SHIFT);
cpuinfo->icache_virtual = cfg0 & MIPS_CONFIG0_VI;
/* If config register selection 1 does not exist, exit. */
if (!(cfg0 & MIPS3_CONFIG_CM))
return;
/* Learn TLB size and L1 cache geometry. */
cfg1 = mips_rd_config1();
#ifndef CPU_NLM
cpuinfo->tlb_nentries =
((cfg1 & MIPS_CONFIG1_TLBSZ_MASK) >> MIPS_CONFIG1_TLBSZ_SHIFT) + 1;
#else
/* Account for Extended TLB entries in XLP */
tmp = mips_rd_config6();
cpuinfo->tlb_nentries = ((tmp >> 16) & 0xffff) + 1;
#endif
/* Add extended TLB size information from config4. */
#if defined(CPU_CNMIPS)
cfg4 = mips_rd_config4();
if ((cfg4 & MIPS_CONFIG4_MMUEXTDEF) == MIPS_CONFIG4_MMUEXTDEF_MMUSIZEEXT)
cpuinfo->tlb_nentries += (cfg4 & MIPS_CONFIG4_MMUSIZEEXT) * 0x40;
#endif
/* L1 instruction cache. */
tmp = (cfg1 & MIPS_CONFIG1_IL_MASK) >> MIPS_CONFIG1_IL_SHIFT;
if (tmp != 0) {
cpuinfo->l1.ic_linesize = 1 << (tmp + 1);
cpuinfo->l1.ic_nways = (((cfg1 & MIPS_CONFIG1_IA_MASK) >> MIPS_CONFIG1_IA_SHIFT)) + 1;
cpuinfo->l1.ic_nsets =
1 << (((cfg1 & MIPS_CONFIG1_IS_MASK) >> MIPS_CONFIG1_IS_SHIFT) + 6);
}
#ifndef CPU_CNMIPS
/* L1 data cache. */
tmp = (cfg1 & MIPS_CONFIG1_DL_MASK) >> MIPS_CONFIG1_DL_SHIFT;
if (tmp != 0) {
cpuinfo->l1.dc_linesize = 1 << (tmp + 1);
cpuinfo->l1.dc_nways =
(((cfg1 & MIPS_CONFIG1_DA_MASK) >> MIPS_CONFIG1_DA_SHIFT)) + 1;
cpuinfo->l1.dc_nsets =
1 << (((cfg1 & MIPS_CONFIG1_DS_MASK) >> MIPS_CONFIG1_DS_SHIFT) + 6);
}
#else
/*
* Some Octeon cache configuration parameters are by model family, not
* config1.
*/
if (OCTEON_IS_MODEL(OCTEON_CN3XXX)) {
/* Octeon and Octeon XL. */
cpuinfo->l1.dc_nsets = 1;
cpuinfo->l1.dc_nways = 64;
} else if (OCTEON_IS_MODEL(OCTEON_CN5XXX)) {
/* Octeon Plus. */
cpuinfo->l1.dc_nsets = 2;
cpuinfo->l1.dc_nways = 64;
} else if (OCTEON_IS_MODEL(OCTEON_CN6XXX)) {
/* Octeon II. */
cpuinfo->l1.dc_nsets = 8;
cpuinfo->l1.dc_nways = 32;
cpuinfo->l1.ic_nsets = 8;
cpuinfo->l1.ic_nways = 37;
} else {
panic("%s: unsupported Cavium Networks CPU.", __func__);
}
/* All Octeon models use 128 byte line size. */
cpuinfo->l1.dc_linesize = 128;
#endif
cpuinfo->l1.ic_size = cpuinfo->l1.ic_linesize
* cpuinfo->l1.ic_nsets * cpuinfo->l1.ic_nways;
cpuinfo->l1.dc_size = cpuinfo->l1.dc_linesize
* cpuinfo->l1.dc_nsets * cpuinfo->l1.dc_nways;
}
void
mips_cpu_init(void)
{
platform_cpu_init();
mips_get_identity(&cpuinfo);
num_tlbentries = cpuinfo.tlb_nentries;
mips_wr_wired(0);
tlb_invalidate_all();
mips_wr_wired(VMWIRED_ENTRIES);
mips_config_cache(&cpuinfo);
mips_vector_init();
mips_icache_sync_all();
mips_dcache_wbinv_all();
/* Print some info about CPU */
cpu_identify();
}
static void
cpu_identify(void)
{
uint32_t cfg0, cfg1, cfg2, cfg3;
printf("cpu%d: ", 0); /* XXX per-cpu */
switch (cpuinfo.cpu_vendor) {
case MIPS_PRID_CID_MTI:
printf("MIPS Technologies");
break;
case MIPS_PRID_CID_BROADCOM:
case MIPS_PRID_CID_SIBYTE:
printf("Broadcom");
break;
case MIPS_PRID_CID_ALCHEMY:
printf("AMD");
break;
case MIPS_PRID_CID_SANDCRAFT:
printf("Sandcraft");
break;
case MIPS_PRID_CID_PHILIPS:
printf("Philips");
break;
case MIPS_PRID_CID_TOSHIBA:
printf("Toshiba");
break;
case MIPS_PRID_CID_LSI:
printf("LSI");
break;
case MIPS_PRID_CID_LEXRA:
printf("Lexra");
break;
case MIPS_PRID_CID_RMI:
printf("RMI");
break;
case MIPS_PRID_CID_CAVIUM:
printf("Cavium");
break;
case MIPS_PRID_CID_PREHISTORIC:
default:
printf("Unknown cid %#x", cpuinfo.cpu_vendor);
break;
}
printf(" processor v%d.%d\n", cpuinfo.cpu_rev, cpuinfo.cpu_impl);
printf(" MMU: ");
if (cpuinfo.tlb_type == MIPS_MMU_NONE) {
printf("none present\n");
} else {
if (cpuinfo.tlb_type == MIPS_MMU_TLB) {
printf("Standard TLB");
} else if (cpuinfo.tlb_type == MIPS_MMU_BAT) {
printf("Standard BAT");
} else if (cpuinfo.tlb_type == MIPS_MMU_FIXED) {
printf("Fixed mapping");
}
printf(", %d entries\n", cpuinfo.tlb_nentries);
}
printf(" L1 i-cache: ");
if (cpuinfo.l1.ic_linesize == 0) {
printf("disabled");
} else {
if (cpuinfo.l1.ic_nways == 1) {
printf("direct-mapped with");
} else {
printf ("%d ways of", cpuinfo.l1.ic_nways);
}
printf(" %d sets, %d bytes per line\n",
cpuinfo.l1.ic_nsets, cpuinfo.l1.ic_linesize);
}
printf(" L1 d-cache: ");
if (cpuinfo.l1.dc_linesize == 0) {
printf("disabled");
} else {
if (cpuinfo.l1.dc_nways == 1) {
printf("direct-mapped with");
} else {
printf ("%d ways of", cpuinfo.l1.dc_nways);
}
printf(" %d sets, %d bytes per line\n",
cpuinfo.l1.dc_nsets, cpuinfo.l1.dc_linesize);
}
cfg0 = mips_rd_config();
/* If config register selection 1 does not exist, exit. */
if (!(cfg0 & MIPS3_CONFIG_CM))
return;
cfg1 = mips_rd_config1();
printf(" Config1=0x%b\n", cfg1,
"\20\7COP2\6MDMX\5PerfCount\4WatchRegs\3MIPS16\2EJTAG\1FPU");
/* If config register selection 2 does not exist, exit. */
if (!(cfg1 & MIPS3_CONFIG_CM))
return;
cfg2 = mips_rd_config2();
/*
* Config2 contains no useful information other then Config3
* existence flag
*/
/* If config register selection 3 does not exist, exit. */
if (!(cfg2 & MIPS3_CONFIG_CM))
return;
cfg3 = mips_rd_config3();
/* Print Config3 if it contains any useful info */
if (cfg3 & ~(0x80000000))
printf(" Config3=0x%b\n", cfg3, "\20\2SmartMIPS\1TraceLogic");
}
static struct rman cpu_hardirq_rman;
static devclass_t cpu_devclass;
/*
* Device methods
*/
static int cpu_probe(device_t);
static int cpu_attach(device_t);
static struct resource *cpu_alloc_resource(device_t, device_t, int, int *,
u_long, u_long, u_long, u_int);
static int cpu_setup_intr(device_t, device_t, struct resource *, int,
driver_filter_t *f, driver_intr_t *, void *,
void **);
static device_method_t cpu_methods[] = {
/* Device interface */
DEVMETHOD(device_probe, cpu_probe),
DEVMETHOD(device_attach, cpu_attach),
DEVMETHOD(device_detach, bus_generic_detach),
DEVMETHOD(device_shutdown, bus_generic_shutdown),
/* Bus interface */
DEVMETHOD(bus_alloc_resource, cpu_alloc_resource),
DEVMETHOD(bus_setup_intr, cpu_setup_intr),
DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr),
{ 0, 0 }
};
static driver_t cpu_driver = {
"cpu", cpu_methods, 1
};
static int
cpu_probe(device_t dev)
{
return (0);
}
static int
cpu_attach(device_t dev)
{
int error;
#ifdef notyet
device_t clock;
#endif
cpu_hardirq_rman.rm_start = 0;
cpu_hardirq_rman.rm_end = 5;
cpu_hardirq_rman.rm_type = RMAN_ARRAY;
cpu_hardirq_rman.rm_descr = "CPU Hard Interrupts";
error = rman_init(&cpu_hardirq_rman);
if (error != 0) {
device_printf(dev, "failed to initialize irq resources\n");
return (error);
}
/* XXX rman_manage_all. */
error = rman_manage_region(&cpu_hardirq_rman,
cpu_hardirq_rman.rm_start,
cpu_hardirq_rman.rm_end);
if (error != 0) {
device_printf(dev, "failed to manage irq resources\n");
return (error);
}
if (device_get_unit(dev) != 0)
panic("can't attach more cpus");
device_set_desc(dev, "MIPS32 processor");
#ifdef notyet
clock = device_add_child(dev, "clock", device_get_unit(dev));
if (clock == NULL)
device_printf(dev, "clock failed to attach");
#endif
return (bus_generic_attach(dev));
}
static struct resource *
cpu_alloc_resource(device_t dev, device_t child, int type, int *rid,
u_long start, u_long end, u_long count, u_int flags)
{
struct resource *res;
if (type != SYS_RES_IRQ)
return (NULL);
res = rman_reserve_resource(&cpu_hardirq_rman, start, end, count, 0,
child);
return (res);
}
static int
cpu_setup_intr(device_t dev, device_t child, struct resource *res, int flags,
driver_filter_t *filt, driver_intr_t *handler, void *arg,
void **cookiep)
{
int error;
int intr;
error = rman_activate_resource(res);
if (error != 0) {
device_printf(child, "could not activate irq\n");
return (error);
}
intr = rman_get_start(res);
cpu_establish_hardintr(device_get_nameunit(child), filt, handler, arg,
intr, flags, cookiep);
device_printf(child, "established CPU interrupt %d\n", intr);
return (0);
}
DRIVER_MODULE(cpu, root, cpu_driver, cpu_devclass, 0, 0);