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 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