Merge branch 'topic/asoc' into for-linus
[linux-2.6] / arch / arm / nwfpe / extended_cpdo.c
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 floatx80 floatx80_exp(floatx80 Fm);
27 floatx80 floatx80_ln(floatx80 Fm);
28 floatx80 floatx80_sin(floatx80 rFm);
29 floatx80 floatx80_cos(floatx80 rFm);
30 floatx80 floatx80_arcsin(floatx80 rFm);
31 floatx80 floatx80_arctan(floatx80 rFm);
32 floatx80 floatx80_log(floatx80 rFm);
33 floatx80 floatx80_tan(floatx80 rFm);
34 floatx80 floatx80_arccos(floatx80 rFm);
35 floatx80 floatx80_pow(floatx80 rFn, floatx80 rFm);
36 floatx80 floatx80_pol(floatx80 rFn, floatx80 rFm);
37
38 static floatx80 floatx80_rsf(struct roundingData *roundData, floatx80 rFn, floatx80 rFm)
39 {
40         return floatx80_sub(roundData, rFm, rFn);
41 }
42
43 static floatx80 floatx80_rdv(struct roundingData *roundData, floatx80 rFn, floatx80 rFm)
44 {
45         return floatx80_div(roundData, rFm, rFn);
46 }
47
48 static floatx80 (*const dyadic_extended[16])(struct roundingData*, floatx80 rFn, floatx80 rFm) = {
49         [ADF_CODE >> 20] = floatx80_add,
50         [MUF_CODE >> 20] = floatx80_mul,
51         [SUF_CODE >> 20] = floatx80_sub,
52         [RSF_CODE >> 20] = floatx80_rsf,
53         [DVF_CODE >> 20] = floatx80_div,
54         [RDF_CODE >> 20] = floatx80_rdv,
55         [RMF_CODE >> 20] = floatx80_rem,
56
57         /* strictly, these opcodes should not be implemented */
58         [FML_CODE >> 20] = floatx80_mul,
59         [FDV_CODE >> 20] = floatx80_div,
60         [FRD_CODE >> 20] = floatx80_rdv,
61 };
62
63 static floatx80 floatx80_mvf(struct roundingData *roundData, floatx80 rFm)
64 {
65         return rFm;
66 }
67
68 static floatx80 floatx80_mnf(struct roundingData *roundData, floatx80 rFm)
69 {
70         rFm.high ^= 0x8000;
71         return rFm;
72 }
73
74 static floatx80 floatx80_abs(struct roundingData *roundData, floatx80 rFm)
75 {
76         rFm.high &= 0x7fff;
77         return rFm;
78 }
79
80 static floatx80 (*const monadic_extended[16])(struct roundingData*, floatx80 rFm) = {
81         [MVF_CODE >> 20] = floatx80_mvf,
82         [MNF_CODE >> 20] = floatx80_mnf,
83         [ABS_CODE >> 20] = floatx80_abs,
84         [RND_CODE >> 20] = floatx80_round_to_int,
85         [URD_CODE >> 20] = floatx80_round_to_int,
86         [SQT_CODE >> 20] = floatx80_sqrt,
87         [NRM_CODE >> 20] = floatx80_mvf,
88 };
89
90 unsigned int ExtendedCPDO(struct roundingData *roundData, const unsigned int opcode, FPREG * rFd)
91 {
92         FPA11 *fpa11 = GET_FPA11();
93         floatx80 rFm;
94         unsigned int Fm, opc_mask_shift;
95
96         Fm = getFm(opcode);
97         if (CONSTANT_FM(opcode)) {
98                 rFm = getExtendedConstant(Fm);
99         } else {
100                 switch (fpa11->fType[Fm]) {
101                 case typeSingle:
102                         rFm = float32_to_floatx80(fpa11->fpreg[Fm].fSingle);
103                         break;
104
105                 case typeDouble:
106                         rFm = float64_to_floatx80(fpa11->fpreg[Fm].fDouble);
107                         break;
108
109                 case typeExtended:
110                         rFm = fpa11->fpreg[Fm].fExtended;
111                         break;
112
113                 default:
114                         return 0;
115                 }
116         }
117
118         opc_mask_shift = (opcode & MASK_ARITHMETIC_OPCODE) >> 20;
119         if (!MONADIC_INSTRUCTION(opcode)) {
120                 unsigned int Fn = getFn(opcode);
121                 floatx80 rFn;
122
123                 switch (fpa11->fType[Fn]) {
124                 case typeSingle:
125                         rFn = float32_to_floatx80(fpa11->fpreg[Fn].fSingle);
126                         break;
127
128                 case typeDouble:
129                         rFn = float64_to_floatx80(fpa11->fpreg[Fn].fDouble);
130                         break;
131
132                 case typeExtended:
133                         rFn = fpa11->fpreg[Fn].fExtended;
134                         break;
135
136                 default:
137                         return 0;
138                 }
139
140                 if (dyadic_extended[opc_mask_shift]) {
141                         rFd->fExtended = dyadic_extended[opc_mask_shift](roundData, rFn, rFm);
142                 } else {
143                         return 0;
144                 }
145         } else {
146                 if (monadic_extended[opc_mask_shift]) {
147                         rFd->fExtended = monadic_extended[opc_mask_shift](roundData, rFm);
148                 } else {
149                         return 0;
150                 }
151         }
152
153         return 1;
154 }