lib/libc/sparc64/sys/__sparc_utrap_gen.S

   1 /*-
   2  * Copyright (c) 2001 Jake Burkholder.
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  24  * SUCH DAMAGE.
  25  */
  26
  27 #include <machine/asm.h>
  28 __FBSDID("$FreeBSD$");
  29
  30         .register       %g2, #ignore
  31         .register       %g3, #ignore
  32         .register       %g6, #ignore
  33         .register       %g7, #ignore
  34
  35 #include <machine/tstate.h>
  36 #include <machine/utrap.h>
  37
  38 #include "assym.s"
  39
  40 ENTRY(__sparc_utrap_gen)
  41 #ifdef SUN4V
  42         save
  43         ta      %xcc, ST_FPEMU_CONTEXT
  44 #endif
  45         sub     %sp, UF_SIZEOF, %sp
  46
  47         stx     %o0, [%sp + SPOFF + CCFSZ + UF_TYPE]
  48         stx     %o3, [%sp + SPOFF + CCFSZ + UF_TAR]
  49         stx     %o4, [%sp + SPOFF + CCFSZ + UF_SFAR]
  50         stx     %o5, [%sp + SPOFF + CCFSZ + UF_SFSR]
  51
  52         stx     %l4, [%sp + SPOFF + CCFSZ + UF_FSR]
  53         stx     %l5, [%sp + SPOFF + CCFSZ + UF_STATE]
  54         stx     %l6, [%sp + SPOFF + CCFSZ + UF_PC]
  55         stx     %l7, [%sp + SPOFF + CCFSZ + UF_NPC]
  56
  57         stx     %g1, [%sp + SPOFF + CCFSZ + UF_G1]
  58         stx     %g2, [%sp + SPOFF + CCFSZ + UF_G2]
  59         stx     %g3, [%sp + SPOFF + CCFSZ + UF_G3]
  60         stx     %g4, [%sp + SPOFF + CCFSZ + UF_G4]
  61         stx     %g5, [%sp + SPOFF + CCFSZ + UF_G5]
  62         stx     %g6, [%sp + SPOFF + CCFSZ + UF_G6]
  63         stx     %g7, [%sp + SPOFF + CCFSZ + UF_G7]
  64
  65         stx     %i0, [%sp + SPOFF + CCFSZ + UF_O0]
  66         stx     %i1, [%sp + SPOFF + CCFSZ + UF_O1]
  67         stx     %i2, [%sp + SPOFF + CCFSZ + UF_O2]
  68         stx     %i3, [%sp + SPOFF + CCFSZ + UF_O3]
  69         stx     %i4, [%sp + SPOFF + CCFSZ + UF_O4]
  70         stx     %i5, [%sp + SPOFF + CCFSZ + UF_O5]
  71         stx     %i6, [%sp + SPOFF + CCFSZ + UF_O6]
  72         stx     %i7, [%sp + SPOFF + CCFSZ + UF_O7]
  73
  74         rd      %y, %l6
  75
  76         call    __sparc_utrap
  77          add    %sp, SPOFF + CCFSZ, %o0
  78
  79         wr      %l6, 0, %y
  80
  81         ldx     [%sp + SPOFF + CCFSZ + UF_G1], %g1
  82         ldx     [%sp + SPOFF + CCFSZ + UF_G2], %g2
  83         ldx     [%sp + SPOFF + CCFSZ + UF_G3], %g3
  84         ldx     [%sp + SPOFF + CCFSZ + UF_G4], %g4
  85         ldx     [%sp + SPOFF + CCFSZ + UF_G5], %g5
  86         ldx     [%sp + SPOFF + CCFSZ + UF_G6], %g6
  87         ldx     [%sp + SPOFF + CCFSZ + UF_G7], %g7
  88
  89         ldx     [%sp + SPOFF + CCFSZ + UF_O0], %i0
  90         ldx     [%sp + SPOFF + CCFSZ + UF_O1], %i1
  91         ldx     [%sp + SPOFF + CCFSZ + UF_O2], %i2
  92         ldx     [%sp + SPOFF + CCFSZ + UF_O3], %i3
  93         ldx     [%sp + SPOFF + CCFSZ + UF_O4], %i4
  94         ldx     [%sp + SPOFF + CCFSZ + UF_O5], %i5
  95         ldx     [%sp + SPOFF + CCFSZ + UF_O6], %i6
  96         ldx     [%sp + SPOFF + CCFSZ + UF_O7], %i7
  97
  98         ldx     [%sp + SPOFF + CCFSZ + UF_STATE], %l5
  99         ! Restore %asi and %ccr from the passed tstate
 100         srlx    %l5, TSTATE_CCR_SHIFT, %l4
 101         and     %l4, CCR_MASK, %l4
 102         wr      %l4, 0, %ccr
 103         srlx    %l5, TSTATE_ASI_SHIFT, %l4
 104         and     %l4, ASI_MASK, %l4
 105         wr      %l4, 0, %asi
 106         ldx     [%sp + SPOFF + CCFSZ + UF_PC], %l6
 107         ldx     [%sp + SPOFF + CCFSZ + UF_NPC], %l7
 108
 109         jmpl    %l6, %g0
 110          return %l7
 111 END(__sparc_utrap_gen)