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