Blame view

kernel/linux-rt-4.4.41/arch/m68k/fpsp040/sto_res.S 1.93 KB
5113f6f70   김현기   kernel add
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
  |
  |	sto_res.sa 3.1 12/10/90
  |
  |	Takes the result and puts it in where the user expects it.
  |	Library functions return result in fp0.	If fp0 is not the
  |	users destination register then fp0 is moved to the
  |	correct floating-point destination register.  fp0 and fp1
  |	are then restored to the original contents.
  |
  |	Input:	result in fp0,fp1
  |
  |		d2 & a0 should be kept unmodified
  |
  |	Output:	moves the result to the true destination reg or mem
  |
  |	Modifies: destination floating point register
  |
  
  |		Copyright (C) Motorola, Inc. 1990
  |			All Rights Reserved
  |
  |       For details on the license for this file, please see the
  |       file, README, in this same directory.
  
  STO_RES:	|idnt	2,1 | Motorola 040 Floating Point Software Package
  
  
  	|section	8
  
  #include "fpsp.h"
  
  	.global	sto_cos
  sto_cos:
  	bfextu		CMDREG1B(%a6){#13:#3},%d0	|extract cos destination
  	cmpib		#3,%d0		|check for fp0/fp1 cases
  	bles		c_fp0123
  	fmovemx	%fp1-%fp1,-(%a7)
  	moveql		#7,%d1
  	subl		%d0,%d1		|d1 = 7- (dest. reg. no.)
  	clrl		%d0
  	bsetl		%d1,%d0		|d0 is dynamic register mask
  	fmovemx	(%a7)+,%d0
  	rts
  c_fp0123:
  	cmpib		#0,%d0
  	beqs		c_is_fp0
  	cmpib		#1,%d0
  	beqs		c_is_fp1
  	cmpib		#2,%d0
  	beqs		c_is_fp2
  c_is_fp3:
  	fmovemx	%fp1-%fp1,USER_FP3(%a6)
  	rts
  c_is_fp2:
  	fmovemx	%fp1-%fp1,USER_FP2(%a6)
  	rts
  c_is_fp1:
  	fmovemx	%fp1-%fp1,USER_FP1(%a6)
  	rts
  c_is_fp0:
  	fmovemx	%fp1-%fp1,USER_FP0(%a6)
  	rts
  
  
  	.global	sto_res
  sto_res:
  	bfextu		CMDREG1B(%a6){#6:#3},%d0	|extract destination register
  	cmpib		#3,%d0		|check for fp0/fp1 cases
  	bles		fp0123
  	fmovemx	%fp0-%fp0,-(%a7)
  	moveql		#7,%d1
  	subl		%d0,%d1		|d1 = 7- (dest. reg. no.)
  	clrl		%d0
  	bsetl		%d1,%d0		|d0 is dynamic register mask
  	fmovemx	(%a7)+,%d0
  	rts
  fp0123:
  	cmpib		#0,%d0
  	beqs		is_fp0
  	cmpib		#1,%d0
  	beqs		is_fp1
  	cmpib		#2,%d0
  	beqs		is_fp2
  is_fp3:
  	fmovemx	%fp0-%fp0,USER_FP3(%a6)
  	rts
  is_fp2:
  	fmovemx	%fp0-%fp0,USER_FP2(%a6)
  	rts
  is_fp1:
  	fmovemx	%fp0-%fp0,USER_FP1(%a6)
  	rts
  is_fp0:
  	fmovemx	%fp0-%fp0,USER_FP0(%a6)
  	rts
  
  	|end