xref: /onnv-gate/usr/src/uts/sun4/os/mp_startup.c (revision 1077)
10Sstevel@tonic-gate /*
20Sstevel@tonic-gate  * CDDL HEADER START
30Sstevel@tonic-gate  *
40Sstevel@tonic-gate  * The contents of this file are subject to the terms of the
50Sstevel@tonic-gate  * Common Development and Distribution License, Version 1.0 only
60Sstevel@tonic-gate  * (the "License").  You may not use this file except in compliance
70Sstevel@tonic-gate  * with the License.
80Sstevel@tonic-gate  *
90Sstevel@tonic-gate  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
100Sstevel@tonic-gate  * or http://www.opensolaris.org/os/licensing.
110Sstevel@tonic-gate  * See the License for the specific language governing permissions
120Sstevel@tonic-gate  * and limitations under the License.
130Sstevel@tonic-gate  *
140Sstevel@tonic-gate  * When distributing Covered Code, include this CDDL HEADER in each
150Sstevel@tonic-gate  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
160Sstevel@tonic-gate  * If applicable, add the following below this CDDL HEADER, with the
170Sstevel@tonic-gate  * fields enclosed by brackets "[]" replaced with your own identifying
180Sstevel@tonic-gate  * information: Portions Copyright [yyyy] [name of copyright owner]
190Sstevel@tonic-gate  *
200Sstevel@tonic-gate  * CDDL HEADER END
210Sstevel@tonic-gate  */
220Sstevel@tonic-gate /*
230Sstevel@tonic-gate  * Copyright 2005 Sun Microsystems, Inc.  All rights reserved.
240Sstevel@tonic-gate  * Use is subject to license terms.
250Sstevel@tonic-gate  */
260Sstevel@tonic-gate 
270Sstevel@tonic-gate #pragma ident	"%Z%%M%	%I%	%E% SMI"
280Sstevel@tonic-gate 
290Sstevel@tonic-gate #include <sys/sysmacros.h>
300Sstevel@tonic-gate #include <sys/prom_plat.h>
310Sstevel@tonic-gate #include <sys/prom_debug.h>
320Sstevel@tonic-gate #include <vm/hat_sfmmu.h>
330Sstevel@tonic-gate #include <vm/seg_kp.h>
340Sstevel@tonic-gate #include <vm/seg_kmem.h>
350Sstevel@tonic-gate #include <sys/machsystm.h>
360Sstevel@tonic-gate #include <sys/callb.h>
370Sstevel@tonic-gate #include <sys/cpu_module.h>
380Sstevel@tonic-gate #include <sys/chip.h>
390Sstevel@tonic-gate #include <sys/dtrace.h>
400Sstevel@tonic-gate #include <sys/reboot.h>
410Sstevel@tonic-gate #include <sys/kdi.h>
42*1077Ssvemuri #include <sys/traptrace.h>
430Sstevel@tonic-gate #ifdef TRAPTRACE
440Sstevel@tonic-gate #include <sys/bootconf.h>
450Sstevel@tonic-gate #endif /* TRAPTRACE */
460Sstevel@tonic-gate #include <sys/cpu_sgnblk_defs.h>
470Sstevel@tonic-gate 
480Sstevel@tonic-gate extern void cpu_intrq_setup(struct cpu *);
490Sstevel@tonic-gate extern void cpu_intrq_register(struct cpu *);
500Sstevel@tonic-gate 
510Sstevel@tonic-gate struct cpu	*cpus;	/* pointer to other cpus; dynamically allocate */
520Sstevel@tonic-gate struct cpu	*cpu[NCPU];	/* pointers to all CPUs */
530Sstevel@tonic-gate uint64_t	cpu_pa[NCPU];	/* pointers to all CPUs in PA */
540Sstevel@tonic-gate cpu_core_t	cpu_core[NCPU];	/* cpu_core structures */
550Sstevel@tonic-gate 
560Sstevel@tonic-gate #ifdef TRAPTRACE
570Sstevel@tonic-gate caddr_t	ttrace_buf;	/* bop alloced traptrace for all cpus except 0 */
580Sstevel@tonic-gate #endif /* TRAPTRACE */
590Sstevel@tonic-gate 
600Sstevel@tonic-gate /* bit mask of cpus ready for x-calls, protected by cpu_lock */
610Sstevel@tonic-gate cpuset_t cpu_ready_set;
620Sstevel@tonic-gate 
630Sstevel@tonic-gate /* bit mask used to communicate with cpus during bringup */
640Sstevel@tonic-gate static cpuset_t proxy_ready_set;
650Sstevel@tonic-gate 
660Sstevel@tonic-gate static void	slave_startup(void);
670Sstevel@tonic-gate 
680Sstevel@tonic-gate /*
690Sstevel@tonic-gate  * Defined in $KARCH/os/mach_mp_startup.c
700Sstevel@tonic-gate  */
710Sstevel@tonic-gate #pragma weak init_cpu_info
720Sstevel@tonic-gate 
730Sstevel@tonic-gate /*
740Sstevel@tonic-gate  * Amount of time (in milliseconds) we should wait before giving up on CPU
750Sstevel@tonic-gate  * initialization and assuming that the CPU we're trying to wake up is dead
760Sstevel@tonic-gate  * or out of control.
770Sstevel@tonic-gate  */
780Sstevel@tonic-gate #define	CPU_WAKEUP_GRACE_MSEC 1000
790Sstevel@tonic-gate 
800Sstevel@tonic-gate /*
810Sstevel@tonic-gate  * MP configurations may reserve additional interrupt request entries.
820Sstevel@tonic-gate  * intr_add_{div,max} can be modified to tune memory usage.
830Sstevel@tonic-gate  */
840Sstevel@tonic-gate 
850Sstevel@tonic-gate uint_t	intr_add_div = 1;			/* 1=worst case memory usage */
860Sstevel@tonic-gate size_t	intr_add_max = 0;
870Sstevel@tonic-gate 
880Sstevel@tonic-gate /* intr_add_{pools,head,tail} calculated based on intr_add_{div,max} */
890Sstevel@tonic-gate 
900Sstevel@tonic-gate size_t	intr_add_pools = 0;			/* additional pools per cpu */
910Sstevel@tonic-gate struct intr_req	*intr_add_head = (struct intr_req *)NULL;
920Sstevel@tonic-gate #ifdef	DEBUG
930Sstevel@tonic-gate struct intr_req	*intr_add_tail = (struct intr_req *)NULL;
940Sstevel@tonic-gate #endif	/* DEBUG */
950Sstevel@tonic-gate 
960Sstevel@tonic-gate 
970Sstevel@tonic-gate #ifdef	TRAPTRACE
980Sstevel@tonic-gate /*
990Sstevel@tonic-gate  * This function bop allocs traptrace buffers for all cpus
1000Sstevel@tonic-gate  * other than boot cpu.
1010Sstevel@tonic-gate  */
1020Sstevel@tonic-gate caddr_t
1030Sstevel@tonic-gate trap_trace_alloc(caddr_t base)
1040Sstevel@tonic-gate {
1050Sstevel@tonic-gate 	caddr_t	vaddr;
1060Sstevel@tonic-gate 	extern int max_ncpus;
1070Sstevel@tonic-gate 
1080Sstevel@tonic-gate 	if (max_ncpus == 1) {
1090Sstevel@tonic-gate 		return (base);
1100Sstevel@tonic-gate 	}
1110Sstevel@tonic-gate 
112*1077Ssvemuri 	if ((vaddr = (caddr_t)BOP_ALLOC(bootops, base, (TRAP_TSIZE *
113*1077Ssvemuri 		(max_ncpus - 1)), TRAP_TSIZE)) == NULL) {
1140Sstevel@tonic-gate 		panic("traptrace_alloc: can't bop alloc");
1150Sstevel@tonic-gate 	}
1160Sstevel@tonic-gate 	ttrace_buf = vaddr;
1170Sstevel@tonic-gate 	PRM_DEBUG(ttrace_buf);
118*1077Ssvemuri 	return (vaddr + (TRAP_TSIZE * (max_ncpus - 1)));
1190Sstevel@tonic-gate }
1200Sstevel@tonic-gate #endif	/* TRAPTRACE */
1210Sstevel@tonic-gate 
1220Sstevel@tonic-gate /*
1230Sstevel@tonic-gate  * common slave cpu initialization code
1240Sstevel@tonic-gate  */
1250Sstevel@tonic-gate void
1260Sstevel@tonic-gate common_startup_init(cpu_t *cp, int cpuid)
1270Sstevel@tonic-gate {
1280Sstevel@tonic-gate 	kthread_id_t tp;
1290Sstevel@tonic-gate 	sfmmu_t *sfmmup;
1300Sstevel@tonic-gate 	caddr_t	sp;
1310Sstevel@tonic-gate 
1320Sstevel@tonic-gate 	/*
1330Sstevel@tonic-gate 	 * Allocate and initialize the startup thread for this CPU.
1340Sstevel@tonic-gate 	 */
1350Sstevel@tonic-gate 	tp = thread_create(NULL, 0, slave_startup, NULL, 0, &p0,
1360Sstevel@tonic-gate 	    TS_STOPPED, maxclsyspri);
1370Sstevel@tonic-gate 
1380Sstevel@tonic-gate 	/*
1390Sstevel@tonic-gate 	 * Set state to TS_ONPROC since this thread will start running
1400Sstevel@tonic-gate 	 * as soon as the CPU comes online.
1410Sstevel@tonic-gate 	 *
1420Sstevel@tonic-gate 	 * All the other fields of the thread structure are setup by
1430Sstevel@tonic-gate 	 * thread_create().
1440Sstevel@tonic-gate 	 */
1450Sstevel@tonic-gate 	THREAD_ONPROC(tp, cp);
1460Sstevel@tonic-gate 	tp->t_preempt = 1;
1470Sstevel@tonic-gate 	tp->t_bound_cpu = cp;
1480Sstevel@tonic-gate 	tp->t_affinitycnt = 1;
1490Sstevel@tonic-gate 	tp->t_cpu = cp;
1500Sstevel@tonic-gate 	tp->t_disp_queue = cp->cpu_disp;
1510Sstevel@tonic-gate 
1520Sstevel@tonic-gate 	sfmmup = astosfmmu(&kas);
1530Sstevel@tonic-gate 	CPUSET_ADD(sfmmup->sfmmu_cpusran, cpuid);
1540Sstevel@tonic-gate 
1550Sstevel@tonic-gate 	/*
1560Sstevel@tonic-gate 	 * Setup thread to start in slave_startup.
1570Sstevel@tonic-gate 	 */
1580Sstevel@tonic-gate 	sp = tp->t_stk;
1590Sstevel@tonic-gate 	tp->t_pc = (uintptr_t)slave_startup - 8;
1600Sstevel@tonic-gate 	tp->t_sp = (uintptr_t)((struct rwindow *)sp - 1) - STACK_BIAS;
1610Sstevel@tonic-gate 
1620Sstevel@tonic-gate 	cp->cpu_id = cpuid;
1630Sstevel@tonic-gate 	cp->cpu_self = cp;
1640Sstevel@tonic-gate 	cp->cpu_thread = tp;
1650Sstevel@tonic-gate 	cp->cpu_lwp = NULL;
1660Sstevel@tonic-gate 	cp->cpu_dispthread = tp;
1670Sstevel@tonic-gate 	cp->cpu_dispatch_pri = DISP_PRIO(tp);
168834Sandrei 	cp->cpu_startup_thread = tp;
1690Sstevel@tonic-gate }
1700Sstevel@tonic-gate 
1710Sstevel@tonic-gate /*
1720Sstevel@tonic-gate  * parametric flag setting functions.  these routines set the cpu
1730Sstevel@tonic-gate  * state just prior to releasing the slave cpu.
1740Sstevel@tonic-gate  */
1750Sstevel@tonic-gate void
1760Sstevel@tonic-gate cold_flag_set(int cpuid)
1770Sstevel@tonic-gate {
1780Sstevel@tonic-gate 	cpu_t *cp;
1790Sstevel@tonic-gate 
1800Sstevel@tonic-gate 	ASSERT(MUTEX_HELD(&cpu_lock));
1810Sstevel@tonic-gate 
1820Sstevel@tonic-gate 	cp = cpu[cpuid];
1830Sstevel@tonic-gate 	cp->cpu_flags |= CPU_RUNNING | CPU_ENABLE | CPU_EXISTS;
1840Sstevel@tonic-gate 	cpu_add_active(cp);
1850Sstevel@tonic-gate 	/*
1860Sstevel@tonic-gate 	 * Add CPU_READY after the cpu_add_active() call
1870Sstevel@tonic-gate 	 * to avoid pausing cp.
1880Sstevel@tonic-gate 	 */
1890Sstevel@tonic-gate 	cp->cpu_flags |= CPU_READY;		/* ready */
1900Sstevel@tonic-gate 	cpu_set_state(cp);
1910Sstevel@tonic-gate }
1920Sstevel@tonic-gate 
1930Sstevel@tonic-gate static void
1940Sstevel@tonic-gate warm_flag_set(int cpuid)
1950Sstevel@tonic-gate {
1960Sstevel@tonic-gate 	cpu_t *cp;
1970Sstevel@tonic-gate 
1980Sstevel@tonic-gate 	ASSERT(MUTEX_HELD(&cpu_lock));
1990Sstevel@tonic-gate 
2000Sstevel@tonic-gate 	/*
2010Sstevel@tonic-gate 	 * warm start activates cpus into the OFFLINE state
2020Sstevel@tonic-gate 	 */
2030Sstevel@tonic-gate 	cp = cpu[cpuid];
2040Sstevel@tonic-gate 	cp->cpu_flags |= CPU_RUNNING | CPU_READY | CPU_EXISTS
2050Sstevel@tonic-gate 		| CPU_OFFLINE | CPU_QUIESCED;
2060Sstevel@tonic-gate 	cpu_set_state(cp);
2070Sstevel@tonic-gate }
2080Sstevel@tonic-gate 
2090Sstevel@tonic-gate /*
2100Sstevel@tonic-gate  * Internal cpu startup sequencer
2110Sstevel@tonic-gate  * The sequence is as follows:
2120Sstevel@tonic-gate  *
2130Sstevel@tonic-gate  * MASTER	SLAVE
2140Sstevel@tonic-gate  * -------	----------
2150Sstevel@tonic-gate  * assume the kernel data is initialized
2160Sstevel@tonic-gate  * clear the proxy bit
2170Sstevel@tonic-gate  * start the slave cpu
2180Sstevel@tonic-gate  * wait for the slave cpu to set the proxy
2190Sstevel@tonic-gate  *
2200Sstevel@tonic-gate  *		the slave runs slave_startup and then sets the proxy
2210Sstevel@tonic-gate  *		the slave waits for the master to add slave to the ready set
2220Sstevel@tonic-gate  *
2230Sstevel@tonic-gate  * the master finishes the initialization and
2240Sstevel@tonic-gate  * adds the slave to the ready set
2250Sstevel@tonic-gate  *
2260Sstevel@tonic-gate  *		the slave exits the startup thread and is running
2270Sstevel@tonic-gate  */
2280Sstevel@tonic-gate void
2290Sstevel@tonic-gate start_cpu(int cpuid, void(*flag_func)(int))
2300Sstevel@tonic-gate {
2310Sstevel@tonic-gate 	extern caddr_t cpu_startup;
2320Sstevel@tonic-gate 	int timout;
2330Sstevel@tonic-gate 
2340Sstevel@tonic-gate 	ASSERT(MUTEX_HELD(&cpu_lock));
2350Sstevel@tonic-gate 
2360Sstevel@tonic-gate 	/*
2370Sstevel@tonic-gate 	 * Before we begin the dance, tell DTrace that we're about to start
2380Sstevel@tonic-gate 	 * a CPU.
2390Sstevel@tonic-gate 	 */
2400Sstevel@tonic-gate 	if (dtrace_cpustart_init != NULL)
2410Sstevel@tonic-gate 		(*dtrace_cpustart_init)();
2420Sstevel@tonic-gate 
2430Sstevel@tonic-gate 	/* start the slave cpu */
2440Sstevel@tonic-gate 	CPUSET_DEL(proxy_ready_set, cpuid);
2450Sstevel@tonic-gate 	if (prom_test("SUNW,start-cpu-by-cpuid") == 0) {
2460Sstevel@tonic-gate 		(void) prom_startcpu_bycpuid(cpuid, (caddr_t)&cpu_startup,
2470Sstevel@tonic-gate 		    cpuid);
2480Sstevel@tonic-gate 	} else {
2490Sstevel@tonic-gate 		/* "by-cpuid" interface didn't exist.  Do it the old way */
250789Sahrens 		pnode_t nodeid = cpunodes[cpuid].nodeid;
2510Sstevel@tonic-gate 
252789Sahrens 		ASSERT(nodeid != (pnode_t)0);
2530Sstevel@tonic-gate 		(void) prom_startcpu(nodeid, (caddr_t)&cpu_startup, cpuid);
2540Sstevel@tonic-gate 	}
2550Sstevel@tonic-gate 
2560Sstevel@tonic-gate 	/* wait for the slave cpu to check in. */
2570Sstevel@tonic-gate 	for (timout = CPU_WAKEUP_GRACE_MSEC; timout; timout--) {
2580Sstevel@tonic-gate 		if (CPU_IN_SET(proxy_ready_set, cpuid))
2590Sstevel@tonic-gate 			break;
2600Sstevel@tonic-gate 		DELAY(1000);
2610Sstevel@tonic-gate 	}
2620Sstevel@tonic-gate 	if (timout == 0) {
2630Sstevel@tonic-gate 		panic("cpu%d failed to start (2)", cpuid);
2640Sstevel@tonic-gate 	}
2650Sstevel@tonic-gate 
2660Sstevel@tonic-gate 	/*
2670Sstevel@tonic-gate 	 * The slave has started; we can tell DTrace that it's safe again.
2680Sstevel@tonic-gate 	 */
2690Sstevel@tonic-gate 	if (dtrace_cpustart_fini != NULL)
2700Sstevel@tonic-gate 		(*dtrace_cpustart_fini)();
2710Sstevel@tonic-gate 
2720Sstevel@tonic-gate 	/* run the master side of stick synchronization for the slave cpu */
2730Sstevel@tonic-gate 	sticksync_master();
2740Sstevel@tonic-gate 
2750Sstevel@tonic-gate 	/*
2760Sstevel@tonic-gate 	 * deal with the cpu flags in a phase-specific manner
2770Sstevel@tonic-gate 	 * for various reasons, this needs to run after the slave
2780Sstevel@tonic-gate 	 * is checked in but before the slave is released.
2790Sstevel@tonic-gate 	 */
2800Sstevel@tonic-gate 	(*flag_func)(cpuid);
2810Sstevel@tonic-gate 
2820Sstevel@tonic-gate 	/* release the slave */
2830Sstevel@tonic-gate 	CPUSET_ADD(cpu_ready_set, cpuid);
2840Sstevel@tonic-gate }
2850Sstevel@tonic-gate 
2860Sstevel@tonic-gate #ifdef TRAPTRACE
2870Sstevel@tonic-gate int trap_tr0_inuse = 1;	/* it is always used on the boot cpu */
2880Sstevel@tonic-gate int trap_trace_inuse[NCPU];
2890Sstevel@tonic-gate #endif /* TRAPTRACE */
2900Sstevel@tonic-gate 
2910Sstevel@tonic-gate #define	cpu_next_free	cpu_prev
2920Sstevel@tonic-gate 
2930Sstevel@tonic-gate /*
2940Sstevel@tonic-gate  * Routine to set up a CPU to prepare for starting it up.
2950Sstevel@tonic-gate  */
2960Sstevel@tonic-gate void
2970Sstevel@tonic-gate setup_cpu_common(int cpuid)
2980Sstevel@tonic-gate {
2990Sstevel@tonic-gate 	struct cpu *cp = NULL;
3000Sstevel@tonic-gate 	kthread_id_t tp;
3010Sstevel@tonic-gate #ifdef TRAPTRACE
3020Sstevel@tonic-gate 	int tt_index;
3030Sstevel@tonic-gate 	TRAP_TRACE_CTL	*ctlp;
3040Sstevel@tonic-gate 	caddr_t	newbuf;
3050Sstevel@tonic-gate #endif /* TRAPTRACE */
3060Sstevel@tonic-gate 
3070Sstevel@tonic-gate 	extern void idle();
3080Sstevel@tonic-gate 	extern void init_intr_threads(struct cpu *);
3090Sstevel@tonic-gate 
3100Sstevel@tonic-gate 	ASSERT(MUTEX_HELD(&cpu_lock));
3110Sstevel@tonic-gate 	ASSERT(cpu[cpuid] == NULL);
3120Sstevel@tonic-gate 
3130Sstevel@tonic-gate 	ASSERT(ncpus <= max_ncpus);
3140Sstevel@tonic-gate 
3150Sstevel@tonic-gate #ifdef TRAPTRACE
3160Sstevel@tonic-gate 	/*
3170Sstevel@tonic-gate 	 * allocate a traptrace buffer for this CPU.
3180Sstevel@tonic-gate 	 */
3190Sstevel@tonic-gate 	ctlp = &trap_trace_ctl[cpuid];
3200Sstevel@tonic-gate 	if (!trap_tr0_inuse) {
3210Sstevel@tonic-gate 		trap_tr0_inuse = 1;
3220Sstevel@tonic-gate 		newbuf = trap_tr0;
3230Sstevel@tonic-gate 		tt_index = -1;
3240Sstevel@tonic-gate 	} else {
3250Sstevel@tonic-gate 		for (tt_index = 0; tt_index < (max_ncpus-1); tt_index++)
3260Sstevel@tonic-gate 			if (!trap_trace_inuse[tt_index])
3270Sstevel@tonic-gate 			    break;
3280Sstevel@tonic-gate 		ASSERT(tt_index < max_ncpus - 1);
3290Sstevel@tonic-gate 		trap_trace_inuse[tt_index] = 1;
330*1077Ssvemuri 		newbuf = (caddr_t)(ttrace_buf + (tt_index * TRAP_TSIZE));
3310Sstevel@tonic-gate 	}
3320Sstevel@tonic-gate 	ctlp->d.vaddr_base = newbuf;
3330Sstevel@tonic-gate 	ctlp->d.offset = ctlp->d.last_offset = 0;
3340Sstevel@tonic-gate 	ctlp->d.limit = trap_trace_bufsize;
3350Sstevel@tonic-gate 	ctlp->d.paddr_base = va_to_pa(newbuf);
3360Sstevel@tonic-gate 	ASSERT(ctlp->d.paddr_base != (uint64_t)-1);
337*1077Ssvemuri #endif /* TRAPTRACE */
3380Sstevel@tonic-gate 	/*
339*1077Ssvemuri 	 * initialize hv traptrace buffer for this CPU
3400Sstevel@tonic-gate 	 */
341*1077Ssvemuri 	mach_htraptrace_setup(cpuid);
3420Sstevel@tonic-gate 
3430Sstevel@tonic-gate 	/*
3440Sstevel@tonic-gate 	 * Obtain pointer to the appropriate cpu structure.
3450Sstevel@tonic-gate 	 */
3460Sstevel@tonic-gate 	if (cpu0.cpu_flags == 0) {
3470Sstevel@tonic-gate 		cp = &cpu0;
3480Sstevel@tonic-gate 	} else {
3490Sstevel@tonic-gate 		/*
3500Sstevel@tonic-gate 		 *  When dynamically allocating cpu structs,
3510Sstevel@tonic-gate 		 *  cpus is used as a pointer to a list of freed
3520Sstevel@tonic-gate 		 *  cpu structs.
3530Sstevel@tonic-gate 		 */
3540Sstevel@tonic-gate 		if (cpus) {
3550Sstevel@tonic-gate 			/* grab the first cpu struct on the free list */
3560Sstevel@tonic-gate 			cp = cpus;
3570Sstevel@tonic-gate 			if (cp->cpu_next_free)
3580Sstevel@tonic-gate 				cpus = cp->cpu_next_free;
3590Sstevel@tonic-gate 			else
3600Sstevel@tonic-gate 				cpus = NULL;
3610Sstevel@tonic-gate 		}
3620Sstevel@tonic-gate 	}
3630Sstevel@tonic-gate 
3640Sstevel@tonic-gate 	if (cp == NULL)
3650Sstevel@tonic-gate 		cp = vmem_xalloc(static_alloc_arena, CPU_ALLOC_SIZE,
3660Sstevel@tonic-gate 		    CPU_ALLOC_SIZE, 0, 0, NULL, NULL, VM_SLEEP);
3670Sstevel@tonic-gate 
3680Sstevel@tonic-gate 	bzero(cp, sizeof (*cp));
3690Sstevel@tonic-gate 
3700Sstevel@tonic-gate 	cp->cpu_id = cpuid;
3710Sstevel@tonic-gate 	cp->cpu_self = cp;
3720Sstevel@tonic-gate 
3730Sstevel@tonic-gate 	/*
3740Sstevel@tonic-gate 	 * Initialize ptl1_panic stack
3750Sstevel@tonic-gate 	 */
3760Sstevel@tonic-gate 	ptl1_init_cpu(cp);
3770Sstevel@tonic-gate 
3780Sstevel@tonic-gate 	/*
3790Sstevel@tonic-gate 	 * Initialize the dispatcher for this CPU.
3800Sstevel@tonic-gate 	 */
3810Sstevel@tonic-gate 	disp_cpu_init(cp);
3820Sstevel@tonic-gate 
383414Skchow 	cpu_vm_data_init(cp);
384414Skchow 
3850Sstevel@tonic-gate 	/*
3860Sstevel@tonic-gate 	 * Now, initialize per-CPU idle thread for this CPU.
3870Sstevel@tonic-gate 	 */
3880Sstevel@tonic-gate 	tp = thread_create(NULL, 0, idle, NULL, 0, &p0, TS_ONPROC, -1);
3890Sstevel@tonic-gate 
3900Sstevel@tonic-gate 	cp->cpu_idle_thread = tp;
3910Sstevel@tonic-gate 
3920Sstevel@tonic-gate 	tp->t_preempt = 1;
3930Sstevel@tonic-gate 	tp->t_bound_cpu = cp;
3940Sstevel@tonic-gate 	tp->t_affinitycnt = 1;
3950Sstevel@tonic-gate 	tp->t_cpu = cp;
3960Sstevel@tonic-gate 	tp->t_disp_queue = cp->cpu_disp;
3970Sstevel@tonic-gate 
3980Sstevel@tonic-gate 	/*
3990Sstevel@tonic-gate 	 * Registering a thread in the callback table is usually
4000Sstevel@tonic-gate 	 * done in the initialization code of the thread. In this
4010Sstevel@tonic-gate 	 * case, we do it right after thread creation to avoid
4020Sstevel@tonic-gate 	 * blocking idle thread while registering itself. It also
4030Sstevel@tonic-gate 	 * avoids the possibility of reregistration in case a CPU
4040Sstevel@tonic-gate 	 * restarts its idle thread.
4050Sstevel@tonic-gate 	 */
4060Sstevel@tonic-gate 	CALLB_CPR_INIT_SAFE(tp, "idle");
4070Sstevel@tonic-gate 
4080Sstevel@tonic-gate 	init_cpu_info(cp);
4090Sstevel@tonic-gate 
4100Sstevel@tonic-gate 	/*
4110Sstevel@tonic-gate 	 * Initialize the interrupt threads for this CPU
4120Sstevel@tonic-gate 	 */
4130Sstevel@tonic-gate 	init_intr_pool(cp);
4140Sstevel@tonic-gate 	init_intr_threads(cp);
4150Sstevel@tonic-gate 
4160Sstevel@tonic-gate 	/*
417220Sesaxe 	 * Add CPU to list of available CPUs.
418220Sesaxe 	 * It'll be on the active list after it is started.
4190Sstevel@tonic-gate 	 */
4200Sstevel@tonic-gate 	cpu_add_unit(cp);
4210Sstevel@tonic-gate 
4220Sstevel@tonic-gate 	/*
4230Sstevel@tonic-gate 	 * Allocate and init cpu module private data structures,
4240Sstevel@tonic-gate 	 * including scrubber.
4250Sstevel@tonic-gate 	 */
4260Sstevel@tonic-gate 	cpu_init_private(cp);
4270Sstevel@tonic-gate 
428220Sesaxe 	/*
429220Sesaxe 	 * Associate this CPU with a physical processor
430220Sesaxe 	 */
431220Sesaxe 	chip_cpu_init(cp);
432220Sesaxe 
4330Sstevel@tonic-gate 	cpu_intrq_setup(cp);
4340Sstevel@tonic-gate }
4350Sstevel@tonic-gate 
4360Sstevel@tonic-gate /*
4370Sstevel@tonic-gate  * Routine to clean up a CPU after shutting it down.
4380Sstevel@tonic-gate  */
4390Sstevel@tonic-gate int
4400Sstevel@tonic-gate cleanup_cpu_common(int cpuid)
4410Sstevel@tonic-gate {
4420Sstevel@tonic-gate 	struct cpu *cp;
4430Sstevel@tonic-gate #ifdef TRAPTRACE
4440Sstevel@tonic-gate 	int i;
4450Sstevel@tonic-gate 	TRAP_TRACE_CTL	*ctlp;
4460Sstevel@tonic-gate 	caddr_t	newbuf;
4470Sstevel@tonic-gate #endif /* TRAPTRACE */
4480Sstevel@tonic-gate 
4490Sstevel@tonic-gate 	ASSERT(MUTEX_HELD(&cpu_lock));
4500Sstevel@tonic-gate 	ASSERT(cpu[cpuid] != NULL);
4510Sstevel@tonic-gate 
4520Sstevel@tonic-gate 	cp = cpu[cpuid];
4530Sstevel@tonic-gate 
4540Sstevel@tonic-gate 	/* Free cpu module private data structures, including scrubber. */
4550Sstevel@tonic-gate 	cpu_uninit_private(cp);
4560Sstevel@tonic-gate 
457414Skchow 	cpu_vm_data_destroy(cp);
458414Skchow 
4590Sstevel@tonic-gate 	/*
4600Sstevel@tonic-gate 	 * Remove CPU from list of available CPUs.
4610Sstevel@tonic-gate 	 */
4620Sstevel@tonic-gate 	cpu_del_unit(cpuid);
4630Sstevel@tonic-gate 
4640Sstevel@tonic-gate 	/*
4650Sstevel@tonic-gate 	 * Clean up the interrupt pool.
4660Sstevel@tonic-gate 	 */
4670Sstevel@tonic-gate 	cleanup_intr_pool(cp);
4680Sstevel@tonic-gate 
4690Sstevel@tonic-gate 	/*
4700Sstevel@tonic-gate 	 * At this point, the only threads bound to this CPU should be
4710Sstevel@tonic-gate 	 * special per-cpu threads: it's idle thread, it's pause thread,
4720Sstevel@tonic-gate 	 * and it's interrupt threads.  Clean these up.
4730Sstevel@tonic-gate 	 */
4740Sstevel@tonic-gate 	cpu_destroy_bound_threads(cp);
4750Sstevel@tonic-gate 
4760Sstevel@tonic-gate 	/*
4770Sstevel@tonic-gate 	 * Free the interrupt stack.
4780Sstevel@tonic-gate 	 */
4790Sstevel@tonic-gate 	segkp_release(segkp, cp->cpu_intr_stack);
4800Sstevel@tonic-gate 
481*1077Ssvemuri 	/*
482*1077Ssvemuri 	 * Free hv traptrace buffer for this CPU.
483*1077Ssvemuri 	 */
484*1077Ssvemuri 	mach_htraptrace_cleanup(cpuid);
4850Sstevel@tonic-gate #ifdef TRAPTRACE
4860Sstevel@tonic-gate 	/*
4870Sstevel@tonic-gate 	 * Free the traptrace buffer for this CPU.
4880Sstevel@tonic-gate 	 */
4890Sstevel@tonic-gate 	ctlp = &trap_trace_ctl[cpuid];
4900Sstevel@tonic-gate 	newbuf = ctlp->d.vaddr_base;
491*1077Ssvemuri 	i = (newbuf - ttrace_buf) / (TRAP_TSIZE);
492*1077Ssvemuri 	if (((newbuf - ttrace_buf) % (TRAP_TSIZE) == 0) &&
4930Sstevel@tonic-gate 	    ((i >= 0) && (i < (max_ncpus-1)))) {
4940Sstevel@tonic-gate 		/*
4950Sstevel@tonic-gate 		 * This CPU got it's trap trace buffer from the
4960Sstevel@tonic-gate 		 * boot-alloc'd bunch of them.
4970Sstevel@tonic-gate 		 */
4980Sstevel@tonic-gate 		trap_trace_inuse[i] = 0;
499*1077Ssvemuri 		bzero(newbuf, (TRAP_TSIZE));
5000Sstevel@tonic-gate 	} else if (newbuf == trap_tr0) {
5010Sstevel@tonic-gate 		trap_tr0_inuse = 0;
502*1077Ssvemuri 		bzero(trap_tr0, (TRAP_TSIZE));
5030Sstevel@tonic-gate 	} else {
5040Sstevel@tonic-gate 		cmn_err(CE_WARN, "failed to free trap trace buffer from cpu%d",
5050Sstevel@tonic-gate 		    cpuid);
5060Sstevel@tonic-gate 	}
5070Sstevel@tonic-gate 	bzero(ctlp, sizeof (*ctlp));
5080Sstevel@tonic-gate #endif /* TRAPTRACE */
5090Sstevel@tonic-gate 
5100Sstevel@tonic-gate 	/*
5110Sstevel@tonic-gate 	 * There is a race condition with mutex_vector_enter() which
5120Sstevel@tonic-gate 	 * caches a cpu pointer. The race is detected by checking cpu_next.
5130Sstevel@tonic-gate 	 */
5140Sstevel@tonic-gate 	disp_cpu_fini(cp);
5150Sstevel@tonic-gate 	cpu_pa[cpuid] = 0;
5160Sstevel@tonic-gate 	bzero(cp, sizeof (*cp));
5170Sstevel@tonic-gate 
5180Sstevel@tonic-gate 	/*
5190Sstevel@tonic-gate 	 * Place the freed cpu structure on the list of freed cpus.
5200Sstevel@tonic-gate 	 */
5210Sstevel@tonic-gate 	if (cp != &cpu0) {
5220Sstevel@tonic-gate 		if (cpus) {
5230Sstevel@tonic-gate 			cp->cpu_next_free = cpus;
5240Sstevel@tonic-gate 			cpus = cp;
5250Sstevel@tonic-gate 		}
5260Sstevel@tonic-gate 		else
5270Sstevel@tonic-gate 			cpus = cp;
5280Sstevel@tonic-gate 	}
5290Sstevel@tonic-gate 
5300Sstevel@tonic-gate 	return (0);
5310Sstevel@tonic-gate }
5320Sstevel@tonic-gate 
5330Sstevel@tonic-gate /*
5340Sstevel@tonic-gate  * This routine is used to start a previously powered off processor.
5350Sstevel@tonic-gate  * Note that restarted cpus are initialized into the offline state.
5360Sstevel@tonic-gate  */
5370Sstevel@tonic-gate void
5380Sstevel@tonic-gate restart_other_cpu(int cpuid)
5390Sstevel@tonic-gate {
5400Sstevel@tonic-gate 	struct cpu *cp;
5410Sstevel@tonic-gate 	kthread_id_t tp;
5420Sstevel@tonic-gate 	caddr_t	sp;
5430Sstevel@tonic-gate 	extern void idle();
5440Sstevel@tonic-gate 
5450Sstevel@tonic-gate 	ASSERT(MUTEX_HELD(&cpu_lock));
5460Sstevel@tonic-gate 	ASSERT(cpuid < NCPU && cpu[cpuid] != NULL);
5470Sstevel@tonic-gate 
5480Sstevel@tonic-gate 	/*
5490Sstevel@tonic-gate 	 * Obtain pointer to the appropriate cpu structure.
5500Sstevel@tonic-gate 	 */
5510Sstevel@tonic-gate 	cp = cpu[cpuid];
5520Sstevel@tonic-gate 
5530Sstevel@tonic-gate 	common_startup_init(cp, cpuid);
5540Sstevel@tonic-gate 
5550Sstevel@tonic-gate 	/*
5560Sstevel@tonic-gate 	 * idle thread t_lock is held when the idle thread is suspended.
5570Sstevel@tonic-gate 	 * Manually unlock the t_lock of idle loop so that we can resume
5580Sstevel@tonic-gate 	 * the suspended idle thread.
5590Sstevel@tonic-gate 	 * Also adjust the PC of idle thread for re-retry.
5600Sstevel@tonic-gate 	 */
5610Sstevel@tonic-gate 	cp->cpu_intr_actv = 0;	/* clear the value from previous life */
5620Sstevel@tonic-gate 	cp->cpu_m.mutex_ready = 0; /* we are not ready yet */
5630Sstevel@tonic-gate 	lock_clear(&cp->cpu_idle_thread->t_lock);
5640Sstevel@tonic-gate 	tp = cp->cpu_idle_thread;
5650Sstevel@tonic-gate 
5660Sstevel@tonic-gate 	sp = tp->t_stk;
5670Sstevel@tonic-gate 	tp->t_sp = (uintptr_t)((struct rwindow *)sp - 1) - STACK_BIAS;
5680Sstevel@tonic-gate 	tp->t_pc = (uintptr_t)idle - 8;
5690Sstevel@tonic-gate 
5700Sstevel@tonic-gate 	/*
5710Sstevel@tonic-gate 	 * restart the cpu now
5720Sstevel@tonic-gate 	 */
5730Sstevel@tonic-gate 	promsafe_pause_cpus();
5740Sstevel@tonic-gate 	start_cpu(cpuid, warm_flag_set);
5750Sstevel@tonic-gate 	start_cpus();
5760Sstevel@tonic-gate 
5770Sstevel@tonic-gate 	/* call cmn_err outside pause_cpus/start_cpus to avoid deadlock */
5780Sstevel@tonic-gate 	cmn_err(CE_CONT, "!cpu%d initialization complete - restarted\n",
5790Sstevel@tonic-gate 	    cpuid);
5800Sstevel@tonic-gate }
5810Sstevel@tonic-gate 
5820Sstevel@tonic-gate /*
5830Sstevel@tonic-gate  * Startup function executed on 'other' CPUs.  This is the first
5840Sstevel@tonic-gate  * C function after cpu_start sets up the cpu registers.
5850Sstevel@tonic-gate  */
5860Sstevel@tonic-gate static void
5870Sstevel@tonic-gate slave_startup(void)
5880Sstevel@tonic-gate {
5890Sstevel@tonic-gate 	struct cpu	*cp = CPU;
5900Sstevel@tonic-gate 	ushort_t	original_flags = cp->cpu_flags;
5910Sstevel@tonic-gate 
592*1077Ssvemuri 	mach_htraptrace_configure(cp->cpu_id);
5930Sstevel@tonic-gate 	cpu_intrq_register(CPU);
5940Sstevel@tonic-gate 	cp->cpu_m.mutex_ready = 1;
5950Sstevel@tonic-gate 	cp->cpu_m.poke_cpu_outstanding = B_FALSE;
5960Sstevel@tonic-gate 
5970Sstevel@tonic-gate 	/* acknowledge that we are done with initialization */
5980Sstevel@tonic-gate 	CPUSET_ADD(proxy_ready_set, cp->cpu_id);
5990Sstevel@tonic-gate 
6000Sstevel@tonic-gate 	/* synchronize STICK */
6010Sstevel@tonic-gate 	sticksync_slave();
6020Sstevel@tonic-gate 
6030Sstevel@tonic-gate 	if (boothowto & RB_DEBUG)
6040Sstevel@tonic-gate 		kdi_dvec_cpu_init(cp);
6050Sstevel@tonic-gate 
6060Sstevel@tonic-gate 	/*
6070Sstevel@tonic-gate 	 * the slave will wait here forever -- assuming that the master
6080Sstevel@tonic-gate 	 * will get back to us.  if it doesn't we've got bigger problems
6090Sstevel@tonic-gate 	 * than a master not replying to this slave.
6100Sstevel@tonic-gate 	 * the small delay improves the slave's responsiveness to the
6110Sstevel@tonic-gate 	 * master's ack and decreases the time window between master and
6120Sstevel@tonic-gate 	 * slave operations.
6130Sstevel@tonic-gate 	 */
6140Sstevel@tonic-gate 	while (!CPU_IN_SET(cpu_ready_set, cp->cpu_id))
6150Sstevel@tonic-gate 		DELAY(1);
6160Sstevel@tonic-gate 
6170Sstevel@tonic-gate 	/* enable interrupts */
6180Sstevel@tonic-gate 	(void) spl0();
6190Sstevel@tonic-gate 
6200Sstevel@tonic-gate 	/*
6210Sstevel@tonic-gate 	 * Signature block update to indicate that this CPU is in OS now.
6220Sstevel@tonic-gate 	 * This needs to be done after the PIL is lowered since on
6230Sstevel@tonic-gate 	 * some platforms the update code may block.
6240Sstevel@tonic-gate 	 */
6250Sstevel@tonic-gate 	CPU_SIGNATURE(OS_SIG, SIGST_RUN, SIGSUBST_NULL, cp->cpu_id);
6260Sstevel@tonic-gate 
6270Sstevel@tonic-gate 	/*
6280Sstevel@tonic-gate 	 * park the slave thread in a safe/quiet state and wait for the master
6290Sstevel@tonic-gate 	 * to finish configuring this CPU before proceeding to thread_exit().
6300Sstevel@tonic-gate 	 */
6310Sstevel@tonic-gate 	while (((volatile ushort_t)cp->cpu_flags) & CPU_QUIESCED)
6320Sstevel@tonic-gate 		DELAY(1);
6330Sstevel@tonic-gate 
6340Sstevel@tonic-gate 	/*
6350Sstevel@tonic-gate 	 * Initialize CPC CPU state.
6360Sstevel@tonic-gate 	 */
6370Sstevel@tonic-gate 	kcpc_hw_startup_cpu(original_flags);
6380Sstevel@tonic-gate 
6390Sstevel@tonic-gate 	/*
6400Sstevel@tonic-gate 	 * Notify the CMT subsystem that the slave has started
6410Sstevel@tonic-gate 	 */
6420Sstevel@tonic-gate 	chip_cpu_startup(CPU);
6430Sstevel@tonic-gate 
6440Sstevel@tonic-gate 	/*
6450Sstevel@tonic-gate 	 * Now we are done with the startup thread, so free it up.
6460Sstevel@tonic-gate 	 */
6470Sstevel@tonic-gate 	thread_exit();
6480Sstevel@tonic-gate 	cmn_err(CE_PANIC, "slave_startup: cannot return");
6490Sstevel@tonic-gate 	/*NOTREACHED*/
6500Sstevel@tonic-gate }
6510Sstevel@tonic-gate 
6520Sstevel@tonic-gate /*
6530Sstevel@tonic-gate  * 4163850 changes the allocation method for cpu structs. cpu structs
6540Sstevel@tonic-gate  * are dynamically allocated. This routine now determines if additional
6550Sstevel@tonic-gate  * per-cpu intr_req entries need to be allocated.
6560Sstevel@tonic-gate  */
6570Sstevel@tonic-gate int
6580Sstevel@tonic-gate ndata_alloc_cpus(struct memlist *ndata)
6590Sstevel@tonic-gate {
6600Sstevel@tonic-gate 	size_t real_sz;
6610Sstevel@tonic-gate 	extern int niobus;
6620Sstevel@tonic-gate 
6630Sstevel@tonic-gate 	if (niobus > 1) {
6640Sstevel@tonic-gate 
6650Sstevel@tonic-gate 		/*
6660Sstevel@tonic-gate 		 * Allocate additional intr_req entries if we have more than
6670Sstevel@tonic-gate 		 * one io bus.  The memory to allocate is calculated from four
6680Sstevel@tonic-gate 		 * variables: niobus, max_ncpus, intr_add_div, and intr_add_max.
6690Sstevel@tonic-gate 		 * Allocate multiple of INTR_POOL_SIZE bytes (512).  Each cpu
6700Sstevel@tonic-gate 		 * already reserves 512 bytes in its machcpu structure, so the
6710Sstevel@tonic-gate 		 * worst case is (512 * (niobus - 1) * max_ncpus) add'l bytes.
6720Sstevel@tonic-gate 		 *
6730Sstevel@tonic-gate 		 * While niobus and max_ncpus reflect the h/w, the following
6740Sstevel@tonic-gate 		 * may be tuned (before boot):
6750Sstevel@tonic-gate 		 *
6760Sstevel@tonic-gate 		 *	intr_add_div -	divisor for scaling the number of
6770Sstevel@tonic-gate 		 *			additional intr_req entries. use '1'
6780Sstevel@tonic-gate 		 *			for worst case memory, '2' for half,
6790Sstevel@tonic-gate 		 *			etc.
6800Sstevel@tonic-gate 		 *
6810Sstevel@tonic-gate 		 *   intr_add_max - upper limit on bytes of memory to reserve
6820Sstevel@tonic-gate 		 */
6830Sstevel@tonic-gate 
6840Sstevel@tonic-gate 		real_sz = INTR_POOL_SIZE * (niobus - 1) * max_ncpus;
6850Sstevel@tonic-gate 
6860Sstevel@tonic-gate 		/* tune memory usage by applying divisor and maximum */
6870Sstevel@tonic-gate 
6880Sstevel@tonic-gate 		if (intr_add_max == 0)
6890Sstevel@tonic-gate 			intr_add_max = max_ncpus * INTR_POOL_SIZE;
6900Sstevel@tonic-gate 		real_sz = MIN(intr_add_max, real_sz / MAX(intr_add_div, 1));
6910Sstevel@tonic-gate 
6920Sstevel@tonic-gate 		/* round down to multiple of (max_ncpus * INTR_POOL_SIZE) */
6930Sstevel@tonic-gate 
6940Sstevel@tonic-gate 		intr_add_pools = real_sz / (max_ncpus * INTR_POOL_SIZE);
6950Sstevel@tonic-gate 		real_sz = intr_add_pools * (max_ncpus * INTR_POOL_SIZE);
6960Sstevel@tonic-gate 
6970Sstevel@tonic-gate 		/* actually reserve the space */
6980Sstevel@tonic-gate 
6990Sstevel@tonic-gate 		intr_add_head = ndata_alloc(ndata, real_sz, ecache_alignsize);
7000Sstevel@tonic-gate 		if (intr_add_head == NULL)
7010Sstevel@tonic-gate 			return (-1);
7020Sstevel@tonic-gate 
7030Sstevel@tonic-gate 		PRM_DEBUG(intr_add_head);
7040Sstevel@tonic-gate #ifdef	DEBUG
7050Sstevel@tonic-gate 		intr_add_tail = (struct intr_req *)
7060Sstevel@tonic-gate 		    ((uintptr_t)intr_add_head + real_sz);
7070Sstevel@tonic-gate #endif	/* DEBUG */
7080Sstevel@tonic-gate 	}
7090Sstevel@tonic-gate 
7100Sstevel@tonic-gate 	return (0);
7110Sstevel@tonic-gate }
7120Sstevel@tonic-gate 
7130Sstevel@tonic-gate 
7140Sstevel@tonic-gate extern struct cpu	*cpu[NCPU];	/* pointers to all CPUs */
7150Sstevel@tonic-gate 
7160Sstevel@tonic-gate extern void setup_cpu_common(int);
7170Sstevel@tonic-gate extern void common_startup_init(cpu_t *, int);
7180Sstevel@tonic-gate extern void start_cpu(int, void(*func)(int));
7190Sstevel@tonic-gate extern void cold_flag_set(int cpuid);
7200Sstevel@tonic-gate 
7210Sstevel@tonic-gate /*
7220Sstevel@tonic-gate  * cpu_bringup_set is a tunable (via /etc/system, debugger, etc.) that
7230Sstevel@tonic-gate  * can be used during debugging to control which processors are brought
7240Sstevel@tonic-gate  * online at boot time.  The variable represents a bitmap of the id's
7250Sstevel@tonic-gate  * of the processors that will be brought online.  The initialization
7260Sstevel@tonic-gate  * of this variable depends on the type of cpuset_t, which varies
7270Sstevel@tonic-gate  * depending on the number of processors supported (see cpuvar.h).
7280Sstevel@tonic-gate  */
7290Sstevel@tonic-gate cpuset_t cpu_bringup_set;
7300Sstevel@tonic-gate 
7310Sstevel@tonic-gate 
7320Sstevel@tonic-gate /*
7330Sstevel@tonic-gate  * Generic start-all cpus entry.  Typically used during cold initialization.
7340Sstevel@tonic-gate  * Note that cold start cpus are initialized into the online state.
7350Sstevel@tonic-gate  */
7360Sstevel@tonic-gate /*ARGSUSED*/
7370Sstevel@tonic-gate void
7380Sstevel@tonic-gate start_other_cpus(int flag)
7390Sstevel@tonic-gate {
7400Sstevel@tonic-gate 	int cpuid;
7410Sstevel@tonic-gate 	extern void idlestop_init(void);
7420Sstevel@tonic-gate 	int bootcpu;
7430Sstevel@tonic-gate 
7440Sstevel@tonic-gate 	/*
7450Sstevel@tonic-gate 	 * Check if cpu_bringup_set has been explicitly set before
7460Sstevel@tonic-gate 	 * initializing it.
7470Sstevel@tonic-gate 	 */
7480Sstevel@tonic-gate 	if (CPUSET_ISNULL(cpu_bringup_set)) {
7490Sstevel@tonic-gate #ifdef MPSAS
7500Sstevel@tonic-gate 		/* just CPU 0 */
7510Sstevel@tonic-gate 		CPUSET_ADD(cpu_bringup_set, 0);
7520Sstevel@tonic-gate #else
7530Sstevel@tonic-gate 		CPUSET_ALL(cpu_bringup_set);
7540Sstevel@tonic-gate #endif
7550Sstevel@tonic-gate 	}
7560Sstevel@tonic-gate 
7570Sstevel@tonic-gate 	if (&cpu_feature_init)
7580Sstevel@tonic-gate 		cpu_feature_init();
7590Sstevel@tonic-gate 
7600Sstevel@tonic-gate 	/*
7610Sstevel@tonic-gate 	 * Initialize CPC.
7620Sstevel@tonic-gate 	 */
7630Sstevel@tonic-gate 	kcpc_hw_init();
7640Sstevel@tonic-gate 
7650Sstevel@tonic-gate 	mutex_enter(&cpu_lock);
7660Sstevel@tonic-gate 
7670Sstevel@tonic-gate 	/*
7680Sstevel@tonic-gate 	 * Initialize our own cpu_info.
7690Sstevel@tonic-gate 	 */
7700Sstevel@tonic-gate 	init_cpu_info(CPU);
7710Sstevel@tonic-gate 
7720Sstevel@tonic-gate 	/*
7730Sstevel@tonic-gate 	 * Initialize CPU 0 cpu module private data area, including scrubber.
7740Sstevel@tonic-gate 	 */
7750Sstevel@tonic-gate 	cpu_init_private(CPU);
7760Sstevel@tonic-gate 
7770Sstevel@tonic-gate 	/*
7780Sstevel@tonic-gate 	 * perform such initialization as is needed
7790Sstevel@tonic-gate 	 * to be able to take CPUs on- and off-line.
7800Sstevel@tonic-gate 	 */
7810Sstevel@tonic-gate 	cpu_pause_init();
7820Sstevel@tonic-gate 	xc_init();		/* initialize processor crosscalls */
7830Sstevel@tonic-gate 	idlestop_init();
7840Sstevel@tonic-gate 
7850Sstevel@tonic-gate 	if (!use_mp) {
7860Sstevel@tonic-gate 		mutex_exit(&cpu_lock);
7870Sstevel@tonic-gate 		cmn_err(CE_CONT, "?***** Not in MP mode\n");
7880Sstevel@tonic-gate 		return;
7890Sstevel@tonic-gate 	}
7900Sstevel@tonic-gate 	/*
7910Sstevel@tonic-gate 	 * should we be initializing this cpu?
7920Sstevel@tonic-gate 	 */
7930Sstevel@tonic-gate 	bootcpu = getprocessorid();
7940Sstevel@tonic-gate 
7950Sstevel@tonic-gate 	/*
7960Sstevel@tonic-gate 	 * launch all the slave cpus now
7970Sstevel@tonic-gate 	 */
7980Sstevel@tonic-gate 	for (cpuid = 0; cpuid < NCPU; cpuid++) {
799789Sahrens 		pnode_t nodeid = cpunodes[cpuid].nodeid;
8000Sstevel@tonic-gate 
801789Sahrens 		if (nodeid == (pnode_t)0)
8020Sstevel@tonic-gate 			continue;
8030Sstevel@tonic-gate 
8040Sstevel@tonic-gate 		if (cpuid == bootcpu) {
8050Sstevel@tonic-gate 			if (!CPU_IN_SET(cpu_bringup_set, cpuid)) {
8060Sstevel@tonic-gate 				cmn_err(CE_WARN, "boot cpu not a member "
8070Sstevel@tonic-gate 				    "of cpu_bringup_set, adding it");
8080Sstevel@tonic-gate 				CPUSET_ADD(cpu_bringup_set, cpuid);
8090Sstevel@tonic-gate 			}
8100Sstevel@tonic-gate 			continue;
8110Sstevel@tonic-gate 		}
8120Sstevel@tonic-gate 		if (!CPU_IN_SET(cpu_bringup_set, cpuid))
8130Sstevel@tonic-gate 			continue;
8140Sstevel@tonic-gate 
8150Sstevel@tonic-gate 		ASSERT(cpu[cpuid] == NULL);
8160Sstevel@tonic-gate 
8170Sstevel@tonic-gate 		setup_cpu_common(cpuid);
8180Sstevel@tonic-gate 
8190Sstevel@tonic-gate 		common_startup_init(cpu[cpuid], cpuid);
8200Sstevel@tonic-gate 
8210Sstevel@tonic-gate 		start_cpu(cpuid, cold_flag_set);
8220Sstevel@tonic-gate 		/*
8230Sstevel@tonic-gate 		 * Because slave_startup() gets fired off after init()
8240Sstevel@tonic-gate 		 * starts, we can't use the '?' trick to do 'boot -v'
8250Sstevel@tonic-gate 		 * printing - so we always direct the 'cpu .. online'
8260Sstevel@tonic-gate 		 * messages to the log.
8270Sstevel@tonic-gate 		 */
8280Sstevel@tonic-gate 		cmn_err(CE_CONT, "!cpu%d initialization complete - online\n",
8290Sstevel@tonic-gate 		    cpuid);
8300Sstevel@tonic-gate 
8310Sstevel@tonic-gate 		/*
8320Sstevel@tonic-gate 		 * XXX: register_cpu_setup() callbacks should be called here
8330Sstevel@tonic-gate 		 * with a new setup code, CPU_BOOT (or something).
8340Sstevel@tonic-gate 		 */
8350Sstevel@tonic-gate 		if (dtrace_cpu_init != NULL)
8360Sstevel@tonic-gate 			(*dtrace_cpu_init)(cpuid);
8370Sstevel@tonic-gate 	}
8380Sstevel@tonic-gate 
8390Sstevel@tonic-gate 	/*
8400Sstevel@tonic-gate 	 * since all the cpus are online now, redistribute interrupts to them.
8410Sstevel@tonic-gate 	 */
8420Sstevel@tonic-gate 	intr_redist_all_cpus();
8430Sstevel@tonic-gate 
8440Sstevel@tonic-gate 	mutex_exit(&cpu_lock);
8450Sstevel@tonic-gate 
8460Sstevel@tonic-gate 	/*
8470Sstevel@tonic-gate 	 * Start the Ecache scrubber.  Must be done after all calls to
8480Sstevel@tonic-gate 	 * cpu_init_private for every cpu (including CPU 0).
8490Sstevel@tonic-gate 	 */
8500Sstevel@tonic-gate 	cpu_init_cache_scrub();
8510Sstevel@tonic-gate 
8520Sstevel@tonic-gate 	if (&cpu_mp_init)
8530Sstevel@tonic-gate 		cpu_mp_init();
8540Sstevel@tonic-gate }
855