arch/m68k/math-emu/fp_move.S

   1 /*
   2  * fp_move.S
   3  *
   4  * Copyright Roman Zippel, 1997.  All rights reserved.
   5  *
   6  * Redistribution and use in source and binary forms, with or without
   7  * modification, are permitted provided that the following conditions
   8  * are met:
   9  * 1. Redistributions of source code must retain the above copyright
  10  *    notice, and the entire permission notice in its entirety,
  11  *    including the disclaimer of warranties.
  12  * 2. Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  * 3. The name of the author may not be used to endorse or promote
  16  *    products derived from this software without specific prior
  17  *    written permission.
  18  *
  19  * ALTERNATIVELY, this product may be distributed under the terms of
  20  * the GNU General Public License, in which case the provisions of the GPL are
  21  * required INSTEAD OF the above restrictions.  (This clause is
  22  * necessary due to a potential bad interaction between the GPL and
  23  * the restrictions contained in a BSD-style copyright.)
  24  *
  25  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
  26  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  27  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
  28  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
  29  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
  30  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
  31  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  32  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
  33  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  34  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
  35  * OF THE POSSIBILITY OF SUCH DAMAGE.
  36  */
  37
  38 #include "fp_emu.h"
  39 #include "fp_decode.h"
  40
  41 do_no_pc_mode=1
  42
  43         .globl  fp_fmove_fp2mem
  44
  45 fp_fmove_fp2mem:
  46         clr.b   (2+FPD_FPSR,FPDATA)
  47         fp_decode_dest_format
  48         move.w  %d0,%d1                 | store data size twice in %d1
  49         swap    %d1                     | one can be trashed below
  50         move.w  %d0,%d1
  51 #ifdef FPU_EMU_DEBUG
  52         lea     0f,%a0
  53         clr.l   %d0
  54         move.b  (%a0,%d1.w),%d0
  55         printf  PDECODE,"fmove.%c ",1,%d0
  56         fp_decode_src_reg
  57         printf  PDECODE,"fp%d,",1,%d0
  58
  59         .data
  60 0:      .byte   'l','s','x','p','w','d','b','p'
  61         .previous
  62 #endif
  63
  64         | encode addressing mode for dest
  65         fp_decode_addr_mode
  66
  67         .long   fp_data, fp_ill
  68         .long   fp_indirect, fp_postinc
  69         .long   fp_predecr, fp_disp16
  70         .long   fp_extmode0, fp_extmode1
  71
  72         | addressing mode: data register direct
  73 fp_data:
  74         fp_mode_data_direct
  75         move.w  %d0,%d1
  76         fp_decode_src_reg
  77         fp_get_fp_reg
  78         lea     (FPD_TEMPFP1,FPDATA),%a1
  79         move.l  (%a0)+,(%a1)+
  80         move.l  (%a0)+,(%a1)+
  81         move.l  (%a0),(%a1)
  82         lea     (-8,%a1),%a0
  83         swap    %d1
  84         move.l  %d1,%d2
  85         printf  PDECODE,"\n"
  86         jmp     ([0f:w,%pc,%d1.w*4])
  87
  88         .align  4
  89 0:
  90         .long   fp_data_long, fp_data_single
  91         .long   fp_ill, fp_ill
  92         .long   fp_data_word, fp_ill
  93         .long   fp_data_byte, fp_ill
  94
  95 fp_data_byte:
  96         jsr     fp_normalize_ext
  97         jsr     fp_conv_ext2byte
  98         move.l  %d0,%d1
  99         swap    %d2
 100         move.w  %d2,%d0
 101         jsr     fp_get_data_reg
 102         move.b  %d1,%d0
 103         move.w  %d2,%d1
 104         jsr     fp_put_data_reg
 105         jra     fp_final
 106
 107 fp_data_word:
 108         jsr     fp_normalize_ext
 109         jsr     fp_conv_ext2short
 110         move.l  %d0,%d1
 111         swap    %d2
 112         move.w  %d2,%d0
 113         jsr     fp_get_data_reg
 114         move.w  %d1,%d0
 115         move.l  %d2,%d1
 116         jsr     fp_put_data_reg
 117         jra     fp_final
 118
 119 fp_data_long:
 120         jsr     fp_normalize_ext
 121         jsr     fp_conv_ext2long
 122         swap    %d2
 123         move.w  %d2,%d1
 124         jsr     fp_put_data_reg
 125         jra     fp_final
 126
 127 fp_data_single:
 128         jsr     fp_normalize_ext
 129         jsr     fp_conv_ext2single
 130         swap    %d2
 131         move.w  %d2,%d1
 132         jsr     fp_put_data_reg
 133         jra     fp_final
 134
 135         | addressing mode: address register indirect
 136 fp_indirect:
 137         fp_mode_addr_indirect
 138         jra     fp_putdest
 139
 140         | addressing mode: address register indirect with postincrement
 141 fp_postinc:
 142         fp_mode_addr_indirect_postinc
 143         jra     fp_putdest
 144
 145         | addressing mode: address register indirect with predecrement
 146 fp_predecr:
 147         fp_mode_addr_indirect_predec
 148         jra     fp_putdest
 149
 150         | addressing mode: address register indirect with 16bit displacement
 151 fp_disp16:
 152         fp_mode_addr_indirect_disp16
 153         jra     fp_putdest
 154
 155 fp_extmode0:
 156         fp_mode_addr_indirect_extmode0
 157         jra     fp_putdest
 158
 159 fp_extmode1:
 160         fp_decode_addr_reg
 161         jmp     ([0f:w,%pc,%d0*4])
 162
 163         .align  4
 164 0:
 165         .long   fp_abs_short, fp_abs_long
 166         .long   fp_ill, fp_ill
 167         .long   fp_ill, fp_ill
 168         .long   fp_ill, fp_ill
 169
 170 fp_abs_short:
 171         fp_mode_abs_short
 172         jra     fp_putdest
 173
 174 fp_abs_long:
 175         fp_mode_abs_long
 176         jra     fp_putdest
 177
 178 fp_putdest:
 179         move.l  %a0,%a1
 180         fp_decode_src_reg
 181         move.l  %d1,%d2                 | save size
 182         fp_get_fp_reg
 183         printf  PDECODE,"\n"
 184         addq.l  #8,%a0
 185         move.l  (%a0),-(%sp)
 186         move.l  -(%a0),-(%sp)
 187         move.l  -(%a0),-(%sp)
 188         move.l  %sp,%a0
 189         jsr     fp_normalize_ext
 190
 191         swap    %d2
 192         jmp     ([0f:w,%pc,%d2.w*4])
 193
 194         .align  4
 195 0:
 196         .long   fp_format_long, fp_format_single
 197         .long   fp_format_extended, fp_format_packed
 198         .long   fp_format_word, fp_format_double
 199         .long   fp_format_byte, fp_format_packed
 200
 201 fp_format_long:
 202         jsr     fp_conv_ext2long
 203         putuser.l %d0,(%a1),fp_err_ua1,%a1
 204         jra     fp_finish_move
 205
 206 fp_format_single:
 207         jsr     fp_conv_ext2single
 208         putuser.l %d0,(%a1),fp_err_ua1,%a1
 209         jra     fp_finish_move
 210
 211 fp_format_extended:
 212         move.l  (%a0)+,%d0
 213         lsl.w   #1,%d0
 214         lsl.l   #7,%d0
 215         lsl.l   #8,%d0
 216         putuser.l %d0,(%a1)+,fp_err_ua1,%a1
 217         move.l  (%a0)+,%d0
 218         putuser.l %d0,(%a1)+,fp_err_ua1,%a1
 219         move.l  (%a0),%d0
 220         putuser.l %d0,(%a1),fp_err_ua1,%a1
 221         jra     fp_finish_move
 222
 223 fp_format_packed:
 224         /* not supported yet */
 225         lea     (12,%sp),%sp
 226         jra     fp_ill
 227
 228 fp_format_word:
 229         jsr     fp_conv_ext2short
 230         putuser.w %d0,(%a1),fp_err_ua1,%a1
 231         jra     fp_finish_move
 232
 233 fp_format_double:
 234         jsr     fp_conv_ext2double
 235         jra     fp_finish_move
 236
 237 fp_format_byte:
 238         jsr     fp_conv_ext2byte
 239         putuser.b %d0,(%a1),fp_err_ua1,%a1
 240 |       jra     fp_finish_move
 241
 242 fp_finish_move:
 243         lea     (12,%sp),%sp
 244         jra     fp_final