verif/diag/assembly/arch/prm/tso/tso_directed/tso_n1_mutex2_ldstub.s

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

#define TIMEOUT                         0x2000
#define ITERATIONS                      0x2

#if defined CREGS_LSU_CTL_REG_DC  && CREGS_LSU_CTL_REG_DC == 0
#define TIMEOUT                         0x4000
#define ITERATIONS                      0x1
#endif

#if defined CREGS_LSU_CTL_REG_IC  && CREGS_LSU_CTL_REG_IC == 0
#define TIMEOUT                         0x4000
#define ITERATIONS                      0x1
#endif

#if defined CREGS_L2_CTL_REG_DIS  && CREGS_L2_CTL_REG_DIS == 1
#define TIMEOUT                         0x4000
#define ITERATIONS                      0x1
#endif


#include "hboot.s"

.global main

main:
        setx    spinlock_address, %l0, spinlock_addr_reg ! spinlock address
        set     TIMEOUT,        to_reg                   ! set timeout count
        set     ITERATIONS,     global_cnt_reg

        or      spinlock_addr_reg, %g0, my_id_reg

th_fork(th_main,%l0)

th_main_0:
        add     my_id_reg, 0x20, my_id_reg              !  my ID address
        stb     %g0, [my_id_reg]                        ! clear it
        ba      getlock
        nop

th_main_1:
        add     my_id_reg, 0x24, my_id_reg
        stb     %g0, [my_id_reg]
        ba      getlock
        nop


th_main_2:
        add     my_id_reg, 0x28, my_id_reg
        stb     %g0, [my_id_reg]
        ba      getlock
        nop

th_main_3:
        add     my_id_reg, 0x2c, my_id_reg
        stb     %g0, [my_id_reg]
        ba      getlock
        nop

th_main_4:
        add     my_id_reg, 0x30, my_id_reg
        stb     %g0, [my_id_reg]
        ba      getlock
        nop

th_main_5:
        add     my_id_reg, 0x34, my_id_reg
        stb     %g0, [my_id_reg]
        ba      getlock
        nop

th_main_6:
        add     my_id_reg, 0x38, my_id_reg
        stb     %g0, [my_id_reg]
        ba      getlock
        nop

th_main_7:
        add     my_id_reg, 0x3c, my_id_reg
        stb     %g0, [my_id_reg]
        ba      getlock
        nop

getlock:
        deccc   to_reg                                  ! dec timeout count
        be      bad_end                                 ! branch if no timeout
        nop
        or      %g0, my_id_reg, test_reg                ! ldstub
        ldstub  [spinlock_addr_reg], test_reg           ! try to acquire lock
        tst     test_reg                                ! did we get it?
        bne     getlock
        nop

gotlock:                                                ! do something
        set     TIMEOUT, to_reg                         ! set to count again
        setx    protected_area, %l0, data_base_reg

        set     100, %l0
        add     %l0, my_id_reg, %l0                     ! initial value
        stx     %l0, [data_base_reg]                    ! store my ID in there
        set     200, %l0
        add     %l0, my_id_reg, %l0                     ! initial value
        stx     %l0, [data_base_reg+8]                  ! store my ID in there
        set     300, %l0
        add     %l0, my_id_reg, %l0                     ! initial value
        stx     %l0, [data_base_reg+16]                 ! store my ID in there
        set     400, %l0
        add     %l0, my_id_reg, %l0                     ! initial value
        stx     %l0, [data_base_reg+24]                 ! store my ID in there
        set     500, %l0
        add     %l0, my_id_reg, %l0                     ! initial value
        stx     %l0, [data_base_reg+32]                 ! store my ID in there
        set     600, %l0
        add     %l0, my_id_reg, %l0                     ! initial value
        stx     %l0, [data_base_reg+40]                 ! store my ID in there
        set     700, %l0
        add     %l0, my_id_reg, %l0                     ! initial value
        stx     %l0, [data_base_reg+48]                 ! store my ID in there
        set     800, %l0
        add     %l0, my_id_reg, %l0                     ! initial value
        stx     %l0, [data_base_reg+56]                 ! store my ID in there
        set     900, %l0
        add     %l0, my_id_reg, %l0                     ! initial value
        stx     %l0, [data_base_reg+64]                 ! store my ID in there

        set     20, %l0
