\ ========== Copyright Header Begin ==========================================
\ 
\ Hypervisor Software File: hslave.fth
\ 
\ Copyright (c) 2006 Sun Microsystems, Inc. All Rights Reserved.
\ 
\  - Do no alter or remove copyright notices
\ 
\  - Redistribution and use of this software in source and binary forms, with 
\    or without modification, are permitted provided that the following 
\    conditions are met: 
\ 
\  - Redistribution of source code must retain the above copyright notice, 
\    this list of conditions and the following disclaimer.
\ 
\  - Redistribution in binary form must reproduce the above copyright notice,
\    this list of conditions and the following disclaimer in the
\    documentation and/or other materials provided with the distribution. 
\ 
\    Neither the name of Sun Microsystems, Inc. or the names of contributors 
\ may be used to endorse or promote products derived from this software 
\ without specific prior written permission. 
\ 
\     This software is provided "AS IS," without a warranty of any kind. 
\ ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND WARRANTIES, 
\ INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY, FITNESS FOR A 
\ PARTICULAR PURPOSE OR NON-INFRINGEMENT, ARE HEREBY EXCLUDED. SUN 
\ MICROSYSTEMS, INC. ("SUN") AND ITS LICENSORS SHALL NOT BE LIABLE FOR 
\ ANY DAMAGES SUFFERED BY LICENSEE AS A RESULT OF USING, MODIFYING OR 
\ DISTRIBUTING THIS SOFTWARE OR ITS DERIVATIVES. IN NO EVENT WILL SUN 
\ OR ITS LICENSORS BE LIABLE FOR ANY LOST REVENUE, PROFIT OR DATA, OR 
\ FOR DIRECT, INDIRECT, SPECIAL, CONSEQUENTIAL, INCIDENTAL OR PUNITIVE 
\ DAMAGES, HOWEVER CAUSED AND REGARDLESS OF THE THEORY OF LIABILITY, 
\ ARISING OUT OF THE USE OF OR INABILITY TO USE THIS SOFTWARE, EVEN IF 
\ SUN HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH DAMAGES.
\ 
\ You acknowledge that this software is not designed, licensed or
\ intended for use in the design, construction, operation or maintenance of
\ any nuclear facility. 
\ 
\ ========== Copyright Header End ============================================
id: @(#)hslave.fth 1.3 07/05/04
purpose:
copyright: Copyright 2007 Sun Microsystems, Inc.  All Rights Reserved
copyright: Use is subject to license terms.

headerless

label start-slave-cpus
   \ Turn OFF everything except for PRIV bit in %pstate

   %g0  h# f			wrpil
   %g0  4			wrpstate
   %i0		      %g1	move
   %i1		      %g2	move
   %g0  0			wrtba
   \ XXX %g0  0		%r22	wrasr	\ Clear SoftInt Reg.
   %g0  7			wrcleanwin
   %g0  0			wrotherwin
   %g0  0			wrwstate
   %g0  0			wrcanrestore
   %g0  6			wrcansave
   %g0  0			wrcwp
   %g1			%i0	move
   %g2			%i1	move
   %g0  0			wrtl	\ TL = 0
   %g0  0                       wrgl

   %g0  h# 16		%o5	add
   %g0  0 always		htrapif
   %g0  h# 20			wrasi
   %o1  %g0 h# 08  %asi		stxa	\ MID in scratchpad1

   %i1			%o1	move	\ Size of Memory
   setup-i/d-tlbs		call
   %i0			%o0	move	\ Base of Memory

   \ ick ick
   \ need a PA, so we reverse engineer one
   \ this needs to move to 'reset'..
   mmu-info >mmu-miss-pa rombase + 4meg 1- land %o0 set \ relative to start
   %i0  %o0 memory-asi	%o0	ldxa	\ PA
   %o1				get-mid
   %o1  /mmu-miss-area log2 %o1	sllx
   %o0  %o1		%o0	add
   %g0  h# 30		%o1	add
   %o0  %g0  %o1 h# 20		stxa	\ Scratch6, MISS AREA PA
   mmu-miss-area-func#	%o5	set
   %g0 fast-trap# always	htrapif	\ set it

   \ Set the base register
   ROMbase              base    set

   \ Set %tba register
   base			%g0	wrtba

   %g0 1                %o0  add	\ MMU On
   %g0 mmu-on-off-func# %o5  add
   here origin - 	%g4  set
   base  %g4		%g4  add
   %g4 h# 18            %o1  add	\ Return PC
   %g0 fast-trap#    always  htrapif
   nop

   \ Set up register
   prom-main-task	up	set

   release-slaves? origin- scr set
   scr  base		scr	add
   scr  %g0		sc2	ld
   begin
      sc2  %g0	%g0	subcc
   0<> until
      scr  %g0	sc2	ld

   scr			rdpstate
   scr  h# 16	scr	or
   scr  0			wrpstate

   \ can clear post-run magic in %i5
   %g0		%i5	move

   \ Enter the initial idle loop
   slave-init		always brif
   nop
end-code

1 4 h# 10 0 hypercall: hyper-startcpu
: idle-slaves ( -- )
   0 tba@ >physical drop		( 0 tba )
   start-slave-cpus origin- over +	( 0 tba pc )
   max-#cpus 0  do			( 0 tba pc )
      mid@ i <>  if			( 0 tba pc )
	 \ Start CPU only if there is a node for it in MD
	 i mid-ok? if			( 0 tba pc )
            0 i >cpu-struct >cpu-status ! ( 0 tba pc )
            3dup i hyper-startcpu	( 0 tba pc status )
	    0= if			( 0 tba pc )
	       \ Give a second for the CPU to park in slave loop
	       get-msecs d# 1000 + begin ( 0 tba pc msecs )
	          get-msecs over <	( 0 tba pc msecs timeout? )
	          i >cpu-struct >cpu-status @ 0= and ( 0 tba pc msecs ok? )
	          while 10 ms 		( 0 tba pc msecs )
	       repeat drop		( 0 tba pc )
	    then			( 0 tba pc )
	 then				( 0 tba pc )
      then				( 0 tba pc )
   loop	 3drop				(  )
;

stand-init: Kicking slave CPU(s) into idle loop
   init-per-cpu-data
   ['] init-per-cpu-data is slave-idle-loop-hook
   idle-slaves
;

headers