/*
* ========== Copyright Header Begin ==========================================
* 
* OpenSPARC T2 Processor File: tso_n1_prod_cons1_pio.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 JBI_CONFIG
#define MAIN_PAGE_HV_ALSO
#define spinlock_addr_reg  		%o0
#define data_base_reg	  		%o1
#define my_id_reg	  		%o3
#define test_reg	  		%o4
#define global_cnt_reg	  		%o5
#define tmp1	  			%l1

#define ITERATIONS 	  		0x2

#include "hboot.s"

.global main

main:
ta T_CHANGE_HPRIV
nop

	setx    spinlock_address, %l0, spinlock_addr_reg	! spinlock address
        set     ITERATIONS,	global_cnt_reg 			! 

th_fork(th_main,%l0)

! Some of the threads are producers, some are consumers
! A pair of producer and consumer has the same ID.
!=====================================================
th_main_0:
        add     %g0, 0x8, my_id_reg			! this is my ID address
	ba	producer
	nop

th_main_1:
        add     %g0, 0x8, my_id_reg
	ba	consumer
	nop

th_main_2:
        add     %g0, 0x38, my_id_reg
	ba	producer
	nop
	!ba good_end
	!nop

th_main_3:
        add     %g0, 0x3c, my_id_reg
	ba	consumer
	nop
	!ba good_end
	!nop

th_main_4:
        add     %g0, 0x38, my_id_reg
	ba	consumer
	nop
	!ba good_end
	!nop

th_main_5:
        add     %g0, 0x3c, my_id_reg
	ba	producer
	nop
	!ba good_end
	!nop

th_main_6:
	ba good_end
	nop

th_main_7:
	ba good_end
	nop

!====================================================================================
producer:
        ld    	[spinlock_addr_reg + my_id_reg], test_reg	! try to acquire lock
        tst     test_reg                       			! did we get it?
        be      producer_gotlock
        nop
	ba	producer
	nop

!====================================================================================
consumer:
        ld    	[spinlock_addr_reg + my_id_reg], test_reg	! try to acquire lock
	sub	test_reg, 0x55, %i1				! code to end the test
	tst	%i1	
	be	good_end					! end the test
	nop
	sub	test_reg, 0x1, %i1				! code for available data
	tst	%i1	
	be	consumer_gotlock
	nop
	ba	consumer
	nop


!====================================================================================
producer_gotlock:
	set 	0x60, %l0
	setx 	protected_area, tmp1, data_base_reg
producer_loop0:
	st 	%g0, [data_base_reg + my_id_reg] 	! clean up
	add	data_base_reg, 0x40, data_base_reg 	! increment the address
	deccc	%l0
	bne 	producer_loop0				! repeat
	nop

	set 	0x60, %l0
	setx 	protected_area, tmp1, data_base_reg
	mov 	my_id_reg, %i1 
producer_loop1:
	st 	%i1, [data_base_reg + my_id_reg] 	! store my ID in there
	add	data_base_reg, 0x40, data_base_reg 	! increment the address
	add	%i1, 1, %i1
	deccc	%l0
	bne 	producer_loop1				! repeat
	nop

	deccc	global_cnt_reg
        be	cleanup_and_finish
	nop
	add	%g0, 1 , tmp1
        st      tmp1, [spinlock_addr_reg + my_id_reg]    ! data ready
	ba	producer
	nop

cleanup_and_finish:
	add	%g0, 0x55 , tmp1
        st      tmp1, [spinlock_addr_reg + my_id_reg]    ! finish the test
	ba good_end
	nop

!====================================================================================
consumer_gotlock:
	set 	0x60, %l0
	setx 	protected_area, tmp1, data_base_reg
	mov 	my_id_reg, %i1 
consumer_loop1:
	ld 	[data_base_reg + my_id_reg], %i2 	! load my ID in there
	subcc 	%i2, %i1, %i2
	bne	bad_end
	nop
	add	data_base_reg, 0x40, data_base_reg 	! increment the address
	inc	%i1
	deccc	%l0
	bne 	consumer_loop1				! repeat
	nop

        st      %g0, [spinlock_addr_reg+ my_id_reg]	! consumer ready

	ba	consumer
	nop

good_end:
        ta      T_GOOD_TRAP
bad_end:
        ta      T_BAD_TRAP

!==========================

SECTION .MY_DATA0  DATA_VA=0xd0100000
attr_data {
        Name = .MY_DATA0,
        VA= 0x0d0100000,
        RA=0xc000000000,
        PA=0xc000000000,
        part_0_ctx_nonzero_tsb_config_0,
        TTE_G=1, TTE_Context=0x44, 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=0, TTE_CV=0, TTE_E=0, TTE_P=0, TTE_W=1
        }

	.data

.global spinlock_address
spinlock_address:
	.skip 0x1000


SECTION .MY_DATA1  DATA_VA=0xd1110000
attr_data {
        Name = .MY_DATA1,
        VA= 0x0d1110000,
        RA=0xc200bee000,
        PA=0xc200bee000,
        part_0_ctx_nonzero_tsb_config_1,
        TTE_G=1, TTE_Context=0x44, 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=0, TTE_CV=0, TTE_E=0, TTE_P=0, TTE_W=1
        }

	.data
.global protected_area
protected_area:
	.word	0xbeef
	.skip 0x1000
	.word	0xbeef
.end