/*
* ========== Copyright Header Begin ==========================================
* 
* OpenSPARC T2 Processor File: tso_n1_cross_mod5.s
* Copyright (C) 1995-2007 Sun Microsystems, Inc. All Rights Reserved
* 4150 Network Circle, Santa Clara, California 95054, U.S.A.
*
* DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER. 
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; version 2 of the License.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
*
* For the avoidance of doubt, and except that if any non-GPL license 
* choice is available it will apply instead, Sun elects to use only 
* the General Public License version 2 (GPLv2) at this time for any 
* software where a choice of GPL license versions is made 
* available with the language indicating that GPLv2 or any later version 
* may be used, or where a choice of which version of the GPL is applied is 
* otherwise unspecified. 
*
* Please contact Sun Microsystems, Inc., 4150 Network Circle, Santa Clara, 
* CA 95054 USA or visit www.sun.com if you need additional information or 
* have any questions. 
*
* 
* ========== Copyright Header End ============================================
*/
#define MAIN_BASE_DATA_ADDR     0x160000
#define MAIN_BASE_TEXT_ADDR  	0x150000
#define MAIN_BASE_DATA_ADDR_RA	0x100160000
#define MAIN_BASE_TEXT_ADDR_RA	0x100150000

#define USER_PAGE_CUSTOM_MAP
#include "hboot.s"

SECTION .MAIN  TEXT_VA=0x150000, DATA_VA=0x160000

attr_text {
        Name = .MAIN,
        VA=MAIN_BASE_TEXT_ADDR,
        RA=MAIN_BASE_TEXT_ADDR_RA,
        PA=ra2pa(MAIN_BASE_TEXT_ADDR_RA,0),
part_0_ctx_nonzero_tsb_config_0,
        TTE_G=0, TTE_Context=PCONTEXT, TTE_V=1, TTE_Size=0, TTE_NFO=0,
        TTE_IE=0, TTE_Soft2=0, TTE_Diag=0, TTE_Soft=0,
        TTE_L=0, TTE_CP=1, TTE_CV=1, TTE_E=0, TTE_EP=1, TTE_P=0, TTE_W=1
        }

attr_data {
        Name = .MAIN,
        VA=MAIN_BASE_DATA_ADDR,
        RA=MAIN_BASE_DATA_ADDR_RA,
        PA=ra2pa(MAIN_BASE_DATA_ADDR_RA,0),
part_0_ctx_nonzero_tsb_config_0,
        TTE_G=0, TTE_Context=PCONTEXT, TTE_V=1, TTE_Size=0, TTE_NFO=0,
        TTE_IE=0, TTE_Soft2=0, TTE_Diag=0, TTE_Soft=0,
        TTE_L=0, TTE_CP=1, TTE_CV=1, TTE_E=0, TTE_P=0, TTE_W=1
        }

.text
.global main
main:	
	clr	%l0

	th_fork(th_main,%l0)


! this thread modfifies the code
!===============================
th_main_0:

	set	0x40, %i7		! loop counting

	setx 	ready, 	  %l0, %l1	! pointers...
	setx 	noop, 	  %l0, %l2
	ld	[%l2], %o7		! %o7 contains the nop command

deliver_loop:

	setx 	modified1, %l0, %l3	!
deliver_loop1:
        ld      [%l1], %o0    		! read ready.
	tst	%o0			! should be 0.
	bne	deliver_loop1
	nop

	st	%o7, [%l3]		! modify the code.
	st	%o7, [%l3 + 4]		! and then flush.
	flush	%l3			! the register value does not matter

	setx 	modified2, %l0, %l3	!
deliver_loop2:
        ld      [%l1 + 0x4], %o0	! read ready.
	tst	%o0			! should be 0.
	bne	deliver_loop2
	nop

	st	%o7, [%l3]		! modify the code.
	st	%o7, [%l3 + 4]		! and then flush.
	flush	%l3			! the register value does not matter

	setx 	modified3, %l0, %l3	!
deliver_loop3:
        ld      [%l1 + 0x8], %o0	! read ready.
	tst	%o0			! should be 0.
	bne	deliver_loop3
	nop

	st	%o7, [%l3]		! modify the code.
	st	%o7, [%l3 + 4]		! and then flush.
	flush	%l3			! the register value does not matter

	deccc	%i7			! count
	bne	goon
	nop
	ba	final_stuff		! go to end if finished
	nop

goon:
	set	1, %i0			! set ready
	st	%i0, [%l1]		! 
	st	%i0, [%l1+4]		! 
	st	%i0, [%l1+8]		! 
	ba	deliver_loop		! repeat
	nop
	
final_stuff:
	set	0x1, %i0		! 55 means we are done.
	st	%i0, [%l1]		! 
	st	%i0, [%l1+4]		! 
	set	0x55, %i0		! 55 means we are done.
	st	%i0, [%l1+8]		! 
	ba	good_end
	nop

! these are the receivers
!------------------------
th_main_1:
th_main_4:

	setx 	ready, %l0, %l1		! pointers...
	setx 	bad_end, %l0, %l2
	ld	[%l2], %o7		! o7 contains a ta 0x101

wait_loop:				! wait for ready flag
wait_loop1:				! wait for ready flag
        ld      [%l1], %o0    
        subcc   %o0, 0x1, %i1        	! code for available data
        bne	wait_loop1
	nop
	nop
modified1:
	ta	T_BAD_TRAP		! this data is overwritten
	ta	T_BAD_TRAP		! with nop-s, so diag goes on.

wait_loop2:				! wait for ready flag
        ld      [%l1+0x4], %o0    
        subcc   %o0, 0x1, %i1      	! check for end of test flag.
        bne	wait_loop2
	nop
	nop
modified2:
	ta	T_BAD_TRAP		! this data is overwritten
	ta	T_BAD_TRAP		! with nop-s, so diag goes on.

wait_loop3:				! wait for ready flag
        ld      [%l1+0x8], %o0    
        subcc   %o0, 0x55, %i1      	! check for end of test flag.
        be      good_end   		! end the test
        nop
        subcc   %o0, 0x1, %i1        	! code for available data
        bne	wait_loop3
	nop
	nop
modified3:
	ta	T_BAD_TRAP		! this data is overwritten
	ta	T_BAD_TRAP		! with nop-s, so diag goes on.

	setx 	modified1, %l0, %l3
	st	%o7, [%l3]		! now overwrite again to  ta T_BAD_TRAP
	st	%o7, [%l3 + 4]
	setx 	modified2, %l0, %l3
	st	%o7, [%l3]		! now overwrite again to  ta T_BAD_TRAP
	st	%o7, [%l3 + 4]
	setx 	modified3, %l0, %l3
	st	%o7, [%l3]		! now overwrite again to  ta T_BAD_TRAP
	st	%o7, [%l3 + 4]

	st	%g0, [%l1]		! reset the flags
	st	%g0, [%l1 + 4]
	st	%g0, [%l1 + 8]

        ba      wait_loop		! do it again
        nop
 
good_end:
        ta      T_GOOD_TRAP
bad_end:
        ta      T_BAD_TRAP
noop:
	nop

!------------------------------------------------------------------------------

.data
.global ready
ready:
        .word   0x0
        .word   0x0
        .word   0x0
        .word   0x0
        
.end