Home | History | Annotate | Line # | Download | only in oea
cpu_subr.c revision 1.60
      1  1.60      matt /*	$NetBSD: cpu_subr.c,v 1.60 2011/01/18 01:02:55 matt Exp $	*/
      2   1.1      matt 
      3   1.1      matt /*-
      4   1.1      matt  * Copyright (c) 2001 Matt Thomas.
      5   1.1      matt  * Copyright (c) 2001 Tsubai Masanari.
      6   1.1      matt  * Copyright (c) 1998, 1999, 2001 Internet Research Institute, Inc.
      7   1.1      matt  * All rights reserved.
      8   1.1      matt  *
      9   1.1      matt  * Redistribution and use in source and binary forms, with or without
     10   1.1      matt  * modification, are permitted provided that the following conditions
     11   1.1      matt  * are met:
     12   1.1      matt  * 1. Redistributions of source code must retain the above copyright
     13   1.1      matt  *    notice, this list of conditions and the following disclaimer.
     14   1.1      matt  * 2. Redistributions in binary form must reproduce the above copyright
     15   1.1      matt  *    notice, this list of conditions and the following disclaimer in the
     16   1.1      matt  *    documentation and/or other materials provided with the distribution.
     17   1.1      matt  * 3. All advertising materials mentioning features or use of this software
     18   1.1      matt  *    must display the following acknowledgement:
     19   1.1      matt  *	This product includes software developed by
     20   1.1      matt  *	Internet Research Institute, Inc.
     21   1.1      matt  * 4. The name of the author may not be used to endorse or promote products
     22   1.1      matt  *    derived from this software without specific prior written permission.
     23   1.1      matt  *
     24   1.1      matt  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     25   1.1      matt  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     26   1.1      matt  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     27   1.1      matt  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     28   1.1      matt  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     29   1.1      matt  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     30   1.1      matt  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     31   1.1      matt  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     32   1.1      matt  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
     33   1.1      matt  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     34   1.1      matt  */
     35   1.9     lukem 
     36   1.9     lukem #include <sys/cdefs.h>
     37  1.60      matt __KERNEL_RCSID(0, "$NetBSD: cpu_subr.c,v 1.60 2011/01/18 01:02:55 matt Exp $");
     38   1.1      matt 
     39   1.1      matt #include "opt_ppcparam.h"
     40   1.1      matt #include "opt_multiprocessor.h"
     41   1.1      matt #include "opt_altivec.h"
     42   1.1      matt #include "sysmon_envsys.h"
     43   1.1      matt 
     44   1.1      matt #include <sys/param.h>
     45   1.1      matt #include <sys/systm.h>
     46   1.1      matt #include <sys/device.h>
     47  1.33   garbled #include <sys/types.h>
     48  1.33   garbled #include <sys/lwp.h>
     49  1.12      matt #include <sys/malloc.h>
     50  1.56       phx #include <sys/xcall.h>
     51   1.1      matt 
     52  1.59  uebayasi #include <uvm/uvm.h>
     53   1.1      matt 
     54  1.55      matt #include <powerpc/spr.h>
     55   1.1      matt #include <powerpc/oea/hid.h>
     56   1.1      matt #include <powerpc/oea/hid_601.h>
     57  1.55      matt #include <powerpc/oea/spr.h>
     58  1.42   garbled #include <powerpc/oea/cpufeat.h>
     59   1.1      matt 
     60   1.1      matt #include <dev/sysmon/sysmonvar.h>
     61   1.1      matt 
     62   1.7      matt static void cpu_enable_l2cr(register_t);
     63   1.7      matt static void cpu_enable_l3cr(register_t);
     64   1.1      matt static void cpu_config_l2cr(int);
     65   1.7      matt static void cpu_config_l3cr(int);
     66  1.23    briggs static void cpu_probe_speed(struct cpu_info *);
     67  1.20      matt static void cpu_idlespin(void);
     68  1.56       phx static void cpu_set_dfs_xcall(void *, void *);
     69   1.1      matt #if NSYSMON_ENVSYS > 0
     70   1.1      matt static void cpu_tau_setup(struct cpu_info *);
     71  1.34   xtraeme static void cpu_tau_refresh(struct sysmon_envsys *, envsys_data_t *);
     72   1.1      matt #endif
     73   1.1      matt 
     74   1.1      matt int cpu;
     75   1.1      matt int ncpus;
     76   1.1      matt 
     77   1.7      matt struct fmttab {
     78   1.7      matt 	register_t fmt_mask;
     79   1.7      matt 	register_t fmt_value;
     80   1.7      matt 	const char *fmt_string;
     81   1.7      matt };
     82   1.7      matt 
     83  1.50  macallan /*
     84  1.50  macallan  * This should be one per CPU but since we only support it on 750 variants it
     85  1.50  macallan  * doesn't realy matter since none of them supports SMP
     86  1.50  macallan  */
     87  1.50  macallan envsys_data_t sensor;
     88  1.50  macallan 
     89   1.7      matt static const struct fmttab cpu_7450_l2cr_formats[] = {
     90   1.7      matt 	{ L2CR_L2E, 0, " disabled" },
     91   1.7      matt 	{ L2CR_L2DO|L2CR_L2IO, L2CR_L2DO, " data-only" },
     92   1.7      matt 	{ L2CR_L2DO|L2CR_L2IO, L2CR_L2IO, " instruction-only" },
     93   1.7      matt 	{ L2CR_L2DO|L2CR_L2IO, L2CR_L2DO|L2CR_L2IO, " locked" },
     94   1.7      matt 	{ L2CR_L2E, ~0, " 256KB L2 cache" },
     95  1.36   garbled 	{ L2CR_L2PE, 0, " no parity" },
     96  1.36   garbled 	{ L2CR_L2PE, ~0, " parity enabled" },
     97  1.28   garbled 	{ 0, 0, NULL }
     98   1.7      matt };
     99   1.7      matt 
    100  1.22      matt static const struct fmttab cpu_7448_l2cr_formats[] = {
    101  1.22      matt 	{ L2CR_L2E, 0, " disabled" },
    102  1.22      matt 	{ L2CR_L2DO|L2CR_L2IO, L2CR_L2DO, " data-only" },
    103  1.22      matt 	{ L2CR_L2DO|L2CR_L2IO, L2CR_L2IO, " instruction-only" },
    104  1.22      matt 	{ L2CR_L2DO|L2CR_L2IO, L2CR_L2DO|L2CR_L2IO, " locked" },
    105  1.22      matt 	{ L2CR_L2E, ~0, " 1MB L2 cache" },
    106  1.36   garbled 	{ L2CR_L2PE, 0, " no parity" },
    107  1.36   garbled 	{ L2CR_L2PE, ~0, " parity enabled" },
    108  1.28   garbled 	{ 0, 0, NULL }
    109  1.22      matt };
    110  1.22      matt 
    111  1.11      matt static const struct fmttab cpu_7457_l2cr_formats[] = {
    112  1.11      matt 	{ L2CR_L2E, 0, " disabled" },
    113  1.11      matt 	{ L2CR_L2DO|L2CR_L2IO, L2CR_L2DO, " data-only" },
    114  1.11      matt 	{ L2CR_L2DO|L2CR_L2IO, L2CR_L2IO, " instruction-only" },
    115  1.11      matt 	{ L2CR_L2DO|L2CR_L2IO, L2CR_L2DO|L2CR_L2IO, " locked" },
    116  1.11      matt 	{ L2CR_L2E, ~0, " 512KB L2 cache" },
    117  1.36   garbled 	{ L2CR_L2PE, 0, " no parity" },
    118  1.36   garbled 	{ L2CR_L2PE, ~0, " parity enabled" },
    119  1.28   garbled 	{ 0, 0, NULL }
    120  1.11      matt };
    121  1.11      matt 
    122   1.7      matt static const struct fmttab cpu_7450_l3cr_formats[] = {
    123   1.7      matt 	{ L3CR_L3DO|L3CR_L3IO, L3CR_L3DO, " data-only" },
    124   1.7      matt 	{ L3CR_L3DO|L3CR_L3IO, L3CR_L3IO, " instruction-only" },
    125   1.7      matt 	{ L3CR_L3DO|L3CR_L3IO, L3CR_L3DO|L3CR_L3IO, " locked" },
    126   1.7      matt 	{ L3CR_L3SIZ, L3SIZ_2M, " 2MB" },
    127   1.7      matt 	{ L3CR_L3SIZ, L3SIZ_1M, " 1MB" },
    128   1.7      matt 	{ L3CR_L3PE|L3CR_L3APE, L3CR_L3PE|L3CR_L3APE, " parity" },
    129   1.7      matt 	{ L3CR_L3PE|L3CR_L3APE, L3CR_L3PE, " data-parity" },
    130   1.7      matt 	{ L3CR_L3PE|L3CR_L3APE, L3CR_L3APE, " address-parity" },
    131   1.7      matt 	{ L3CR_L3PE|L3CR_L3APE, 0, " no-parity" },
    132   1.7      matt 	{ L3CR_L3SIZ, ~0, " L3 cache" },
    133   1.7      matt 	{ L3CR_L3RT, L3RT_MSUG2_DDR, " (DDR SRAM)" },
    134   1.7      matt 	{ L3CR_L3RT, L3RT_PIPELINE_LATE, " (LW SRAM)" },
    135   1.7      matt 	{ L3CR_L3RT, L3RT_PB2_SRAM, " (PB2 SRAM)" },
    136   1.7      matt 	{ L3CR_L3CLK, ~0, " at" },
    137   1.7      matt 	{ L3CR_L3CLK, L3CLK_20, " 2:1" },
    138   1.7      matt 	{ L3CR_L3CLK, L3CLK_25, " 2.5:1" },
    139   1.7      matt 	{ L3CR_L3CLK, L3CLK_30, " 3:1" },
    140   1.7      matt 	{ L3CR_L3CLK, L3CLK_35, " 3.5:1" },
    141   1.7      matt 	{ L3CR_L3CLK, L3CLK_40, " 4:1" },
    142   1.7      matt 	{ L3CR_L3CLK, L3CLK_50, " 5:1" },
    143   1.7      matt 	{ L3CR_L3CLK, L3CLK_60, " 6:1" },
    144   1.7      matt 	{ L3CR_L3CLK, ~0, " ratio" },
    145  1.28   garbled 	{ 0, 0, NULL },
    146   1.7      matt };
    147   1.7      matt 
    148   1.7      matt static const struct fmttab cpu_ibm750_l2cr_formats[] = {
    149   1.7      matt 	{ L2CR_L2E, 0, " disabled" },
    150   1.7      matt 	{ L2CR_L2DO|L2CR_L2IO, L2CR_L2DO, " data-only" },
    151   1.7      matt 	{ L2CR_L2DO|L2CR_L2IO, L2CR_L2IO, " instruction-only" },
    152   1.7      matt 	{ L2CR_L2DO|L2CR_L2IO, L2CR_L2DO|L2CR_L2IO, " locked" },
    153   1.7      matt 	{ 0, ~0, " 512KB" },
    154   1.7      matt 	{ L2CR_L2WT, L2CR_L2WT, " WT" },
    155   1.7      matt 	{ L2CR_L2WT, 0, " WB" },
    156   1.7      matt 	{ L2CR_L2PE, L2CR_L2PE, " with ECC" },
    157   1.7      matt 	{ 0, ~0, " L2 cache" },
    158  1.28   garbled 	{ 0, 0, NULL }
    159   1.7      matt };
    160   1.7      matt 
    161   1.7      matt static const struct fmttab cpu_l2cr_formats[] = {
    162   1.7      matt 	{ L2CR_L2E, 0, " disabled" },
    163   1.7      matt 	{ L2CR_L2DO|L2CR_L2IO, L2CR_L2DO, " data-only" },
    164   1.7      matt 	{ L2CR_L2DO|L2CR_L2IO, L2CR_L2IO, " instruction-only" },
    165   1.7      matt 	{ L2CR_L2DO|L2CR_L2IO, L2CR_L2DO|L2CR_L2IO, " locked" },
    166   1.7      matt 	{ L2CR_L2PE, L2CR_L2PE, " parity" },
    167   1.7      matt 	{ L2CR_L2PE, 0, " no-parity" },
    168   1.7      matt 	{ L2CR_L2SIZ, L2SIZ_2M, " 2MB" },
    169   1.7      matt 	{ L2CR_L2SIZ, L2SIZ_1M, " 1MB" },
    170   1.7      matt 	{ L2CR_L2SIZ, L2SIZ_512K, " 512KB" },
    171   1.7      matt 	{ L2CR_L2SIZ, L2SIZ_256K, " 256KB" },
    172   1.7      matt 	{ L2CR_L2WT, L2CR_L2WT, " WT" },
    173   1.7      matt 	{ L2CR_L2WT, 0, " WB" },
    174   1.7      matt 	{ L2CR_L2E, ~0, " L2 cache" },
    175   1.7      matt 	{ L2CR_L2RAM, L2RAM_FLOWTHRU_BURST, " (FB SRAM)" },
    176   1.7      matt 	{ L2CR_L2RAM, L2RAM_PIPELINE_LATE, " (LW SRAM)" },
    177   1.7      matt 	{ L2CR_L2RAM, L2RAM_PIPELINE_BURST, " (PB SRAM)" },
    178   1.7      matt 	{ L2CR_L2CLK, ~0, " at" },
    179   1.7      matt 	{ L2CR_L2CLK, L2CLK_10, " 1:1" },
    180   1.7      matt 	{ L2CR_L2CLK, L2CLK_15, " 1.5:1" },
    181   1.7      matt 	{ L2CR_L2CLK, L2CLK_20, " 2:1" },
    182   1.7      matt 	{ L2CR_L2CLK, L2CLK_25, " 2.5:1" },
    183   1.7      matt 	{ L2CR_L2CLK, L2CLK_30, " 3:1" },
    184   1.7      matt 	{ L2CR_L2CLK, L2CLK_35, " 3.5:1" },
    185   1.7      matt 	{ L2CR_L2CLK, L2CLK_40, " 4:1" },
    186   1.7      matt 	{ L2CR_L2CLK, ~0, " ratio" },
    187  1.28   garbled 	{ 0, 0, NULL }
    188   1.7      matt };
    189   1.7      matt 
    190   1.7      matt static void cpu_fmttab_print(const struct fmttab *, register_t);
    191   1.7      matt 
    192   1.7      matt struct cputab {
    193   1.7      matt 	const char name[8];
    194   1.7      matt 	uint16_t version;
    195   1.7      matt 	uint16_t revfmt;
    196   1.7      matt };
    197   1.7      matt #define	REVFMT_MAJMIN	1		/* %u.%u */
    198   1.7      matt #define	REVFMT_HEX	2		/* 0x%04x */
    199   1.7      matt #define	REVFMT_DEC	3		/* %u */
    200   1.7      matt static const struct cputab models[] = {
    201   1.7      matt 	{ "601",	MPC601,		REVFMT_DEC },
    202   1.7      matt 	{ "602",	MPC602,		REVFMT_DEC },
    203   1.7      matt 	{ "603",	MPC603,		REVFMT_MAJMIN },
    204   1.7      matt 	{ "603e",	MPC603e,	REVFMT_MAJMIN },
    205   1.7      matt 	{ "603ev",	MPC603ev,	REVFMT_MAJMIN },
    206  1.31   aymeric 	{ "G2",		MPCG2,		REVFMT_MAJMIN },
    207   1.7      matt 	{ "604",	MPC604,		REVFMT_MAJMIN },
    208  1.15    briggs 	{ "604e",	MPC604e,	REVFMT_MAJMIN },
    209   1.7      matt 	{ "604ev",	MPC604ev,	REVFMT_MAJMIN },
    210   1.7      matt 	{ "620",	MPC620,  	REVFMT_HEX },
    211   1.7      matt 	{ "750",	MPC750,		REVFMT_MAJMIN },
    212   1.7      matt 	{ "750FX",	IBM750FX,	REVFMT_MAJMIN },
    213   1.7      matt 	{ "7400",	MPC7400,	REVFMT_MAJMIN },
    214   1.7      matt 	{ "7410",	MPC7410,	REVFMT_MAJMIN },
    215   1.7      matt 	{ "7450",	MPC7450,	REVFMT_MAJMIN },
    216   1.7      matt 	{ "7455",	MPC7455,	REVFMT_MAJMIN },
    217  1.11      matt 	{ "7457",	MPC7457,	REVFMT_MAJMIN },
    218  1.21      matt 	{ "7447A",	MPC7447A,	REVFMT_MAJMIN },
    219  1.22      matt 	{ "7448",	MPC7448,	REVFMT_MAJMIN },
    220   1.7      matt 	{ "8240",	MPC8240,	REVFMT_MAJMIN },
    221  1.30  nisimura 	{ "8245",	MPC8245,	REVFMT_MAJMIN },
    222  1.27   sanjayl 	{ "970",	IBM970,		REVFMT_MAJMIN },
    223  1.27   sanjayl 	{ "970FX",	IBM970FX,	REVFMT_MAJMIN },
    224  1.47       chs 	{ "970MP",	IBM970MP,	REVFMT_MAJMIN },
    225  1.41   garbled 	{ "POWER3II",   IBMPOWER3II,    REVFMT_MAJMIN },
    226   1.7      matt 	{ "",		0,		REVFMT_HEX }
    227   1.7      matt };
    228   1.7      matt 
    229   1.1      matt #ifdef MULTIPROCESSOR
    230  1.60      matt struct cpu_info cpu_info[CPU_MAXNUM] = {
    231  1.60      matt     [0] = {
    232  1.60      matt 	.ci_curlwp = &lwp0,
    233  1.60      matt 	.ci_fpulwp = &lwp0,
    234  1.60      matt 	.ci_veclwp = &lwp0,
    235  1.60      matt     },
    236  1.60      matt };
    237  1.33   garbled volatile struct cpu_hatch_data *cpu_hatch_data;
    238  1.33   garbled volatile int cpu_hatch_stack;
    239  1.33   garbled extern int ticks_per_intr;
    240  1.33   garbled #include <powerpc/oea/bat.h>
    241  1.33   garbled #include <arch/powerpc/pic/picvar.h>
    242  1.33   garbled #include <arch/powerpc/pic/ipivar.h>
    243  1.33   garbled extern struct bat battable[];
    244   1.1      matt #else
    245  1.60      matt struct cpu_info cpu_info[1] = {
    246  1.60      matt     [0] = {
    247  1.60      matt 	.ci_curlwp = &lwp0,
    248  1.60      matt 	.ci_fpulwp = &lwp0,
    249  1.60      matt 	.ci_veclwp = &lwp0,
    250  1.60      matt     },
    251  1.60      matt };
    252  1.33   garbled #endif /*MULTIPROCESSOR*/
    253   1.1      matt 
    254   1.1      matt int cpu_altivec;
    255  1.14    kleink int cpu_psluserset, cpu_pslusermod;
    256   1.1      matt char cpu_model[80];
    257   1.1      matt 
    258  1.42   garbled /* This is to be called from locore.S, and nowhere else. */
    259  1.42   garbled 
    260  1.42   garbled void
    261  1.42   garbled cpu_model_init(void)
    262  1.42   garbled {
    263  1.42   garbled 	u_int pvr, vers;
    264  1.42   garbled 
    265  1.42   garbled 	pvr = mfpvr();
    266  1.42   garbled 	vers = pvr >> 16;
    267  1.42   garbled 
    268  1.42   garbled 	oeacpufeat = 0;
    269  1.42   garbled 
    270  1.42   garbled 	if ((vers >= IBMRS64II && vers <= IBM970GX) || vers == MPC620 ||
    271  1.42   garbled 		vers == IBMCELL || vers == IBMPOWER6P5)
    272  1.42   garbled 		oeacpufeat |= OEACPU_64 | OEACPU_64_BRIDGE | OEACPU_NOBAT;
    273  1.42   garbled 
    274  1.45      matt 	else if (vers == MPC601)
    275  1.42   garbled 		oeacpufeat |= OEACPU_601;
    276  1.45      matt 
    277  1.45      matt 	else if (MPC745X_P(vers) && vers != MPC7450)
    278  1.45      matt 		oeacpufeat |= OEACPU_XBSEN | OEACPU_HIGHBAT | OEACPU_HIGHSPRG;
    279  1.42   garbled }
    280  1.42   garbled 
    281   1.1      matt void
    282   1.7      matt cpu_fmttab_print(const struct fmttab *fmt, register_t data)
    283   1.7      matt {
    284   1.7      matt 	for (; fmt->fmt_mask != 0 || fmt->fmt_value != 0; fmt++) {
    285   1.7      matt 		if ((~fmt->fmt_mask & fmt->fmt_value) != 0 ||
    286   1.7      matt 		    (data & fmt->fmt_mask) == fmt->fmt_value)
    287   1.7      matt 			aprint_normal("%s", fmt->fmt_string);
    288   1.7      matt 	}
    289   1.7      matt }
    290   1.7      matt 
    291   1.7      matt void
    292  1.20      matt cpu_idlespin(void)
    293  1.20      matt {
    294  1.20      matt 	register_t msr;
    295  1.20      matt 
    296  1.20      matt 	if (powersave <= 0)
    297  1.20      matt 		return;
    298  1.20      matt 
    299  1.26     perry 	__asm volatile(
    300  1.20      matt 		"sync;"
    301  1.20      matt 		"mfmsr	%0;"
    302  1.20      matt 		"oris	%0,%0,%1@h;"	/* enter power saving mode */
    303  1.20      matt 		"mtmsr	%0;"
    304  1.20      matt 		"isync;"
    305  1.20      matt 	    :	"=r"(msr)
    306  1.20      matt 	    :	"J"(PSL_POW));
    307  1.20      matt }
    308  1.20      matt 
    309  1.20      matt void
    310   1.1      matt cpu_probe_cache(void)
    311   1.1      matt {
    312   1.1      matt 	u_int assoc, pvr, vers;
    313   1.1      matt 
    314   1.1      matt 	pvr = mfpvr();
    315   1.1      matt 	vers = pvr >> 16;
    316   1.1      matt 
    317  1.27   sanjayl 
    318  1.27   sanjayl 	/* Presently common across almost all implementations. */
    319  1.43   garbled 	curcpu()->ci_ci.dcache_line_size = 32;
    320  1.43   garbled 	curcpu()->ci_ci.icache_line_size = 32;
    321  1.27   sanjayl 
    322  1.27   sanjayl 
    323   1.1      matt 	switch (vers) {
    324   1.1      matt #define	K	*1024
    325   1.1      matt 	case IBM750FX:
    326   1.1      matt 	case MPC601:
    327   1.1      matt 	case MPC750:
    328  1.48  macallan 	case MPC7400:
    329  1.22      matt 	case MPC7447A:
    330  1.22      matt 	case MPC7448:
    331   1.1      matt 	case MPC7450:
    332   1.1      matt 	case MPC7455:
    333  1.11      matt 	case MPC7457:
    334   1.1      matt 		curcpu()->ci_ci.dcache_size = 32 K;
    335   1.1      matt 		curcpu()->ci_ci.icache_size = 32 K;
    336   1.1      matt 		assoc = 8;
    337   1.1      matt 		break;
    338   1.1      matt 	case MPC603:
    339   1.1      matt 		curcpu()->ci_ci.dcache_size = 8 K;
    340   1.1      matt 		curcpu()->ci_ci.icache_size = 8 K;
    341   1.1      matt 		assoc = 2;
    342   1.1      matt 		break;
    343   1.1      matt 	case MPC603e:
    344   1.1      matt 	case MPC603ev:
    345   1.1      matt 	case MPC604:
    346   1.1      matt 	case MPC8240:
    347   1.1      matt 	case MPC8245:
    348  1.31   aymeric 	case MPCG2:
    349   1.1      matt 		curcpu()->ci_ci.dcache_size = 16 K;
    350   1.1      matt 		curcpu()->ci_ci.icache_size = 16 K;
    351   1.1      matt 		assoc = 4;
    352   1.1      matt 		break;
    353  1.15    briggs 	case MPC604e:
    354   1.1      matt 	case MPC604ev:
    355   1.1      matt 		curcpu()->ci_ci.dcache_size = 32 K;
    356   1.1      matt 		curcpu()->ci_ci.icache_size = 32 K;
    357   1.1      matt 		assoc = 4;
    358   1.1      matt 		break;
    359  1.41   garbled 	case IBMPOWER3II:
    360  1.41   garbled 		curcpu()->ci_ci.dcache_size = 64 K;
    361  1.41   garbled 		curcpu()->ci_ci.icache_size = 32 K;
    362  1.41   garbled 		curcpu()->ci_ci.dcache_line_size = 128;
    363  1.41   garbled 		curcpu()->ci_ci.icache_line_size = 128;
    364  1.41   garbled 		assoc = 128; /* not a typo */
    365  1.41   garbled 		break;
    366  1.27   sanjayl 	case IBM970:
    367  1.27   sanjayl 	case IBM970FX:
    368  1.47       chs 	case IBM970MP:
    369  1.27   sanjayl 		curcpu()->ci_ci.dcache_size = 32 K;
    370  1.27   sanjayl 		curcpu()->ci_ci.icache_size = 64 K;
    371  1.27   sanjayl 		curcpu()->ci_ci.dcache_line_size = 128;
    372  1.27   sanjayl 		curcpu()->ci_ci.icache_line_size = 128;
    373  1.27   sanjayl 		assoc = 2;
    374  1.27   sanjayl 		break;
    375  1.27   sanjayl 
    376   1.1      matt 	default:
    377   1.6   thorpej 		curcpu()->ci_ci.dcache_size = PAGE_SIZE;
    378   1.6   thorpej 		curcpu()->ci_ci.icache_size = PAGE_SIZE;
    379   1.1      matt 		assoc = 1;
    380   1.1      matt #undef	K
    381   1.1      matt 	}
    382   1.1      matt 
    383   1.1      matt 	/*
    384   1.1      matt 	 * Possibly recolor.
    385   1.1      matt 	 */
    386   1.1      matt 	uvm_page_recolor(atop(curcpu()->ci_ci.dcache_size / assoc));
    387   1.1      matt }
    388   1.1      matt 
    389   1.1      matt struct cpu_info *
    390  1.60      matt cpu_attach_common(device_t self, int id)
    391   1.1      matt {
    392   1.1      matt 	struct cpu_info *ci;
    393   1.1      matt 	u_int pvr, vers;
    394   1.1      matt 
    395   1.1      matt 	ci = &cpu_info[id];
    396   1.1      matt #ifndef MULTIPROCESSOR
    397   1.1      matt 	/*
    398   1.1      matt 	 * If this isn't the primary CPU, print an error message
    399   1.1      matt 	 * and just bail out.
    400   1.1      matt 	 */
    401   1.1      matt 	if (id != 0) {
    402   1.3      matt 		aprint_normal(": ID %d\n", id);
    403   1.3      matt 		aprint_normal("%s: processor off-line; multiprocessor support "
    404   1.1      matt 		    "not present in kernel\n", self->dv_xname);
    405   1.1      matt 		return (NULL);
    406   1.1      matt 	}
    407   1.1      matt #endif
    408   1.1      matt 
    409   1.1      matt 	ci->ci_cpuid = id;
    410  1.60      matt 	ci->ci_idepth = -1;
    411   1.1      matt 	ci->ci_dev = self;
    412  1.20      matt 	ci->ci_idlespin = cpu_idlespin;
    413   1.1      matt 
    414   1.1      matt 	pvr = mfpvr();
    415   1.1      matt 	vers = (pvr >> 16) & 0xffff;
    416   1.1      matt 
    417   1.1      matt 	switch (id) {
    418   1.1      matt 	case 0:
    419   1.1      matt 		/* load my cpu_number to PIR */
    420   1.1      matt 		switch (vers) {
    421   1.1      matt 		case MPC601:
    422   1.1      matt 		case MPC604:
    423  1.15    briggs 		case MPC604e:
    424   1.1      matt 		case MPC604ev:
    425   1.1      matt 		case MPC7400:
    426   1.1      matt 		case MPC7410:
    427  1.22      matt 		case MPC7447A:
    428  1.22      matt 		case MPC7448:
    429   1.1      matt 		case MPC7450:
    430   1.1      matt 		case MPC7455:
    431  1.11      matt 		case MPC7457:
    432   1.1      matt 			mtspr(SPR_PIR, id);
    433   1.1      matt 		}
    434   1.1      matt 		cpu_setup(self, ci);
    435   1.1      matt 		break;
    436   1.1      matt 	default:
    437   1.1      matt 		if (id >= CPU_MAXNUM) {
    438   1.3      matt 			aprint_normal(": more than %d cpus?\n", CPU_MAXNUM);
    439   1.1      matt 			panic("cpuattach");
    440   1.1      matt 		}
    441   1.1      matt #ifndef MULTIPROCESSOR
    442   1.3      matt 		aprint_normal(" not configured\n");
    443   1.1      matt 		return NULL;
    444  1.29      yamt #else
    445  1.29      yamt 		mi_cpu_attach(ci);
    446  1.29      yamt 		break;
    447   1.1      matt #endif
    448   1.1      matt 	}
    449   1.1      matt 	return (ci);
    450   1.1      matt }
    451   1.1      matt 
    452   1.1      matt void
    453  1.60      matt cpu_setup(device_t self, struct cpu_info *ci)
    454   1.1      matt {
    455  1.41   garbled 	u_int hid0, hid0_save, pvr, vers;
    456  1.24        he 	const char *bitmask;
    457  1.24        he 	char hidbuf[128];
    458   1.1      matt 	char model[80];
    459   1.1      matt 
    460   1.1      matt 	pvr = mfpvr();
    461   1.1      matt 	vers = (pvr >> 16) & 0xffff;
    462   1.1      matt 
    463   1.1      matt 	cpu_identify(model, sizeof(model));
    464   1.3      matt 	aprint_normal(": %s, ID %d%s\n", model,  cpu_number(),
    465   1.1      matt 	    cpu_number() == 0 ? " (primary)" : "");
    466   1.1      matt 
    467  1.46   garbled 	/* set the cpu number */
    468  1.46   garbled 	ci->ci_cpuid = cpu_number();
    469  1.41   garbled 	hid0_save = hid0 = mfspr(SPR_HID0);
    470  1.27   sanjayl 
    471   1.1      matt 	cpu_probe_cache();
    472   1.1      matt 
    473   1.1      matt 	/*
    474   1.1      matt 	 * Configure power-saving mode.
    475   1.1      matt 	 */
    476   1.1      matt 	switch (vers) {
    477  1.18    briggs 	case MPC604:
    478  1.18    briggs 	case MPC604e:
    479  1.18    briggs 	case MPC604ev:
    480  1.18    briggs 		/*
    481  1.18    briggs 		 * Do not have HID0 support settings, but can support
    482  1.18    briggs 		 * MSR[POW] off
    483  1.18    briggs 		 */
    484  1.18    briggs 		powersave = 1;
    485  1.18    briggs 		break;
    486  1.18    briggs 
    487   1.1      matt 	case MPC603:
    488   1.1      matt 	case MPC603e:
    489   1.1      matt 	case MPC603ev:
    490   1.1      matt 	case MPC7400:
    491   1.1      matt 	case MPC7410:
    492   1.1      matt 	case MPC8240:
    493   1.1      matt 	case MPC8245:
    494  1.31   aymeric 	case MPCG2:
    495   1.1      matt 		/* Select DOZE mode. */
    496   1.1      matt 		hid0 &= ~(HID0_DOZE | HID0_NAP | HID0_SLEEP);
    497   1.1      matt 		hid0 |= HID0_DOZE | HID0_DPM;
    498   1.1      matt 		powersave = 1;
    499   1.1      matt 		break;
    500   1.1      matt 
    501  1.57  macallan 	case MPC750:
    502  1.57  macallan 	case IBM750FX:
    503  1.57  macallan 		/* Select NAP mode. */
    504  1.57  macallan 		hid0 &= ~(HID0_DOZE | HID0_NAP | HID0_SLEEP);
    505  1.57  macallan 		hid0 |= HID0_NAP | HID0_DPM;
    506  1.57  macallan 		powersave = 1;
    507  1.57  macallan 		break;
    508  1.57  macallan 
    509  1.22      matt 	case MPC7447A:
    510  1.22      matt 	case MPC7448:
    511  1.11      matt 	case MPC7457:
    512   1.1      matt 	case MPC7455:
    513   1.1      matt 	case MPC7450:
    514   1.5      matt 		/* Enable the 7450 branch caches */
    515   1.5      matt 		hid0 |= HID0_SGE | HID0_BTIC;
    516   1.5      matt 		hid0 |= HID0_LRSTK | HID0_FOLD | HID0_BHT;
    517  1.45      matt 		/* Enable more and larger BAT registers */
    518  1.45      matt 		if (oeacpufeat & OEACPU_XBSEN)
    519  1.45      matt 			hid0 |= HID0_XBSEN;
    520  1.45      matt 		if (oeacpufeat & OEACPU_HIGHBAT)
    521  1.45      matt 			hid0 |= HID0_HIGH_BAT_EN;
    522   1.1      matt 		/* Disable BTIC on 7450 Rev 2.0 or earlier */
    523   1.5      matt 		if (vers == MPC7450 && (pvr & 0xFFFF) <= 0x0200)
    524   1.1      matt 			hid0 &= ~HID0_BTIC;
    525   1.1      matt 		/* Select NAP mode. */
    526  1.45      matt 		hid0 &= ~HID0_SLEEP;
    527  1.45      matt 		hid0 |= HID0_NAP | HID0_DPM;
    528  1.19       chs 		powersave = 1;
    529   1.1      matt 		break;
    530   1.1      matt 
    531  1.27   sanjayl 	case IBM970:
    532  1.27   sanjayl 	case IBM970FX:
    533  1.47       chs 	case IBM970MP:
    534  1.41   garbled 	case IBMPOWER3II:
    535   1.1      matt 	default:
    536   1.1      matt 		/* No power-saving mode is available. */ ;
    537   1.1      matt 	}
    538   1.1      matt 
    539   1.1      matt #ifdef NAPMODE
    540   1.1      matt 	switch (vers) {
    541   1.1      matt 	case IBM750FX:
    542   1.1      matt 	case MPC750:
    543   1.1      matt 	case MPC7400:
    544   1.1      matt 		/* Select NAP mode. */
    545   1.1      matt 		hid0 &= ~(HID0_DOZE | HID0_NAP | HID0_SLEEP);
    546   1.1      matt 		hid0 |= HID0_NAP;
    547   1.1      matt 		break;
    548   1.1      matt 	}
    549   1.1      matt #endif
    550   1.1      matt 
    551   1.1      matt 	switch (vers) {
    552   1.1      matt 	case IBM750FX:
    553   1.1      matt 	case MPC750:
    554   1.1      matt 		hid0 &= ~HID0_DBP;		/* XXX correct? */
    555   1.1      matt 		hid0 |= HID0_EMCP | HID0_BTIC | HID0_SGE | HID0_BHT;
    556   1.1      matt 		break;
    557   1.1      matt 
    558   1.1      matt 	case MPC7400:
    559   1.1      matt 	case MPC7410:
    560   1.1      matt 		hid0 &= ~HID0_SPD;
    561   1.1      matt 		hid0 |= HID0_EMCP | HID0_BTIC | HID0_SGE | HID0_BHT;
    562   1.1      matt 		hid0 |= HID0_EIEC;
    563   1.1      matt 		break;
    564   1.1      matt 	}
    565   1.1      matt 
    566  1.41   garbled 	if (hid0 != hid0_save) {
    567  1.41   garbled 		mtspr(SPR_HID0, hid0);
    568  1.41   garbled 		__asm volatile("sync;isync");
    569  1.41   garbled 	}
    570  1.41   garbled 
    571   1.1      matt 
    572   1.1      matt 	switch (vers) {
    573   1.1      matt 	case MPC601:
    574   1.1      matt 		bitmask = HID0_601_BITMASK;
    575   1.1      matt 		break;
    576   1.1      matt 	case MPC7450:
    577   1.1      matt 	case MPC7455:
    578  1.11      matt 	case MPC7457:
    579   1.1      matt 		bitmask = HID0_7450_BITMASK;
    580   1.1      matt 		break;
    581  1.27   sanjayl 	case IBM970:
    582  1.27   sanjayl 	case IBM970FX:
    583  1.47       chs 	case IBM970MP:
    584  1.27   sanjayl 		bitmask = 0;
    585  1.27   sanjayl 		break;
    586   1.1      matt 	default:
    587   1.1      matt 		bitmask = HID0_BITMASK;
    588   1.1      matt 		break;
    589   1.1      matt 	}
    590  1.51  christos 	snprintb(hidbuf, sizeof hidbuf, bitmask, hid0);
    591  1.41   garbled 	aprint_normal("%s: HID0 %s, powersave: %d\n", self->dv_xname, hidbuf,
    592  1.41   garbled 	    powersave);
    593   1.1      matt 
    594  1.23    briggs 	ci->ci_khz = 0;
    595  1.23    briggs 
    596   1.1      matt 	/*
    597   1.1      matt 	 * Display speed and cache configuration.
    598   1.1      matt 	 */
    599  1.15    briggs 	switch (vers) {
    600  1.15    briggs 	case MPC604:
    601  1.15    briggs 	case MPC604e:
    602  1.15    briggs 	case MPC604ev:
    603  1.15    briggs 	case MPC750:
    604  1.15    briggs 	case IBM750FX:
    605  1.16    briggs 	case MPC7400:
    606  1.15    briggs 	case MPC7410:
    607  1.22      matt 	case MPC7447A:
    608  1.22      matt 	case MPC7448:
    609  1.16    briggs 	case MPC7450:
    610  1.16    briggs 	case MPC7455:
    611  1.16    briggs 	case MPC7457:
    612   1.7      matt 		aprint_normal("%s: ", self->dv_xname);
    613  1.23    briggs 		cpu_probe_speed(ci);
    614  1.23    briggs 		aprint_normal("%u.%02u MHz",
    615  1.23    briggs 			      ci->ci_khz / 1000, (ci->ci_khz / 10) % 100);
    616  1.36   garbled 		switch (vers) {
    617  1.37  macallan 		case MPC7450: /* 7441 does not have L3! */
    618  1.37  macallan 		case MPC7455: /* 7445 does not have L3! */
    619  1.37  macallan 		case MPC7457: /* 7447 does not have L3! */
    620  1.37  macallan 			cpu_config_l3cr(vers);
    621  1.38  macallan 			break;
    622  1.36   garbled 		case IBM750FX:
    623  1.36   garbled 		case MPC750:
    624  1.36   garbled 		case MPC7400:
    625  1.36   garbled 		case MPC7410:
    626  1.36   garbled 		case MPC7447A:
    627  1.36   garbled 		case MPC7448:
    628  1.36   garbled 			cpu_config_l2cr(pvr);
    629  1.36   garbled 			break;
    630  1.36   garbled 		default:
    631  1.36   garbled 			break;
    632   1.7      matt 		}
    633   1.7      matt 		aprint_normal("\n");
    634  1.15    briggs 		break;
    635   1.1      matt 	}
    636   1.1      matt 
    637   1.1      matt #if NSYSMON_ENVSYS > 0
    638   1.1      matt 	/*
    639   1.1      matt 	 * Attach MPC750 temperature sensor to the envsys subsystem.
    640   1.1      matt 	 * XXX the 74xx series also has this sensor, but it is not
    641   1.1      matt 	 * XXX supported by Motorola and may return values that are off by
    642   1.1      matt 	 * XXX 35-55 degrees C.
    643   1.1      matt 	 */
    644   1.1      matt 	if (vers == MPC750 || vers == IBM750FX)
    645   1.1      matt 		cpu_tau_setup(ci);
    646   1.1      matt #endif
    647   1.1      matt 
    648   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_clock, EVCNT_TYPE_INTR,
    649   1.1      matt 		NULL, self->dv_xname, "clock");
    650   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_softclock, EVCNT_TYPE_INTR,
    651   1.1      matt 		NULL, self->dv_xname, "soft clock");
    652   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_softnet, EVCNT_TYPE_INTR,
    653   1.1      matt 		NULL, self->dv_xname, "soft net");
    654   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_softserial, EVCNT_TYPE_INTR,
    655   1.1      matt 		NULL, self->dv_xname, "soft serial");
    656   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_traps, EVCNT_TYPE_TRAP,
    657   1.1      matt 		NULL, self->dv_xname, "traps");
    658   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_kdsi, EVCNT_TYPE_TRAP,
    659   1.1      matt 		&ci->ci_ev_traps, self->dv_xname, "kernel DSI traps");
    660   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_udsi, EVCNT_TYPE_TRAP,
    661   1.1      matt 		&ci->ci_ev_traps, self->dv_xname, "user DSI traps");
    662   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_udsi_fatal, EVCNT_TYPE_TRAP,
    663   1.1      matt 		&ci->ci_ev_udsi, self->dv_xname, "user DSI failures");
    664  1.10      matt 	evcnt_attach_dynamic(&ci->ci_ev_kisi, EVCNT_TYPE_TRAP,
    665  1.10      matt 		&ci->ci_ev_traps, self->dv_xname, "kernel ISI traps");
    666   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_isi, EVCNT_TYPE_TRAP,
    667   1.1      matt 		&ci->ci_ev_traps, self->dv_xname, "user ISI traps");
    668   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_isi_fatal, EVCNT_TYPE_TRAP,
    669   1.1      matt 		&ci->ci_ev_isi, self->dv_xname, "user ISI failures");
    670   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_scalls, EVCNT_TYPE_TRAP,
    671   1.1      matt 		&ci->ci_ev_traps, self->dv_xname, "system call traps");
    672   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_pgm, EVCNT_TYPE_TRAP,
    673   1.1      matt 		&ci->ci_ev_traps, self->dv_xname, "PGM traps");
    674   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_fpu, EVCNT_TYPE_TRAP,
    675   1.1      matt 		&ci->ci_ev_traps, self->dv_xname, "FPU unavailable traps");
    676   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_fpusw, EVCNT_TYPE_TRAP,
    677   1.1      matt 		&ci->ci_ev_fpu, self->dv_xname, "FPU context switches");
    678   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_ali, EVCNT_TYPE_TRAP,
    679   1.1      matt 		&ci->ci_ev_traps, self->dv_xname, "user alignment traps");
    680   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_ali_fatal, EVCNT_TYPE_TRAP,
    681   1.1      matt 		&ci->ci_ev_ali, self->dv_xname, "user alignment traps");
    682   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_umchk, EVCNT_TYPE_TRAP,
    683   1.1      matt 		&ci->ci_ev_umchk, self->dv_xname, "user MCHK failures");
    684   1.1      matt 	evcnt_attach_dynamic(&ci->ci_ev_vec, EVCNT_TYPE_TRAP,
    685   1.1      matt 		&ci->ci_ev_traps, self->dv_xname, "AltiVec unavailable");
    686   1.1      matt #ifdef ALTIVEC
    687   1.1      matt 	if (cpu_altivec) {
    688   1.1      matt 		evcnt_attach_dynamic(&ci->ci_ev_vecsw, EVCNT_TYPE_TRAP,
    689   1.1      matt 		    &ci->ci_ev_vec, self->dv_xname, "AltiVec context switches");
    690   1.1      matt 	}
    691   1.1      matt #endif
    692  1.33   garbled 	evcnt_attach_dynamic(&ci->ci_ev_ipi, EVCNT_TYPE_INTR,
    693  1.33   garbled 		NULL, self->dv_xname, "IPIs");
    694   1.1      matt }
    695   1.1      matt 
    696  1.36   garbled /*
    697  1.36   garbled  * According to a document labeled "PVR Register Settings":
    698  1.36   garbled  ** For integrated microprocessors the PVR register inside the device
    699  1.36   garbled  ** will identify the version of the microprocessor core. You must also
    700  1.36   garbled  ** read the Device ID, PCI register 02, to identify the part and the
    701  1.36   garbled  ** Revision ID, PCI register 08, to identify the revision of the
    702  1.36   garbled  ** integrated microprocessor.
    703  1.36   garbled  * This apparently applies to 8240/8245/8241, PVR 00810101 and 80811014
    704  1.36   garbled  */
    705  1.36   garbled 
    706   1.1      matt void
    707   1.1      matt cpu_identify(char *str, size_t len)
    708   1.1      matt {
    709  1.24        he 	u_int pvr, major, minor;
    710   1.1      matt 	uint16_t vers, rev, revfmt;
    711   1.1      matt 	const struct cputab *cp;
    712   1.1      matt 	const char *name;
    713   1.1      matt 	size_t n;
    714   1.1      matt 
    715   1.1      matt 	pvr = mfpvr();
    716   1.1      matt 	vers = pvr >> 16;
    717   1.1      matt 	rev = pvr;
    718  1.27   sanjayl 
    719   1.1      matt 	switch (vers) {
    720   1.1      matt 	case MPC7410:
    721  1.24        he 		minor = (pvr >> 0) & 0xff;
    722  1.24        he 		major = minor <= 4 ? 1 : 2;
    723   1.1      matt 		break;
    724  1.36   garbled 	case MPCG2: /*XXX see note above */
    725  1.36   garbled 		major = (pvr >> 4) & 0xf;
    726  1.36   garbled 		minor = (pvr >> 0) & 0xf;
    727  1.36   garbled 		break;
    728   1.1      matt 	default:
    729  1.36   garbled 		major = (pvr >>  8) & 0xf;
    730  1.24        he 		minor = (pvr >>  0) & 0xf;
    731   1.1      matt 	}
    732   1.1      matt 
    733   1.1      matt 	for (cp = models; cp->name[0] != '\0'; cp++) {
    734   1.1      matt 		if (cp->version == vers)
    735   1.1      matt 			break;
    736   1.1      matt 	}
    737   1.1      matt 
    738   1.1      matt 	if (str == NULL) {
    739   1.1      matt 		str = cpu_model;
    740   1.1      matt 		len = sizeof(cpu_model);
    741   1.1      matt 		cpu = vers;
    742   1.1      matt 	}
    743   1.1      matt 
    744   1.1      matt 	revfmt = cp->revfmt;
    745   1.1      matt 	name = cp->name;
    746   1.1      matt 	if (rev == MPC750 && pvr == 15) {
    747   1.1      matt 		name = "755";
    748   1.1      matt 		revfmt = REVFMT_HEX;
    749   1.1      matt 	}
    750   1.1      matt 
    751   1.1      matt 	if (cp->name[0] != '\0') {
    752   1.1      matt 		n = snprintf(str, len, "%s (Revision ", cp->name);
    753   1.1      matt 	} else {
    754   1.1      matt 		n = snprintf(str, len, "Version %#x (Revision ", vers);
    755   1.1      matt 	}
    756   1.1      matt 	if (len > n) {
    757   1.1      matt 		switch (revfmt) {
    758   1.1      matt 		case REVFMT_MAJMIN:
    759  1.24        he 			snprintf(str + n, len - n, "%u.%u)", major, minor);
    760   1.1      matt 			break;
    761   1.1      matt 		case REVFMT_HEX:
    762   1.1      matt 			snprintf(str + n, len - n, "0x%04x)", rev);
    763   1.1      matt 			break;
    764   1.1      matt 		case REVFMT_DEC:
    765   1.1      matt 			snprintf(str + n, len - n, "%u)", rev);
    766   1.1      matt 			break;
    767   1.1      matt 		}
    768   1.1      matt 	}
    769   1.1      matt }
    770   1.1      matt 
    771   1.1      matt #ifdef L2CR_CONFIG
    772   1.1      matt u_int l2cr_config = L2CR_CONFIG;
    773   1.1      matt #else
    774   1.1      matt u_int l2cr_config = 0;
    775   1.1      matt #endif
    776   1.1      matt 
    777   1.2     jklos #ifdef L3CR_CONFIG
    778   1.2     jklos u_int l3cr_config = L3CR_CONFIG;
    779   1.2     jklos #else
    780   1.2     jklos u_int l3cr_config = 0;
    781   1.2     jklos #endif
    782   1.2     jklos 
    783   1.1      matt void
    784   1.7      matt cpu_enable_l2cr(register_t l2cr)
    785   1.7      matt {
    786   1.7      matt 	register_t msr, x;
    787  1.40   garbled 	uint16_t vers;
    788   1.7      matt 
    789  1.40   garbled 	vers = mfpvr() >> 16;
    790  1.40   garbled 
    791   1.7      matt 	/* Disable interrupts and set the cache config bits. */
    792   1.7      matt 	msr = mfmsr();
    793   1.7      matt 	mtmsr(msr & ~PSL_EE);
    794   1.7      matt #ifdef ALTIVEC
    795   1.7      matt 	if (cpu_altivec)
    796  1.26     perry 		__asm volatile("dssall");
    797   1.7      matt #endif
    798  1.26     perry 	__asm volatile("sync");
    799   1.7      matt 	mtspr(SPR_L2CR, l2cr & ~L2CR_L2E);
    800  1.26     perry 	__asm volatile("sync");
    801   1.7      matt 
    802   1.7      matt 	/* Wait for L2 clock to be stable (640 L2 clocks). */
    803   1.7      matt 	delay(100);
    804   1.7      matt 
    805   1.7      matt 	/* Invalidate all L2 contents. */
    806  1.40   garbled 	if (MPC745X_P(vers)) {
    807  1.40   garbled 		mtspr(SPR_L2CR, l2cr | L2CR_L2I);
    808  1.40   garbled 		do {
    809  1.40   garbled 			x = mfspr(SPR_L2CR);
    810  1.40   garbled 		} while (x & L2CR_L2I);
    811  1.40   garbled 	} else {
    812  1.40   garbled 		mtspr(SPR_L2CR, l2cr | L2CR_L2I);
    813  1.40   garbled 		do {
    814  1.40   garbled 			x = mfspr(SPR_L2CR);
    815  1.40   garbled 		} while (x & L2CR_L2IP);
    816  1.40   garbled 	}
    817   1.7      matt 	/* Enable L2 cache. */
    818   1.7      matt 	l2cr |= L2CR_L2E;
    819   1.7      matt 	mtspr(SPR_L2CR, l2cr);
    820   1.7      matt 	mtmsr(msr);
    821   1.7      matt }
    822   1.7      matt 
    823   1.7      matt void
    824   1.7      matt cpu_enable_l3cr(register_t l3cr)
    825   1.1      matt {
    826   1.7      matt 	register_t x;
    827   1.7      matt 
    828   1.7      matt 	/* By The Book (numbered steps from section 3.7.1.3 of MPC7450UM) */
    829   1.7      matt 
    830   1.7      matt 	/*
    831   1.7      matt 	 * 1: Set all L3CR bits for final config except L3E, L3I, L3PE, and
    832   1.7      matt 	 *    L3CLKEN.  (also mask off reserved bits in case they were included
    833   1.7      matt 	 *    in L3CR_CONFIG)
    834   1.7      matt 	 */
    835   1.7      matt 	l3cr &= ~(L3CR_L3E|L3CR_L3I|L3CR_L3PE|L3CR_L3CLKEN|L3CR_RESERVED);
    836   1.7      matt 	mtspr(SPR_L3CR, l3cr);
    837   1.7      matt 
    838   1.7      matt 	/* 2: Set L3CR[5] (otherwise reserved bit) to 1 */
    839   1.7      matt 	l3cr |= 0x04000000;
    840   1.7      matt 	mtspr(SPR_L3CR, l3cr);
    841   1.7      matt 
    842   1.7      matt 	/* 3: Set L3CLKEN to 1*/
    843   1.7      matt 	l3cr |= L3CR_L3CLKEN;
    844   1.7      matt 	mtspr(SPR_L3CR, l3cr);
    845   1.7      matt 
    846   1.7      matt 	/* 4/5: Perform a global cache invalidate (ref section 3.7.3.6) */
    847  1.26     perry 	__asm volatile("dssall;sync");
    848   1.7      matt 	/* L3 cache is already disabled, no need to clear L3E */
    849   1.7      matt 	mtspr(SPR_L3CR, l3cr|L3CR_L3I);
    850   1.7      matt 	do {
    851   1.7      matt 		x = mfspr(SPR_L3CR);
    852   1.7      matt 	} while (x & L3CR_L3I);
    853   1.7      matt 
    854   1.7      matt 	/* 6: Clear L3CLKEN to 0 */
    855   1.7      matt 	l3cr &= ~L3CR_L3CLKEN;
    856   1.7      matt 	mtspr(SPR_L3CR, l3cr);
    857   1.7      matt 
    858   1.7      matt 	/* 7: Perform a 'sync' and wait at least 100 CPU cycles */
    859  1.26     perry 	__asm volatile("sync");
    860   1.7      matt 	delay(100);
    861   1.7      matt 
    862   1.7      matt 	/* 8: Set L3E and L3CLKEN */
    863   1.7      matt 	l3cr |= (L3CR_L3E|L3CR_L3CLKEN);
    864   1.7      matt 	mtspr(SPR_L3CR, l3cr);
    865   1.7      matt 
    866   1.7      matt 	/* 9: Perform a 'sync' and wait at least 100 CPU cycles */
    867  1.26     perry 	__asm volatile("sync");
    868   1.7      matt 	delay(100);
    869   1.7      matt }
    870   1.7      matt 
    871   1.7      matt void
    872   1.7      matt cpu_config_l2cr(int pvr)
    873   1.7      matt {
    874   1.7      matt 	register_t l2cr;
    875  1.36   garbled 	u_int vers = (pvr >> 16) & 0xffff;
    876   1.1      matt 
    877   1.1      matt 	l2cr = mfspr(SPR_L2CR);
    878   1.1      matt 
    879   1.1      matt 	/*
    880   1.1      matt 	 * For MP systems, the firmware may only configure the L2 cache
    881   1.1      matt 	 * on the first CPU.  In this case, assume that the other CPUs
    882   1.1      matt 	 * should use the same value for L2CR.
    883   1.1      matt 	 */
    884   1.1      matt 	if ((l2cr & L2CR_L2E) != 0 && l2cr_config == 0) {
    885   1.1      matt 		l2cr_config = l2cr;
    886   1.1      matt 	}
    887   1.1      matt 
    888   1.1      matt 	/*
    889   1.1      matt 	 * Configure L2 cache if not enabled.
    890   1.1      matt 	 */
    891   1.8       scw 	if ((l2cr & L2CR_L2E) == 0 && l2cr_config != 0) {
    892   1.7      matt 		cpu_enable_l2cr(l2cr_config);
    893   1.8       scw 		l2cr = mfspr(SPR_L2CR);
    894   1.8       scw 	}
    895   1.7      matt 
    896  1.15    briggs 	if ((l2cr & L2CR_L2E) == 0) {
    897  1.15    briggs 		aprint_normal(" L2 cache present but not enabled ");
    898   1.7      matt 		return;
    899  1.15    briggs 	}
    900  1.36   garbled 	aprint_normal(",");
    901   1.1      matt 
    902  1.36   garbled 	switch (vers) {
    903  1.36   garbled 	case IBM750FX:
    904   1.7      matt 		cpu_fmttab_print(cpu_ibm750_l2cr_formats, l2cr);
    905  1.36   garbled 		break;
    906  1.36   garbled 	case MPC750:
    907  1.36   garbled 		if ((pvr & 0xffffff00) == 0x00082200 /* IBM750CX */ ||
    908  1.36   garbled 		    (pvr & 0xffffef00) == 0x00082300 /* IBM750CXe */)
    909  1.36   garbled 			cpu_fmttab_print(cpu_ibm750_l2cr_formats, l2cr);
    910  1.36   garbled 		else
    911  1.36   garbled 			cpu_fmttab_print(cpu_l2cr_formats, l2cr);
    912  1.36   garbled 		break;
    913  1.36   garbled 	case MPC7447A:
    914  1.36   garbled 	case MPC7457:
    915  1.36   garbled 		cpu_fmttab_print(cpu_7457_l2cr_formats, l2cr);
    916  1.36   garbled 		return;
    917  1.36   garbled 	case MPC7448:
    918  1.36   garbled 		cpu_fmttab_print(cpu_7448_l2cr_formats, l2cr);
    919  1.36   garbled 		return;
    920  1.36   garbled 	case MPC7450:
    921  1.36   garbled 	case MPC7455:
    922  1.36   garbled 		cpu_fmttab_print(cpu_7450_l2cr_formats, l2cr);
    923  1.36   garbled 		break;
    924  1.36   garbled 	default:
    925   1.7      matt 		cpu_fmttab_print(cpu_l2cr_formats, l2cr);
    926  1.36   garbled 		break;
    927   1.1      matt 	}
    928   1.7      matt }
    929   1.1      matt 
    930   1.7      matt void
    931   1.7      matt cpu_config_l3cr(int vers)
    932   1.7      matt {
    933   1.7      matt 	register_t l2cr;
    934   1.7      matt 	register_t l3cr;
    935   1.7      matt 
    936   1.7      matt 	l2cr = mfspr(SPR_L2CR);
    937   1.1      matt 
    938   1.7      matt 	/*
    939   1.7      matt 	 * For MP systems, the firmware may only configure the L2 cache
    940   1.7      matt 	 * on the first CPU.  In this case, assume that the other CPUs
    941   1.7      matt 	 * should use the same value for L2CR.
    942   1.7      matt 	 */
    943   1.7      matt 	if ((l2cr & L2CR_L2E) != 0 && l2cr_config == 0) {
    944   1.7      matt 		l2cr_config = l2cr;
    945   1.7      matt 	}
    946   1.1      matt 
    947   1.7      matt 	/*
    948   1.7      matt 	 * Configure L2 cache if not enabled.
    949   1.7      matt 	 */
    950   1.7      matt 	if ((l2cr & L2CR_L2E) == 0 && l2cr_config != 0) {
    951   1.7      matt 		cpu_enable_l2cr(l2cr_config);
    952   1.7      matt 		l2cr = mfspr(SPR_L2CR);
    953   1.7      matt 	}
    954   1.7      matt 
    955   1.7      matt 	aprint_normal(",");
    956  1.22      matt 	switch (vers) {
    957  1.22      matt 	case MPC7447A:
    958  1.22      matt 	case MPC7457:
    959  1.22      matt 		cpu_fmttab_print(cpu_7457_l2cr_formats, l2cr);
    960  1.22      matt 		return;
    961  1.22      matt 	case MPC7448:
    962  1.22      matt 		cpu_fmttab_print(cpu_7448_l2cr_formats, l2cr);
    963  1.22      matt 		return;
    964  1.22      matt 	default:
    965  1.22      matt 		cpu_fmttab_print(cpu_7450_l2cr_formats, l2cr);
    966  1.22      matt 		break;
    967  1.22      matt 	}
    968   1.2     jklos 
    969   1.7      matt 	l3cr = mfspr(SPR_L3CR);
    970   1.1      matt 
    971   1.7      matt 	/*
    972   1.7      matt 	 * For MP systems, the firmware may only configure the L3 cache
    973   1.7      matt 	 * on the first CPU.  In this case, assume that the other CPUs
    974   1.7      matt 	 * should use the same value for L3CR.
    975   1.7      matt 	 */
    976   1.7      matt 	if ((l3cr & L3CR_L3E) != 0 && l3cr_config == 0) {
    977   1.7      matt 		l3cr_config = l3cr;
    978   1.7      matt 	}
    979   1.1      matt 
    980   1.7      matt 	/*
    981   1.7      matt 	 * Configure L3 cache if not enabled.
    982   1.7      matt 	 */
    983   1.7      matt 	if ((l3cr & L3CR_L3E) == 0 && l3cr_config != 0) {
    984   1.7      matt 		cpu_enable_l3cr(l3cr_config);
    985   1.7      matt 		l3cr = mfspr(SPR_L3CR);
    986   1.7      matt 	}
    987   1.7      matt 
    988   1.7      matt 	if (l3cr & L3CR_L3E) {
    989   1.7      matt 		aprint_normal(",");
    990   1.7      matt 		cpu_fmttab_print(cpu_7450_l3cr_formats, l3cr);
    991   1.7      matt 	}
    992   1.1      matt }
    993   1.1      matt 
    994   1.1      matt void
    995  1.23    briggs cpu_probe_speed(struct cpu_info *ci)
    996   1.1      matt {
    997   1.1      matt 	uint64_t cps;
    998   1.1      matt 
    999   1.7      matt 	mtspr(SPR_MMCR0, MMCR0_FC);
   1000   1.1      matt 	mtspr(SPR_PMC1, 0);
   1001   1.7      matt 	mtspr(SPR_MMCR0, MMCR0_PMC1SEL(PMCN_CYCLES));
   1002   1.1      matt 	delay(100000);
   1003   1.1      matt 	cps = (mfspr(SPR_PMC1) * 10) + 4999;
   1004   1.1      matt 
   1005  1.15    briggs 	mtspr(SPR_MMCR0, MMCR0_FC);
   1006  1.15    briggs 
   1007  1.56       phx 	ci->ci_khz = (cps * cpu_get_dfs()) / 1000;
   1008  1.56       phx }
   1009  1.56       phx 
   1010  1.56       phx /*
   1011  1.56       phx  * Read the Dynamic Frequency Switching state and return a divisor for
   1012  1.56       phx  * the maximum frequency.
   1013  1.56       phx  */
   1014  1.56       phx int
   1015  1.56       phx cpu_get_dfs(void)
   1016  1.56       phx {
   1017  1.58       phx 	u_int pvr, vers;
   1018  1.56       phx 
   1019  1.56       phx 	pvr = mfpvr();
   1020  1.56       phx 	vers = pvr >> 16;
   1021  1.56       phx 
   1022  1.56       phx 	switch (vers) {
   1023  1.56       phx 	case MPC7448:
   1024  1.58       phx 		if (mfspr(SPR_HID1) & HID1_DFS4)
   1025  1.56       phx 			return 4;
   1026  1.56       phx 	case MPC7447A:
   1027  1.58       phx 		if (mfspr(SPR_HID1) & HID1_DFS2)
   1028  1.56       phx 			return 2;
   1029  1.56       phx 	}
   1030  1.56       phx 	return 1;
   1031  1.56       phx }
   1032  1.56       phx 
   1033  1.56       phx /*
   1034  1.56       phx  * Set the Dynamic Frequency Switching divisor the same for all cpus.
   1035  1.56       phx  */
   1036  1.56       phx void
   1037  1.56       phx cpu_set_dfs(int div)
   1038  1.56       phx {
   1039  1.56       phx 	uint64_t where;
   1040  1.56       phx 	u_int dfs_mask, pvr, vers;
   1041  1.56       phx 
   1042  1.56       phx 	pvr = mfpvr();
   1043  1.56       phx 	vers = pvr >> 16;
   1044  1.56       phx 	dfs_mask = 0;
   1045  1.56       phx 
   1046  1.56       phx 	switch (vers) {
   1047  1.56       phx 	case MPC7448:
   1048  1.56       phx 		dfs_mask |= HID1_DFS4;
   1049  1.56       phx 	case MPC7447A:
   1050  1.56       phx 		dfs_mask |= HID1_DFS2;
   1051  1.56       phx 		break;
   1052  1.56       phx 	default:
   1053  1.56       phx 		printf("cpu_set_dfs: DFS not supported\n");
   1054  1.56       phx 		return;
   1055  1.56       phx 
   1056  1.56       phx 	}
   1057  1.56       phx 
   1058  1.56       phx 	where = xc_broadcast(0, (xcfunc_t)cpu_set_dfs_xcall, &div, &dfs_mask);
   1059  1.56       phx 	xc_wait(where);
   1060  1.56       phx }
   1061  1.56       phx 
   1062  1.56       phx static void
   1063  1.56       phx cpu_set_dfs_xcall(void *arg1, void *arg2)
   1064  1.56       phx {
   1065  1.56       phx 	u_int dfs_mask, hid1, old_hid1;
   1066  1.56       phx 	int *divisor, s;
   1067  1.56       phx 
   1068  1.56       phx 	divisor = arg1;
   1069  1.56       phx 	dfs_mask = *(u_int *)arg2;
   1070  1.56       phx 
   1071  1.56       phx 	s = splhigh();
   1072  1.56       phx 	hid1 = old_hid1 = mfspr(SPR_HID1);
   1073  1.56       phx 
   1074  1.56       phx 	switch (*divisor) {
   1075  1.56       phx 	case 1:
   1076  1.56       phx 		hid1 &= ~dfs_mask;
   1077  1.56       phx 		break;
   1078  1.56       phx 	case 2:
   1079  1.56       phx 		hid1 &= ~(dfs_mask & HID1_DFS4);
   1080  1.56       phx 		hid1 |= dfs_mask & HID1_DFS2;
   1081  1.56       phx 		break;
   1082  1.56       phx 	case 4:
   1083  1.56       phx 		hid1 &= ~(dfs_mask & HID1_DFS2);
   1084  1.56       phx 		hid1 |= dfs_mask & HID1_DFS4;
   1085  1.56       phx 		break;
   1086  1.56       phx 	}
   1087  1.56       phx 
   1088  1.56       phx 	if (hid1 != old_hid1) {
   1089  1.56       phx 		__asm volatile("sync");
   1090  1.56       phx 		mtspr(SPR_HID1, hid1);
   1091  1.56       phx 		__asm volatile("sync;isync");
   1092  1.56       phx 	}
   1093  1.56       phx 
   1094  1.56       phx 	splx(s);
   1095   1.1      matt }
   1096   1.1      matt 
   1097   1.1      matt #if NSYSMON_ENVSYS > 0
   1098   1.1      matt void
   1099   1.1      matt cpu_tau_setup(struct cpu_info *ci)
   1100   1.1      matt {
   1101  1.34   xtraeme 	struct sysmon_envsys *sme;
   1102  1.50  macallan 	int error, therm_delay;
   1103  1.50  macallan 
   1104  1.50  macallan 	mtspr(SPR_THRM1, SPR_THRM_VALID);
   1105  1.50  macallan 	mtspr(SPR_THRM2, 0);
   1106  1.50  macallan 
   1107  1.50  macallan 	/*
   1108  1.50  macallan 	 * we need to figure out how much 20+us in units of CPU clock cycles
   1109  1.50  macallan 	 * are
   1110  1.50  macallan 	 */
   1111  1.50  macallan 
   1112  1.50  macallan 	therm_delay = ci->ci_khz / 40;		/* 25us just to be safe */
   1113  1.50  macallan 
   1114  1.50  macallan         mtspr(SPR_THRM3, SPR_THRM_TIMER(therm_delay) | SPR_THRM_ENABLE);
   1115   1.1      matt 
   1116  1.34   xtraeme 	sme = sysmon_envsys_create();
   1117  1.12      matt 
   1118  1.34   xtraeme 	sensor.units = ENVSYS_STEMP;
   1119  1.34   xtraeme 	(void)strlcpy(sensor.desc, "CPU Temp", sizeof(sensor.desc));
   1120  1.34   xtraeme 	if (sysmon_envsys_sensor_attach(sme, &sensor)) {
   1121  1.34   xtraeme 		sysmon_envsys_destroy(sme);
   1122  1.34   xtraeme 		return;
   1123  1.34   xtraeme 	}
   1124  1.34   xtraeme 
   1125  1.34   xtraeme 	sme->sme_name = ci->ci_dev->dv_xname;
   1126  1.34   xtraeme 	sme->sme_cookie = ci;
   1127  1.34   xtraeme 	sme->sme_refresh = cpu_tau_refresh;
   1128   1.1      matt 
   1129  1.34   xtraeme 	if ((error = sysmon_envsys_register(sme)) != 0) {
   1130   1.3      matt 		aprint_error("%s: unable to register with sysmon (%d)\n",
   1131   1.1      matt 		    ci->ci_dev->dv_xname, error);
   1132  1.34   xtraeme 		sysmon_envsys_destroy(sme);
   1133  1.34   xtraeme 	}
   1134   1.1      matt }
   1135   1.1      matt 
   1136   1.1      matt 
   1137   1.1      matt /* Find the temperature of the CPU. */
   1138  1.34   xtraeme void
   1139  1.34   xtraeme cpu_tau_refresh(struct sysmon_envsys *sme, envsys_data_t *edata)
   1140   1.1      matt {
   1141   1.1      matt 	int i, threshold, count;
   1142   1.1      matt 
   1143   1.1      matt 	threshold = 64; /* Half of the 7-bit sensor range */
   1144   1.1      matt 
   1145   1.1      matt 	/* Successive-approximation code adapted from Motorola
   1146   1.1      matt 	 * application note AN1800/D, "Programming the Thermal Assist
   1147   1.1      matt 	 * Unit in the MPC750 Microprocessor".
   1148   1.1      matt 	 */
   1149  1.50  macallan 	for (i = 5; i >= 0 ; i--) {
   1150   1.1      matt 		mtspr(SPR_THRM1,
   1151   1.1      matt 		    SPR_THRM_THRESHOLD(threshold) | SPR_THRM_VALID);
   1152   1.1      matt 		count = 0;
   1153  1.50  macallan 		while ((count < 100000) &&
   1154   1.1      matt 		    ((mfspr(SPR_THRM1) & SPR_THRM_TIV) == 0)) {
   1155   1.1      matt 			count++;
   1156   1.1      matt 			delay(1);
   1157   1.1      matt 		}
   1158   1.1      matt 		if (mfspr(SPR_THRM1) & SPR_THRM_TIN) {
   1159   1.1      matt 			/* The interrupt bit was set, meaning the
   1160   1.1      matt 			 * temperature was above the threshold
   1161   1.1      matt 			 */
   1162  1.50  macallan 			threshold += 1 << i;
   1163   1.1      matt 		} else {
   1164   1.1      matt 			/* Temperature was below the threshold */
   1165  1.50  macallan 			threshold -= 1 << i;
   1166   1.1      matt 		}
   1167  1.50  macallan 
   1168   1.1      matt 	}
   1169   1.1      matt 	threshold += 2;
   1170   1.1      matt 
   1171   1.1      matt 	/* Convert the temperature in degrees C to microkelvin */
   1172  1.34   xtraeme 	edata->value_cur = (threshold * 1000000) + 273150000;
   1173  1.50  macallan 	edata->state = ENVSYS_SVALID;
   1174   1.1      matt }
   1175   1.1      matt #endif /* NSYSMON_ENVSYS > 0 */
   1176  1.33   garbled 
   1177  1.33   garbled #ifdef MULTIPROCESSOR
   1178  1.46   garbled extern volatile u_int cpu_spinstart_ack;
   1179  1.46   garbled 
   1180  1.33   garbled int
   1181  1.60      matt cpu_spinup(device_t self, struct cpu_info *ci)
   1182  1.33   garbled {
   1183  1.33   garbled 	volatile struct cpu_hatch_data hatch_data, *h = &hatch_data;
   1184  1.33   garbled 	struct pglist mlist;
   1185  1.33   garbled 	int i, error, pvr, vers;
   1186  1.46   garbled 	char *cp, *hp;
   1187  1.33   garbled 
   1188  1.33   garbled 	pvr = mfpvr();
   1189  1.33   garbled 	vers = pvr >> 16;
   1190  1.33   garbled 	KASSERT(ci != curcpu());
   1191  1.33   garbled 
   1192  1.33   garbled 	/*
   1193  1.33   garbled 	 * Allocate some contiguous pages for the intteup PCB and stack
   1194  1.33   garbled 	 * from the lowest 256MB (because bat0 always maps it va == pa).
   1195  1.46   garbled 	 * Must be 16 byte aligned.
   1196  1.33   garbled 	 */
   1197  1.46   garbled 	error = uvm_pglistalloc(INTSTK, 0x10000, 0x10000000, 16, 0,
   1198  1.46   garbled 	    &mlist, 1, 1);
   1199  1.33   garbled 	if (error) {
   1200  1.33   garbled 		aprint_error(": unable to allocate idle stack\n");
   1201  1.33   garbled 		return -1;
   1202  1.33   garbled 	}
   1203  1.33   garbled 
   1204  1.33   garbled 	KASSERT(ci != &cpu_info[0]);
   1205  1.33   garbled 
   1206  1.33   garbled 	cp = (void *)VM_PAGE_TO_PHYS(TAILQ_FIRST(&mlist));
   1207  1.33   garbled 	memset(cp, 0, INTSTK);
   1208  1.33   garbled 
   1209  1.33   garbled 	ci->ci_intstk = cp;
   1210  1.33   garbled 
   1211  1.46   garbled 	/* Now allocate a hatch stack */
   1212  1.46   garbled 	error = uvm_pglistalloc(0x1000, 0x10000, 0x10000000, 16, 0,
   1213  1.46   garbled 	    &mlist, 1, 1);
   1214  1.46   garbled 	if (error) {
   1215  1.46   garbled 		aprint_error(": unable to allocate hatch stack\n");
   1216  1.46   garbled 		return -1;
   1217  1.46   garbled 	}
   1218  1.46   garbled 
   1219  1.46   garbled 	hp = (void *)VM_PAGE_TO_PHYS(TAILQ_FIRST(&mlist));
   1220  1.46   garbled 	memset(hp, 0, 0x1000);
   1221  1.46   garbled 
   1222  1.33   garbled 	/* Initialize secondary cpu's initial lwp to its idlelwp. */
   1223  1.33   garbled 	ci->ci_curlwp = ci->ci_data.cpu_idlelwp;
   1224  1.54     rmind 	ci->ci_curpcb = lwp_getpcb(ci->ci_curlwp);
   1225  1.33   garbled 	ci->ci_curpm = ci->ci_curpcb->pcb_pm;
   1226  1.33   garbled 
   1227  1.33   garbled 	cpu_hatch_data = h;
   1228  1.33   garbled 	h->running = 0;
   1229  1.33   garbled 	h->self = self;
   1230  1.33   garbled 	h->ci = ci;
   1231  1.33   garbled 	h->pir = ci->ci_cpuid;
   1232  1.46   garbled 
   1233  1.46   garbled 	cpu_hatch_stack = (uint32_t)hp;
   1234  1.33   garbled 	ci->ci_lasttb = cpu_info[0].ci_lasttb;
   1235  1.33   garbled 
   1236  1.33   garbled 	/* copy special registers */
   1237  1.46   garbled 
   1238  1.33   garbled 	h->hid0 = mfspr(SPR_HID0);
   1239  1.46   garbled 
   1240  1.33   garbled 	__asm volatile ("mfsdr1 %0" : "=r"(h->sdr1));
   1241  1.46   garbled 	for (i = 0; i < 16; i++) {
   1242  1.33   garbled 		__asm ("mfsrin %0,%1" : "=r"(h->sr[i]) :
   1243  1.33   garbled 		       "r"(i << ADDR_SR_SHFT));
   1244  1.46   garbled 	}
   1245  1.46   garbled 	if (oeacpufeat & OEACPU_64)
   1246  1.46   garbled 		h->asr = mfspr(SPR_ASR);
   1247  1.46   garbled 	else
   1248  1.46   garbled 		h->asr = 0;
   1249  1.46   garbled 
   1250  1.33   garbled 	/* copy the bat regs */
   1251  1.33   garbled 	__asm volatile ("mfibatu %0,0" : "=r"(h->batu[0]));
   1252  1.33   garbled 	__asm volatile ("mfibatl %0,0" : "=r"(h->batl[0]));
   1253  1.33   garbled 	__asm volatile ("mfibatu %0,1" : "=r"(h->batu[1]));
   1254  1.33   garbled 	__asm volatile ("mfibatl %0,1" : "=r"(h->batl[1]));
   1255  1.33   garbled 	__asm volatile ("mfibatu %0,2" : "=r"(h->batu[2]));
   1256  1.33   garbled 	__asm volatile ("mfibatl %0,2" : "=r"(h->batl[2]));
   1257  1.33   garbled 	__asm volatile ("mfibatu %0,3" : "=r"(h->batu[3]));
   1258  1.33   garbled 	__asm volatile ("mfibatl %0,3" : "=r"(h->batl[3]));
   1259  1.33   garbled 	__asm volatile ("sync; isync");
   1260  1.33   garbled 
   1261  1.33   garbled 	if (md_setup_trampoline(h, ci) == -1)
   1262  1.33   garbled 		return -1;
   1263  1.33   garbled 	md_presync_timebase(h);
   1264  1.33   garbled 	md_start_timebase(h);
   1265  1.33   garbled 
   1266  1.33   garbled 	/* wait for secondary printf */
   1267  1.46   garbled 
   1268  1.33   garbled 	delay(200000);
   1269  1.33   garbled 
   1270  1.46   garbled 	if (h->running < 1) {
   1271  1.46   garbled 		aprint_error("%d:CPU %d didn't start %d\n", cpu_spinstart_ack,
   1272  1.46   garbled 		    ci->ci_cpuid, cpu_spinstart_ack);
   1273  1.46   garbled 		Debugger();
   1274  1.33   garbled 		return -1;
   1275  1.33   garbled 	}
   1276  1.33   garbled 
   1277  1.33   garbled 	/* Register IPI Interrupt */
   1278  1.46   garbled 	if (ipiops.ppc_establish_ipi)
   1279  1.46   garbled 		ipiops.ppc_establish_ipi(IST_LEVEL, IPL_HIGH, NULL);
   1280  1.33   garbled 
   1281  1.33   garbled 	return 0;
   1282  1.33   garbled }
   1283  1.33   garbled 
   1284  1.33   garbled static volatile int start_secondary_cpu;
   1285  1.46   garbled extern void tlbia(void);
   1286  1.33   garbled 
   1287  1.46   garbled register_t
   1288  1.46   garbled cpu_hatch(void)
   1289  1.33   garbled {
   1290  1.33   garbled 	volatile struct cpu_hatch_data *h = cpu_hatch_data;
   1291  1.33   garbled 	struct cpu_info * const ci = h->ci;
   1292  1.54     rmind 	struct pcb *pcb;
   1293  1.33   garbled 	u_int msr;
   1294  1.33   garbled 	int i;
   1295  1.33   garbled 
   1296  1.33   garbled 	/* Initialize timebase. */
   1297  1.33   garbled 	__asm ("mttbl %0; mttbu %0; mttbl %0" :: "r"(0));
   1298  1.33   garbled 
   1299  1.46   garbled 	/*
   1300  1.46   garbled 	 * Set PIR (Processor Identification Register).  i.e. whoami
   1301  1.49       chs 	 * Note that PIR is read-only on some CPU versions, so we write to it
   1302  1.49       chs 	 * only if it has a different value than we need.
   1303  1.46   garbled 	 */
   1304  1.46   garbled 
   1305  1.46   garbled 	msr = mfspr(SPR_PIR);
   1306  1.49       chs 	if (msr != h->pir)
   1307  1.46   garbled 		mtspr(SPR_PIR, h->pir);
   1308  1.46   garbled 
   1309  1.33   garbled 	__asm volatile ("mtsprg 0,%0" :: "r"(ci));
   1310  1.46   garbled 	cpu_spinstart_ack = 0;
   1311  1.33   garbled 
   1312  1.33   garbled 	/* Initialize MMU. */
   1313  1.33   garbled 	__asm ("mtibatu 0,%0" :: "r"(h->batu[0]));
   1314  1.33   garbled 	__asm ("mtibatl 0,%0" :: "r"(h->batl[0]));
   1315  1.33   garbled 	__asm ("mtibatu 1,%0" :: "r"(h->batu[1]));
   1316  1.33   garbled 	__asm ("mtibatl 1,%0" :: "r"(h->batl[1]));
   1317  1.33   garbled 	__asm ("mtibatu 2,%0" :: "r"(h->batu[2]));
   1318  1.33   garbled 	__asm ("mtibatl 2,%0" :: "r"(h->batl[2]));
   1319  1.33   garbled 	__asm ("mtibatu 3,%0" :: "r"(h->batu[3]));
   1320  1.33   garbled 	__asm ("mtibatl 3,%0" :: "r"(h->batl[3]));
   1321  1.33   garbled 
   1322  1.33   garbled 	mtspr(SPR_HID0, h->hid0);
   1323  1.33   garbled 
   1324  1.33   garbled 	__asm ("mtibatl 0,%0; mtibatu 0,%1; mtdbatl 0,%0; mtdbatu 0,%1;"
   1325  1.33   garbled 	    :: "r"(battable[0].batl), "r"(battable[0].batu));
   1326  1.33   garbled 
   1327  1.46   garbled 	__asm volatile ("sync");
   1328  1.33   garbled 	for (i = 0; i < 16; i++)
   1329  1.33   garbled 		__asm ("mtsrin %0,%1" :: "r"(h->sr[i]), "r"(i << ADDR_SR_SHFT));
   1330  1.46   garbled 	__asm volatile ("sync; isync");
   1331  1.46   garbled 
   1332  1.46   garbled 	if (oeacpufeat & OEACPU_64)
   1333  1.46   garbled 		mtspr(SPR_ASR, h->asr);
   1334  1.33   garbled 
   1335  1.46   garbled 	cpu_spinstart_ack = 1;
   1336  1.46   garbled 	__asm ("ptesync");
   1337  1.33   garbled 	__asm ("mtsdr1 %0" :: "r"(h->sdr1));
   1338  1.46   garbled 	__asm volatile ("sync; isync");
   1339  1.46   garbled 
   1340  1.46   garbled 	cpu_spinstart_ack = 5;
   1341  1.46   garbled 	for (i = 0; i < 16; i++)
   1342  1.46   garbled 		__asm ("mfsrin %0,%1" : "=r"(h->sr[i]) :
   1343  1.46   garbled 		       "r"(i << ADDR_SR_SHFT));
   1344  1.33   garbled 
   1345  1.33   garbled 	/* Enable I/D address translations. */
   1346  1.46   garbled 	msr = mfmsr();
   1347  1.33   garbled 	msr |= PSL_IR|PSL_DR|PSL_ME|PSL_RI;
   1348  1.46   garbled 	mtmsr(msr);
   1349  1.33   garbled 	__asm volatile ("sync; isync");
   1350  1.46   garbled 	cpu_spinstart_ack = 2;
   1351  1.33   garbled 
   1352  1.33   garbled 	md_sync_timebase(h);
   1353  1.33   garbled 
   1354  1.33   garbled 	cpu_setup(h->self, ci);
   1355  1.33   garbled 
   1356  1.33   garbled 	h->running = 1;
   1357  1.33   garbled 	__asm volatile ("sync; isync");
   1358  1.33   garbled 
   1359  1.33   garbled 	while (start_secondary_cpu == 0)
   1360  1.33   garbled 		;
   1361  1.33   garbled 
   1362  1.33   garbled 	__asm volatile ("sync; isync");
   1363  1.33   garbled 
   1364  1.46   garbled 	aprint_normal("cpu%d started\n", curcpu()->ci_index);
   1365  1.33   garbled 	__asm volatile ("mtdec %0" :: "r"(ticks_per_intr));
   1366  1.33   garbled 
   1367  1.33   garbled 	md_setup_interrupts();
   1368  1.33   garbled 
   1369  1.33   garbled 	ci->ci_ipending = 0;
   1370  1.33   garbled 	ci->ci_cpl = 0;
   1371  1.33   garbled 
   1372  1.33   garbled 	mtmsr(mfmsr() | PSL_EE);
   1373  1.54     rmind 	pcb = lwp_getpcb(ci->ci_data.cpu_idlelwp);
   1374  1.54     rmind 	return pcb->pcb_sp;
   1375  1.33   garbled }
   1376  1.33   garbled 
   1377  1.33   garbled void
   1378  1.53    cegger cpu_boot_secondary_processors(void)
   1379  1.33   garbled {
   1380  1.33   garbled 	start_secondary_cpu = 1;
   1381  1.33   garbled 	__asm volatile ("sync");
   1382  1.33   garbled }
   1383  1.33   garbled 
   1384  1.33   garbled #endif /*MULTIPROCESSOR*/
   1385