Initial commit of OpenSPARC T2 design and verification files.

[OpenSPARC-T2-DV] / verif / diag / assembly / include / tlu_htraps_ext.s

/*
* ========== Copyright Header Begin ==========================================
* 
* OpenSPARC T2 Processor File: tlu_htraps_ext.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 ============================================
*/
resolve_bad_tte:
   !if pc[63:15] matches tba, then relocated handler ..
   rdpr %tpc, %r4
check_tba:
   set 0x7fff, %r5
   andn %r4, %r5, %r5         !clear 14:0
   rdpr %tba, %r6             !compare pc[63:15]  to tba
   cmp %r5, %r6
   bne,a not_a_reloc_handler
   andn %r27, 0x1f, %r6
retry_with_base_tba:
   best_set_reg(TRAP_BASE_VA, %r3, %r5)
   cmp %r4, %r5
   bz htrap_5_ext_done
   set 0x7fff, %r3
   and %r4, %r3, %r4
   or %r5, %r4, %r4
   wrpr %r4, %tpc
   rdpr %tnpc, %r4
   and %r4, %r3, %r4
   or %r5, %r4, %r4
   wrpr %r4, %tnpc
   retry

   !assume %r27 is where we came from ..
not_a_reloc_handler:
   stxa %r27, [%r6] 0x57
   add %r27, 8, %r27
   wrpr %r27, %tnpc
   done

htrap_5_ext:
   rd %pc, %l2
   inc %l3
   add %l2, htrap_5_ext_done-htrap_5_ext, %l2
   rdpr %tl, %l3
   rdpr %tstate, %l4
   rdhpr %htstate, %l5
   or %l5, 0x4, %l5
   inc %l3
   wrpr %l3, %tl
   wrpr %l2, %tpc
   wrpr %l4, %tstate
   wrhpr %l5, %htstate
   retry
htrap_5_ext_done:
   done

wdog_2_ext:
   mov 0x1f, %l1
   stxa    %l1, [%g0] ASI_LSU_CTL_REG
! If TT != 2, then goto trap handler
   rdpr %tt, %l1
   cmp %l1, 0x2
   bne wdog_2_goto_handler
   nop
! else done
   done
wdog_2_goto_handler:
   rdhpr %htstate, %l3
   and %l3, 0x4, %l3    ! If previously in hpriv mode, go to hpriv 
   brnz,a %l3, wdog_2_goto_handler_1
   rdhpr %htba, %l3
   srlx %l1, 7, %l3     ! Send priv sw traps to priv mode ..
   cmp %l3, 0x2         ! 0x2 = priv sw trap, 0x3=hpriv sw trap ..
   be,a wdog_2_goto_handler_1
   rdpr %tba, %l3
   rdhpr %htba, %l3
wdog_2_goto_handler_1:
   sllx %l1, 5, %l1
   add %l1, %l3, %l3
   jmp %l3
   nop