245 lines
		
	
	
		
			5.5 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
			
		
		
	
	
			245 lines
		
	
	
		
			5.5 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
| /*
 | |
|  * fp_move.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"
 | |
| 
 | |
| do_no_pc_mode=1
 | |
| 
 | |
| 	.globl	fp_fmove_fp2mem
 | |
| 
 | |
| fp_fmove_fp2mem:
 | |
| 	clr.b	(2+FPD_FPSR,FPDATA)
 | |
| 	fp_decode_dest_format
 | |
| 	move.w	%d0,%d1			| store data size twice in %d1
 | |
| 	swap	%d1			| one can be trashed below
 | |
| 	move.w	%d0,%d1
 | |
| #ifdef FPU_EMU_DEBUG
 | |
| 	lea	0f,%a0
 | |
| 	clr.l	%d0
 | |
| 	move.b	(%a0,%d1.w),%d0
 | |
| 	printf	PDECODE,"fmove.%c ",1,%d0
 | |
| 	fp_decode_src_reg
 | |
| 	printf	PDECODE,"fp%d,",1,%d0
 | |
| 
 | |
| 	.data
 | |
| 0:	.byte	'l','s','x','p','w','d','b','p'
 | |
| 	.previous
 | |
| #endif
 | |
| 
 | |
| 	| encode addressing mode for dest
 | |
| 	fp_decode_addr_mode
 | |
| 
 | |
| 	.long	fp_data, fp_ill
 | |
| 	.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
 | |
| 	fp_decode_src_reg
 | |
| 	fp_get_fp_reg
 | |
| 	lea	(FPD_TEMPFP1,FPDATA),%a1
 | |
| 	move.l	(%a0)+,(%a1)+
 | |
| 	move.l	(%a0)+,(%a1)+
 | |
| 	move.l	(%a0),(%a1)
 | |
| 	lea	(-8,%a1),%a0
 | |
| 	swap	%d1
 | |
| 	move.l	%d1,%d2
 | |
| 	printf	PDECODE,"\n"
 | |
| 	jmp	([0f:w,%pc,%d1.w*4])
 | |
| 
 | |
| 	.align	4
 | |
| 0:
 | |
| 	.long	fp_data_long, fp_data_single
 | |
| 	.long	fp_ill, fp_ill
 | |
| 	.long	fp_data_word, fp_ill
 | |
| 	.long	fp_data_byte, fp_ill
 | |
| 
 | |
| fp_data_byte:
 | |
| 	jsr	fp_normalize_ext
 | |
| 	jsr	fp_conv_ext2byte
 | |
| 	move.l	%d0,%d1
 | |
| 	swap	%d2
 | |
| 	move.w	%d2,%d0
 | |
| 	jsr	fp_get_data_reg
 | |
| 	move.b	%d1,%d0
 | |
| 	move.w	%d2,%d1
 | |
| 	jsr	fp_put_data_reg
 | |
| 	jra	fp_final
 | |
| 
 | |
| fp_data_word:
 | |
| 	jsr	fp_normalize_ext
 | |
| 	jsr	fp_conv_ext2short
 | |
| 	move.l	%d0,%d1
 | |
| 	swap	%d2
 | |
| 	move.w	%d2,%d0
 | |
| 	jsr	fp_get_data_reg
 | |
| 	move.w	%d1,%d0
 | |
| 	move.l	%d2,%d1
 | |
| 	jsr	fp_put_data_reg
 | |
| 	jra	fp_final
 | |
| 
 | |
| fp_data_long:
 | |
| 	jsr	fp_normalize_ext
 | |
| 	jsr	fp_conv_ext2long
 | |
| 	swap	%d2
 | |
| 	move.w	%d2,%d1
 | |
| 	jsr	fp_put_data_reg
 | |
| 	jra	fp_final
 | |
| 
 | |
| fp_data_single:
 | |
| 	jsr	fp_normalize_ext
 | |
| 	jsr	fp_conv_ext2single
 | |
| 	swap	%d2
 | |
| 	move.w	%d2,%d1
 | |
| 	jsr	fp_put_data_reg
 | |
| 	jra	fp_final
 | |
| 
 | |
| 	| addressing mode: address register indirect
 | |
| fp_indirect:
 | |
| 	fp_mode_addr_indirect
 | |
| 	jra	fp_putdest
 | |
| 
 | |
| 	| addressing mode: address register indirect with postincrement
 | |
| fp_postinc:
 | |
| 	fp_mode_addr_indirect_postinc
 | |
| 	jra	fp_putdest
 | |
| 
 | |
| 	| addressing mode: address register indirect with predecrement
 | |
| fp_predecr:
 | |
| 	fp_mode_addr_indirect_predec
 | |
| 	jra	fp_putdest
 | |
| 
 | |
| 	| addressing mode: address register indirect with 16bit displacement
 | |
| fp_disp16:
 | |
| 	fp_mode_addr_indirect_disp16
 | |
| 	jra     fp_putdest
 | |
| 
 | |
| fp_extmode0:
 | |
| 	fp_mode_addr_indirect_extmode0
 | |
| 	jra	fp_putdest
 | |
| 
 | |
| fp_extmode1:
 | |
| 	fp_decode_addr_reg
 | |
| 	jmp	([0f:w,%pc,%d0*4])
 | |
| 
 | |
| 	.align	4
 | |
| 0:
 | |
| 	.long	fp_abs_short, fp_abs_long
 | |
| 	.long	fp_ill, fp_ill
 | |
| 	.long	fp_ill, fp_ill
 | |
| 	.long	fp_ill, fp_ill
 | |
| 
 | |
| fp_abs_short:
 | |
| 	fp_mode_abs_short
 | |
| 	jra	fp_putdest
 | |
| 
 | |
| fp_abs_long:
 | |
| 	fp_mode_abs_long
 | |
| 	jra	fp_putdest
 | |
| 
 | |
| fp_putdest:
 | |
| 	move.l	%a0,%a1
 | |
| 	fp_decode_src_reg
 | |
| 	move.l	%d1,%d2			| save size
 | |
| 	fp_get_fp_reg
 | |
| 	printf	PDECODE,"\n"
 | |
| 	addq.l	#8,%a0
 | |
| 	move.l	(%a0),-(%sp)
 | |
| 	move.l	-(%a0),-(%sp)
 | |
| 	move.l	-(%a0),-(%sp)
 | |
| 	move.l	%sp,%a0
 | |
| 	jsr	fp_normalize_ext
 | |
| 
 | |
| 	swap	%d2
 | |
| 	jmp	([0f:w,%pc,%d2.w*4])
 | |
| 
 | |
| 	.align	4
 | |
| 0:
 | |
| 	.long	fp_format_long, fp_format_single
 | |
| 	.long	fp_format_extended, fp_format_packed
 | |
| 	.long	fp_format_word, fp_format_double
 | |
| 	.long	fp_format_byte, fp_format_packed
 | |
| 
 | |
| fp_format_long:
 | |
| 	jsr	fp_conv_ext2long
 | |
| 	putuser.l %d0,(%a1),fp_err_ua1,%a1
 | |
| 	jra	fp_finish_move
 | |
| 
 | |
| fp_format_single:
 | |
| 	jsr	fp_conv_ext2single
 | |
| 	putuser.l %d0,(%a1),fp_err_ua1,%a1
 | |
| 	jra	fp_finish_move
 | |
| 
 | |
| fp_format_extended:
 | |
| 	move.l	(%a0)+,%d0
 | |
| 	lsl.w	#1,%d0
 | |
| 	lsl.l	#7,%d0
 | |
| 	lsl.l	#8,%d0
 | |
| 	putuser.l %d0,(%a1)+,fp_err_ua1,%a1
 | |
| 	move.l	(%a0)+,%d0
 | |
| 	putuser.l %d0,(%a1)+,fp_err_ua1,%a1
 | |
| 	move.l	(%a0),%d0
 | |
| 	putuser.l %d0,(%a1),fp_err_ua1,%a1
 | |
| 	jra	fp_finish_move
 | |
| 
 | |
| fp_format_packed:
 | |
| 	/* not supported yet */
 | |
| 	lea	(12,%sp),%sp
 | |
| 	jra	fp_ill
 | |
| 
 | |
| fp_format_word:
 | |
| 	jsr	fp_conv_ext2short
 | |
| 	putuser.w %d0,(%a1),fp_err_ua1,%a1
 | |
| 	jra	fp_finish_move
 | |
| 
 | |
| fp_format_double:
 | |
| 	jsr	fp_conv_ext2double
 | |
| 	jra	fp_finish_move
 | |
| 
 | |
| fp_format_byte:
 | |
| 	jsr	fp_conv_ext2byte
 | |
| 	putuser.b %d0,(%a1),fp_err_ua1,%a1
 | |
| |	jra	fp_finish_move
 | |
| 
 | |
| fp_finish_move:
 | |
| 	lea	(12,%sp),%sp
 | |
| 	jra	fp_final
 |