Quelle  fp_cond.S   Sprache: Sparc

/*
 * fp_cond.S
 *
 * Copyright Roman Zippel, 1997.  All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, and the entire permission notice in its entirety,
 *    including the disclaimer of warranties.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. The name of the author may not be used to endorse or promote
 *    products derived from this software without specific prior
 *    written permission.
 *
 * ALTERNATIVELY, this product may be distributed under the terms of
 * the GNU General Public License, in which case the provisions of the GPL are
 * required INSTEAD OF the above restrictions.  (This clause is
 * necessary due to a potential bad interaction between the GPL and
 * the restrictions contained in a BSD-style copyright.)
 *
 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
 * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
 * OF THE POSSIBILITY OF SUCH DAMAGE.
 */

#include "fp_emu.h"
#include "fp_decode.h"

 .globl fp_fscc, fp_fbccw, fp_fbccl

#ifdef FPU_EMU_DEBUG
fp_fnop:
 printf PDECODE,"fnop\n"
 jra fp_end
#else
#define fp_fnop fp_end
#endif

fp_fbccw:
 tst.w %d2
 jeq fp_fnop
 printf PDECODE,"fbccw "
 fp_get_pc %a0
 lea (-2,%a0,%d2.w),%a0
 jra 1f

fp_fbccl:
 printf PDECODE,"fbccl "
 fp_get_pc %a0
 move.l %d2,%d0
 swap %d0
 fp_get_instr_word %d0,fp_err_ua1
 lea (-2,%a0,%d0.l),%a0
1: printf PDECODE,"%x",1,%a0
 move.l %d2,%d0
 swap %d0
 jsr fp_compute_cond
 tst.l %d0
 jeq 1f
 fp_put_pc %a0,1
1: printf PDECODE,"\n"
 jra fp_end

fp_fdbcc:
 printf PDECODE,"fdbcc "
 fp_get_pc %a1    | calculate new pc
 fp_get_instr_word %d0,fp_err_ua1
 add.w %d0,%a1
 fp_decode_addr_reg
 printf PDECODE,"d%d,%x\n",2,%d0,%a1
 swap %d1    | test condition in %d1
 tst.w %d1
 jne 2f
 move.l %d0,%d1
 jsr fp_get_data_reg
 subq.w #1,%d0
 jcs 1f
 fp_put_pc %a1,1
1: jsr fp_put_data_reg
2: jra fp_end

| set flags for decode macros for fs<cc>
do_fscc=1
do_no_pc_mode=1

fp_fscc:
 printf PDECODE,"fscc "
 move.l %d2,%d0
 jsr fp_compute_cond
 move.w %d0,%d1
 swap %d1

 | decode addressing mode
 fp_decode_addr_mode

 .long fp_data, fp_fdbcc
 .long fp_indirect, fp_postinc
 .long fp_predecr, fp_disp16
 .long fp_extmode0, fp_extmode1

 | addressing mode: data register direct
fp_data:
 fp_mode_data_direct
 move.w %d0,%d1   | save register nr
 jsr fp_get_data_reg
 swap %d1
 move.b %d1,%d0
 swap %d1
 jsr fp_put_data_reg
 printf PDECODE,"\n"
 jra fp_end

fp_indirect:
 fp_mode_addr_indirect
 jra fp_do_scc

fp_postinc:
 fp_mode_addr_indirect_postinc
 jra fp_do_scc

fp_predecr:
 fp_mode_addr_indirect_predec
 jra fp_do_scc

fp_disp16:
 fp_mode_addr_indirect_disp16
 jra fp_do_scc

fp_extmode0:
 fp_mode_addr_indirect_extmode0
 jra fp_do_scc

fp_extmode1:
 bfextu %d2{#13,#3},%d0
 jmp ([0f:w,%pc,%d0*4])

 .align 4
0:
 .long fp_absolute_short, fp_absolute_long
 .long fp_ill, fp_ill  | NOTE: jump here to ftrap.x
 .long fp_ill, fp_ill
 .long fp_ill, fp_ill

fp_absolute_short:
 fp_mode_abs_short
 jra fp_do_scc

fp_absolute_long:
 fp_mode_abs_long
| jra fp_do_scc

fp_do_scc:
 swap %d1
 putuser.b %d1,(%a0),fp_err_ua1,%a0
 printf PDECODE,"\n"
 jra fp_end


#define tst_NAN btst #24,%d1
#define tst_Z btst #26,%d1
#define tst_N btst #27,%d1

fp_compute_cond:
 move.l (FPD_FPSR,FPDATA),%d1
 btst #4,%d0
 jeq 1f
 tst_NAN
 jeq 1f
 bset #15,%d1
 bset #7,%d1
 move.l %d1,(FPD_FPSR,FPDATA)
1: and.w #0xf,%d0
 jmp ([0f:w,%pc,%d0.w*4])

 .align 4
0:
 .long fp_f  , fp_eq , fp_ogt, fp_oge
 .long fp_olt, fp_ole, fp_ogl, fp_or
 .long fp_un , fp_ueq, fp_ugt, fp_uge
 .long fp_ult, fp_ule, fp_ne , fp_t

fp_f:
 moveq #0,%d0
 rts

fp_eq:
 moveq #0,%d0
 tst_Z
 jeq 1f
 moveq #-1,%d0
1: rts

fp_ogt:
 moveq #0,%d0
 tst_NAN
 jne 1f
 tst_Z
 jne 1f
 tst_N
 jne 1f
 moveq #-1,%d0
1: rts

fp_oge:
 moveq #-1,%d0
 tst_Z
 jne 2f
 tst_NAN
 jne 1f
 tst_N
 jeq 2f
1: moveq #0,%d0
2: rts

fp_olt:
 moveq #0,%d0
 tst_NAN
 jne 1f
 tst_Z
 jne 1f
 tst_N
 jeq 1f
 moveq #-1,%d0
1: rts

fp_ole:
 moveq #-1,%d0
 tst_Z
 jne 2f
 tst_NAN
 jne 1f
 tst_N
 jne 2f
1: moveq #0,%d0
2: rts

fp_ogl:
 moveq #0,%d0
 tst_NAN
 jne 1f
 tst_Z
 jne 1f
 moveq #-1,%d0
1: rts

fp_or:
 moveq #0,%d0
 tst_NAN
 jne 1f
 moveq #-1,%d0
1: rts

fp_un:
 moveq #0,%d0
 tst_NAN
 jeq 1f
 moveq #-1,%d0
 rts

fp_ueq:
 moveq #-1,%d0
 tst_NAN
 jne 1f
 tst_Z
 jne 1f
 moveq #0,%d0
1: rts

fp_ugt:
 moveq #-1,%d0
 tst_NAN
 jne 2f
 tst_N
 jne 1f
 tst_Z
 jeq 2f
1: moveq #0,%d0
2: rts

fp_uge:
 moveq #-1,%d0
 tst_NAN
 jne 1f
 tst_Z
 jne 1f
 tst_N
 jeq 1f
 moveq #0,%d0
1: rts

fp_ult:
 moveq #-1,%d0
 tst_NAN
 jne 2f
 tst_Z
 jne 1f
 tst_N
 jne 2f
1: moveq #0,%d0
2: rts

fp_ule:
 moveq #-1,%d0
 tst_NAN
 jne 1f
 tst_Z
 jne 1f
 tst_N
 jne 1f
 moveq #0,%d0
1: rts

fp_ne:
 moveq #0,%d0
 tst_Z
 jne 1f
 moveq #-1,%d0
1: rts

fp_t:
 moveq #-1,%d0
 rts