1 /* $OpenBSD: fpu_qp.c,v 1.9 2019/10/27 21:07:13 guenther Exp $ */
2
3 /*-
4 * Copyright (c) 2002 Jake Burkholder.
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
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 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 */
28
29 #include <sys/types.h>
30 #include <machine/fsr.h>
31
32 #include "fpu_emu.h"
33 #include "fpu_extern.h"
34
35 #define _QP_OP(op) \
36 __dso_hidden void _Qp_ ## op(u_int *c, u_int *a, u_int *b); \
37 PROTO_NORMAL(_Qp_ ## op); \
38 void \
39 _Qp_ ## op(u_int *c, u_int *a, u_int *b) \
40 { \
41 struct fpemu fe; \
42 struct fpn *r; \
43 __asm volatile("stx %%fsr, [%0]" : : "r" (&fe.fe_fsr)); \
44 fe.fe_f1.fp_sign = a[0] >> 31; \
45 fe.fe_f1.fp_sticky = 0; \
46 fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, a[0], a[1], a[2], a[3]); \
47 fe.fe_f2.fp_sign = b[0] >> 31; \
48 fe.fe_f2.fp_sticky = 0; \
49 fe.fe_f2.fp_class = __fpu_qtof(&fe.fe_f2, b[0], b[1], b[2], b[3]); \
50 r = __fpu_ ## op(&fe); \
51 c[0] = __fpu_ftoq(&fe, r, c); \
52 } \
53 DEF_STRONG(_Qp_ ## op); \
54 asm(".protected _Qp_"#op);
55
56 #define _QP_TTOQ(qname, fname, ntype, signpos, atype, ...) \
57 void _Qp_ ## qname ## toq(u_int *c, ntype n); \
58 PROTO_NORMAL(_Qp_ ## qname ## toq); \
59 void \
60 _Qp_ ## qname ## toq(u_int *c, ntype n) \
61 { \
62 struct fpemu fe; \
63 atype *a; \
64 __asm volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :); \
65 a = (atype *)&n; \
66 fe.fe_f1.fp_sign = (signpos >= 0) ? a[0] >> signpos : 0; \
67 fe.fe_f1.fp_sticky = 0; \
68 fe.fe_f1.fp_class = __fpu_ ## fname ## tof(&fe.fe_f1, __VA_ARGS__); \
69 c[0] = __fpu_ftoq(&fe, &fe.fe_f1, c); \
70 } \
71 DEF_STRONG(_Qp_ ## qname ## toq);
72
73 #define _QP_QTOT4(qname, fname, type, x) \
74 type _Qp_qto ## qname(u_int *c); \
75 PROTO_NORMAL(_Qp_qto ## qname); \
76 type \
77 _Qp_qto ## qname(u_int *c) \
78 { \
79 struct fpemu fe; \
80 u_int *a; \
81 type n; \
82 __asm volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :); \
83 a = (u_int *)&n; \
84 fe.fe_f1.fp_sign = c[0] >> 31; \
85 fe.fe_f1.fp_sticky = 0; \
86 fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, c[0], c[1], c[2], c[3]); \
87 a[0] = __fpu_fto ## fname(&fe, &fe.fe_f1, x); \
88 return (n); \
89 } \
90 DEF_STRONG(_Qp_qto ## qname);
91
92 #define _QP_QTOT3(qname, fname, type) \
93 type _Qp_qto ## qname(u_int *c); \
94 PROTO_NORMAL(_Qp_qto ## qname); \
95 type \
96 _Qp_qto ## qname(u_int *c) \
97 { \
98 struct fpemu fe; \
99 u_int *a; \
100 type n; \
101 __asm volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :); \
102 a = (u_int *)&n; \
103 fe.fe_f1.fp_sign = c[0] >> 31; \
104 fe.fe_f1.fp_sticky = 0; \
105 fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, c[0], c[1], c[2], c[3]); \
106 a[0] = __fpu_fto ## fname(&fe, &fe.fe_f1); \
107 return (n); \
108 } \
109 DEF_STRONG(_Qp_qto ## qname);
110
111 #define _QP_QTOT(qname, fname, type, ...) \
112 type _Qp_qto ## qname(u_int *c); \
113 PROTO_NORMAL(_Qp_qto ## qname); \
114 type \
115 _Qp_qto ## qname(u_int *c) \
116 { \
117 struct fpemu fe; \
118 u_int *a; \
119 type n; \
120 __asm volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :); \
121 a = (u_int *)&n; \
122 fe.fe_f1.fp_sign = c[0] >> 31; \
123 fe.fe_f1.fp_sticky = 0; \
124 fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, c[0], c[1], c[2], c[3]); \
125 a[0] = __fpu_fto ## fname(&fe, &fe.fe_f1, ## __VA_ARGS__); \
126 return (n); \
127 } \
128 DEF_STRONG(_Qp_qto ## qname);
129
130 #define FCC_EQ(fcc) ((fcc) == FSR_CC_EQ)
131 #define FCC_GE(fcc) ((fcc) == FSR_CC_EQ || (fcc) == FSR_CC_GT)
132 #define FCC_GT(fcc) ((fcc) == FSR_CC_GT)
133 #define FCC_LE(fcc) ((fcc) == FSR_CC_EQ || (fcc) == FSR_CC_LT)
134 #define FCC_LT(fcc) ((fcc) == FSR_CC_LT)
135 #define FCC_NE(fcc) ((fcc) != FSR_CC_EQ)
136 #define FCC_ID(fcc) (fcc)
137
138 #define FSR_GET_FCC0(fsr) (((fsr) >> FSR_FCC_SHIFT) & FSR_FCC_MASK)
139
140 #define _QP_CMP(name, cmpe, test) \
141 int _Qp_ ## name(u_int *a, u_int *b) ; \
142 PROTO_NORMAL(_Qp_ ## name); \
143 int \
144 _Qp_ ## name(u_int *a, u_int *b) \
145 { \
146 struct fpemu fe; \
147 __asm volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :); \
148 fe.fe_f1.fp_sign = a[0] >> 31; \
149 fe.fe_f1.fp_sticky = 0; \
150 fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, a[0], a[1], a[2], a[3]); \
151 fe.fe_f2.fp_sign = b[0] >> 31; \
152 fe.fe_f2.fp_sticky = 0; \
153 fe.fe_f2.fp_class = __fpu_qtof(&fe.fe_f2, b[0], b[1], b[2], b[3]); \
154 __fpu_compare(&fe, cmpe, 0); \
155 return (test(FSR_GET_FCC0(fe.fe_fsr))); \
156 } \
157 DEF_STRONG(_Qp_ ## name);
158
159 void _Qp_sqrt(u_int *c, u_int *a);
160 PROTO_NORMAL(_Qp_sqrt);
161 void
_Qp_sqrt(u_int * c,u_int * a)162 _Qp_sqrt(u_int *c, u_int *a)
163 {
164 struct fpemu fe;
165 struct fpn *r;
166 __asm volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :);
167 fe.fe_f1.fp_sign = a[0] >> 31;
168 fe.fe_f1.fp_sticky = 0;
169 fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, a[0], a[1], a[2], a[3]);
170 r = __fpu_sqrt(&fe);
171 c[0] = __fpu_ftoq(&fe, r, c);
172 }
173 DEF_STRONG(_Qp_sqrt);
174
175 _QP_OP(add)
176 _QP_OP(div)
177 _QP_OP(mul)
178 _QP_OP(sub)
179
180 _QP_TTOQ(d, d, double, 31, u_int, a[0], a[1])
181 _QP_TTOQ(i, i, int, 31, u_int, a[0])
182 _QP_TTOQ(s, s, float, 31, u_int, a[0])
183 _QP_TTOQ(x, x, long, 63, u_long, a[0])
184 _QP_TTOQ(ui, ui, u_int, -1, u_int, a[0])
185 _QP_TTOQ(ux, ux, u_long, -1, u_long, a[0])
186
187 _QP_QTOT4(d, d, double, a)
188 _QP_QTOT3(i, i, int)
189 _QP_QTOT3(s, s, float)
190 _QP_QTOT4(x, x, long, a)
191 _QP_QTOT3(ui, i, u_int)
192 _QP_QTOT4(ux, x, u_long, a)
193
194 _QP_CMP(feq, 0, FCC_EQ)
195 _QP_CMP(fge, 0, FCC_GE)
196 _QP_CMP(fgt, 0, FCC_GT)
197 _QP_CMP(fle, 0, FCC_LE)
198 _QP_CMP(flt, 0, FCC_LT)
199 _QP_CMP(fne, 0, FCC_NE)
200 _QP_CMP(cmp, 0, FCC_ID)
201 _QP_CMP(cmpe, 1, FCC_ID)
202