forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
334 lines
5.5 KiB
334 lines
5.5 KiB
/* |
|
* 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
|
|
|