Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | NetWinder Floating Point Emulator | |
3 | (c) Rebel.COM, 1998,1999 | |
4 | ||
5 | Direct questions, comments to Scott Bambrough <scottb@netwinder.org> | |
6 | ||
7 | This program is free software; you can redistribute it and/or modify | |
8 | it under the terms of the GNU General Public License as published by | |
9 | the Free Software Foundation; either version 2 of the License, or | |
10 | (at your option) any later version. | |
11 | ||
12 | This program is distributed in the hope that it will be useful, | |
13 | but WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
15 | GNU General Public License for more details. | |
16 | ||
17 | You should have received a copy of the GNU General Public License | |
18 | along with this program; if not, write to the Free Software | |
19 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
20 | */ | |
21 | ||
22 | #include "fpa11.h" | |
23 | #include "softfloat.h" | |
24 | #include "fpopcode.h" | |
25 | ||
26 | union float64_components { | |
27 | float64 f64; | |
28 | unsigned int i[2]; | |
29 | }; | |
30 | ||
31 | float64 float64_exp(float64 Fm); | |
32 | float64 float64_ln(float64 Fm); | |
33 | float64 float64_sin(float64 rFm); | |
34 | float64 float64_cos(float64 rFm); | |
35 | float64 float64_arcsin(float64 rFm); | |
36 | float64 float64_arctan(float64 rFm); | |
37 | float64 float64_log(float64 rFm); | |
38 | float64 float64_tan(float64 rFm); | |
39 | float64 float64_arccos(float64 rFm); | |
40 | float64 float64_pow(float64 rFn, float64 rFm); | |
41 | float64 float64_pol(float64 rFn, float64 rFm); | |
42 | ||
43 | static float64 float64_rsf(float64 rFn, float64 rFm) | |
44 | { | |
45 | return float64_sub(rFm, rFn); | |
46 | } | |
47 | ||
48 | static float64 float64_rdv(float64 rFn, float64 rFm) | |
49 | { | |
50 | return float64_div(rFm, rFn); | |
51 | } | |
52 | ||
53 | static float64 (*const dyadic_double[16])(float64 rFn, float64 rFm) = { | |
54 | [ADF_CODE >> 20] = float64_add, | |
55 | [MUF_CODE >> 20] = float64_mul, | |
56 | [SUF_CODE >> 20] = float64_sub, | |
57 | [RSF_CODE >> 20] = float64_rsf, | |
58 | [DVF_CODE >> 20] = float64_div, | |
59 | [RDF_CODE >> 20] = float64_rdv, | |
60 | [RMF_CODE >> 20] = float64_rem, | |
61 | ||
62 | /* strictly, these opcodes should not be implemented */ | |
63 | [FML_CODE >> 20] = float64_mul, | |
64 | [FDV_CODE >> 20] = float64_div, | |
65 | [FRD_CODE >> 20] = float64_rdv, | |
66 | }; | |
67 | ||
68 | static float64 float64_mvf(float64 rFm) | |
69 | { | |
70 | return rFm; | |
71 | } | |
72 | ||
73 | static float64 float64_mnf(float64 rFm) | |
74 | { | |
75 | union float64_components u; | |
76 | ||
77 | u.f64 = rFm; | |
78 | #ifdef __ARMEB__ | |
79 | u.i[0] ^= 0x80000000; | |
80 | #else | |
81 | u.i[1] ^= 0x80000000; | |
82 | #endif | |
83 | ||
84 | return u.f64; | |
85 | } | |
86 | ||
87 | static float64 float64_abs(float64 rFm) | |
88 | { | |
89 | union float64_components u; | |
90 | ||
91 | u.f64 = rFm; | |
92 | #ifdef __ARMEB__ | |
93 | u.i[0] &= 0x7fffffff; | |
94 | #else | |
95 | u.i[1] &= 0x7fffffff; | |
96 | #endif | |
97 | ||
98 | return u.f64; | |
99 | } | |
100 | ||
101 | static float64 (*const monadic_double[16])(float64 rFm) = { | |
102 | [MVF_CODE >> 20] = float64_mvf, | |
103 | [MNF_CODE >> 20] = float64_mnf, | |
104 | [ABS_CODE >> 20] = float64_abs, | |
105 | [RND_CODE >> 20] = float64_round_to_int, | |
106 | [URD_CODE >> 20] = float64_round_to_int, | |
107 | [SQT_CODE >> 20] = float64_sqrt, | |
108 | [NRM_CODE >> 20] = float64_mvf, | |
109 | }; | |
110 | ||
111 | unsigned int DoubleCPDO(const unsigned int opcode, FPREG * rFd) | |
112 | { | |
113 | FPA11 *fpa11 = GET_FPA11(); | |
114 | float64 rFm; | |
115 | unsigned int Fm, opc_mask_shift; | |
116 | ||
117 | Fm = getFm(opcode); | |
118 | if (CONSTANT_FM(opcode)) { | |
119 | rFm = getDoubleConstant(Fm); | |
120 | } else { | |
121 | switch (fpa11->fType[Fm]) { | |
122 | case typeSingle: | |
123 | rFm = float32_to_float64(fpa11->fpreg[Fm].fSingle); | |
124 | break; | |
125 | ||
126 | case typeDouble: | |
127 | rFm = fpa11->fpreg[Fm].fDouble; | |
128 | break; | |
129 | ||
130 | default: | |
131 | return 0; | |
132 | } | |
133 | } | |
134 | ||
135 | opc_mask_shift = (opcode & MASK_ARITHMETIC_OPCODE) >> 20; | |
136 | if (!MONADIC_INSTRUCTION(opcode)) { | |
137 | unsigned int Fn = getFn(opcode); | |
138 | float64 rFn; | |
139 | ||
140 | switch (fpa11->fType[Fn]) { | |
141 | case typeSingle: | |
142 | rFn = float32_to_float64(fpa11->fpreg[Fn].fSingle); | |
143 | break; | |
144 | ||
145 | case typeDouble: | |
146 | rFn = fpa11->fpreg[Fn].fDouble; | |
147 | break; | |
148 | ||
149 | default: | |
150 | return 0; | |
151 | } | |
152 | ||
153 | if (dyadic_double[opc_mask_shift]) { | |
154 | rFd->fDouble = dyadic_double[opc_mask_shift](rFn, rFm); | |
155 | } else { | |
156 | return 0; | |
157 | } | |
158 | } else { | |
159 | if (monadic_double[opc_mask_shift]) { | |
160 | rFd->fDouble = monadic_double[opc_mask_shift](rFm); | |
161 | } else { | |
162 | return 0; | |
163 | } | |
164 | } | |
165 | ||
166 | return 1; | |
167 | } |