verif/diag/assembly/include/kernel_handler.s

/*
* ========== Copyright Header Begin ==========================================
*
* OpenSPARC T2 Processor File: kernel_handler.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 ============================================
*/
.global kernel_syscall
kernel_syscall:
        ! save globals
        stx     %g1, [%g7+8]
        stx     %g2, [%g7+16]
        stx     %g3, [%g7+24]
        stx     %g4, [%g7+32]
        stx     %g5, [%g7+40]
        stx     %g6, [%g7+48]

        setx    syscall_jmptab, %g1, %g2
        sllx    %o1, 3, %g1
        add     %g2, %g1, %g2   ! %g2 = ptr into jump table based on call #
        ldx     [%g2], %g1
        jmp     %g1

kernel_sysret:
        ! restore globals
        ldx     [%g7+8], %g1
        ldx     [%g7+16], %g2
        ldx     [%g7+24], %g3
        ldx     [%g7+32], %g4
        ldx     [%g7+40], %g5
        ldx     [%g7+48], %g6

        ta      T_SYSRET
        nop

! %o2 = size in bytes
! %o3 = alignment in bytes (has to be power of 2)
! %o4 = returned pointer
kernel_memalign:
        setx    heapptr, %g1, %g2
        ldx     [%g2], %g1      ! %g1 = heapptr
        mov     %o3, %g3
        sub     %g3, 1, %g3     ! alignment mask
        and     %g3, %g1, %g4
        brz     %g4, align_done
        not     %g3
        and     %g3, %g1, %g1
        add     %g1, %o3, %g1
align_done:
        mov     %g1, %o4
        add     %g1, %o2, %g1
        ba      kernel_sysret
        stx     %g1, [%g2]

kernel_printhex:
        ba      kernel_sysret   ! $ EV trig_pc_d(1,expr(@VA(.KERNEL.kernel_printhex), 16, 16)) -> printhex("diagprinthex", %o2)
        nop

kernel_printdec:
        ba      kernel_sysret   ! $ EV trig_pc_d(1,expr(@VA(.KERNEL.kernel_printdec), 16, 16)) -> printdec("diagprintdec", %o2)
        nop

.data
syscall_jmptab:
        .xword  0x0000000000000000
        .xword  kernel_memalign
        .xword  kernel_printhex
        .xword  kernel_printdec

heapptr:
        .xword  0x0000000000000000

.global start_label_list
start_label_list:
#if defined(USER_PAGE_CUSTOM_MAP) || !defined(USER_TEXT_MT_MAP)
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
        .xword  USER_START_LABEL, USER_START_LABEL, USER_START_LABEL, USER_START_LABEL
#else
changequote([, ])dnl
        foreachbit([i], 64, M4_user_data_mask, [
        .xword  [main]i
])dnl
changequote(`,')dnl'
#endif

.align 512
user_globals:

#ifndef USER_HEAP_SIZE
#define USER_HEAP_SIZE 0x2000
#endif

#ifndef USER_PAGE_CUSTOM_MAP
SECTION .USER_HEAP        DATA_VA=USER_HEAP_DATA_VA
changequote([, ])dnl
forloop([i], 0, 7, [
ifdef([part_]i[_used],[
attr_data {
        Name = .USER_HEAP,
        RA = USER_HEAP_DATA_RA,
        PA = ra2pa2(USER_HEAP_DATA_RA,i),
#ifndef USE_N1_TSB_NAMES
        [part_]i[_ctx_nonzero_tsb_config_0],
#else
        [part_]i[_d_ctx_nonzero_ps0_tsb],
#endif
        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=1,  TTE_CV=0,
        TTE_E=0,      TTE_P=0,        TTE_W=1
        }

.data
.global user_heap_start
user_heap_start:
.skip (USER_HEAP_SIZE-0x4)
.word 0x0
.end
])dnl
])dnl
changequote(`,')dnl'
#endif