loop1:
        ldx     [data_base_reg],    %i0                 ! read the data area
        add     %i0, 1, %i0
        stx     %i0, [data_base_reg]                    ! store my ID in there
        ldx     [data_base_reg+8],  %i0                 ! read the data area
        add     %i0, 1, %i0
        stx     %i0, [data_base_reg+8]                  ! store my ID in there
        ldx     [data_base_reg+16], %i0                 ! read the data area
        add     %i0, 1, %i0
        stx     %i0, [data_base_reg+16]                 ! store my ID in there
        ldx     [data_base_reg+24], %i0                 ! read the data area
        add     %i0, 1, %i0
        stx     %i0, [data_base_reg+24]                 ! store my ID in there
        ldx     [data_base_reg+32], %i0                 ! read the data area
        add     %i0, 1, %i0
        stx     %i0, [data_base_reg+32]                 ! store my ID in there
        ldx     [data_base_reg+40], %i0                 ! read the data area
        add     %i0, 1, %i0
        stx     %i0, [data_base_reg+40]                 ! store my ID in there
        ldx     [data_base_reg+48], %i0                 ! read the data area
        add     %i0, 1, %i0
        stx     %i0, [data_base_reg+48]                 ! store my ID in there
        ldx     [data_base_reg+56], %i0                 ! read the data area
        add     %i0, 1, %i0
        stx     %i0, [data_base_reg+56]                 ! store my ID in there
        ldx     [data_base_reg+64], %i0                 ! read the data area
        add     %i0, 1, %i0
        stx     %i0, [data_base_reg+64]                 ! store my ID in there

        deccc   %l0
        bne     loop1                                   ! repeat
        nop

        set     120, %l0
        add     %l0, my_id_reg, %i0                     ! initial value
        ldx     [data_base_reg], tmp1                   ! read the data area
        subcc   tmp1, %i0, %g0
        bne     bad_end
        nop

        set     220, %l0
        add     %l0, my_id_reg, %i0                     ! initial value
        ldx     [data_base_reg+8], tmp1                 ! read the data area
        subcc   tmp1, %i0, %g0
        bne     bad_end
        nop

        set     320, %l0
        add     %l0, my_id_reg, %i0                     ! initial value
        ldx     [data_base_reg+16], tmp1                ! read the data area
        subcc   tmp1, %i0, %g0
        bne     bad_end
        nop

        set     420, %l0
        add     %l0, my_id_reg, %i0                     ! initial value
        ldx     [data_base_reg+24], tmp1                ! read the data area
        subcc   tmp1, %i0, %g0
        bne     bad_end
        nop


        set     520, %l0
        add     %l0, my_id_reg, %i0                     ! initial value
        ldx     [data_base_reg+32], tmp1                ! read the data area
        subcc   tmp1, %i0, %g0
        bne     bad_end
        nop

        set     620, %l0
        add     %l0, my_id_reg, %i0                     ! initial value
        ldx     [data_base_reg+40], tmp1                ! read the data area
        subcc   tmp1, %i0, %g0
        bne     bad_end
        nop

        set     720, %l0
        add     %l0, my_id_reg, %i0                     ! initial value
        ldx     [data_base_reg+48], tmp1                ! read the data area
        subcc   tmp1, %i0, %g0
        bne     bad_end
        nop

        set     820, %l0
        add     %l0, my_id_reg, %i0                     ! initial value
        ldx     [data_base_reg+56], tmp1                ! read the data area
        subcc   tmp1, %i0, %g0
        bne     bad_end
        nop

        set     920, %l0
        add     %l0, my_id_reg, %i0                     ! initial value
        ldx     [data_base_reg+64], tmp1                ! read the data area
        subcc   tmp1, %i0, %g0
        bne     bad_end
        nop

clearlock:
        stb        %g0, [spinlock_addr_reg]            ! unlock

check_done:
        deccc   global_cnt_reg
        be      good_end
        nop
        ba      getlock
        nop

good_end:
        ta      T_GOOD_TRAP
bad_end:
        ta      T_BAD_TRAP

!==========================
        .data

user_data_start:

        .skip   0x20
.align  0x8
spinlock_address:
        .word   0x0
        .skip   0x800
.align  0x8
protected_area:
        .word   0xbeef
        .skip 0x1000
        .word   0xbeef