1 /* $OpenBSD: fpu_qp.c,v 1.2 2004/09/28 18:03:36 otto 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/cdefs.h> 30 #if 0 31 __FBSDID("$FreeBSD: src/lib/libc/sparc64/fpu/fpu_qp.c,v 1.3 2002/09/02 02:30:20 jake Exp $"); 32 #endif 33 34 #include <sys/types.h> 35 #include <machine/fsr.h> 36 37 #include "fpu_emu.h" 38 #include "fpu_extern.h" 39 40 #define _QP_OP(op) \ 41 void _Qp_ ## op(u_int *c, u_int *a, u_int *b); \ 42 void \ 43 _Qp_ ## op(u_int *c, u_int *a, u_int *b) \ 44 { \ 45 struct fpemu fe; \ 46 struct fpn *r; \ 47 __asm __volatile("stx %%fsr, [%0]" : : "r" (&fe.fe_fsr)); \ 48 fe.fe_f1.fp_sign = a[0] >> 31; \ 49 fe.fe_f1.fp_sticky = 0; \ 50 fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, a[0], a[1], a[2], a[3]); \ 51 fe.fe_f2.fp_sign = b[0] >> 31; \ 52 fe.fe_f2.fp_sticky = 0; \ 53 fe.fe_f2.fp_class = __fpu_qtof(&fe.fe_f2, b[0], b[1], b[2], b[3]); \ 54 r = __fpu_ ## op(&fe); \ 55 c[0] = __fpu_ftoq(&fe, r, c); \ 56 } 57 58 #define _QP_TTOQ(qname, fname, ntype, atype, signed, ...) \ 59 void _Qp_ ## qname ## toq(u_int *c, ntype n); \ 60 void \ 61 _Qp_ ## qname ## toq(u_int *c, ntype n) \ 62 { \ 63 struct fpemu fe; \ 64 atype *a; \ 65 __asm __volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :); \ 66 a = (atype *)&n; \ 67 fe.fe_f1.fp_sign = signed ? a[0] >> 31 : 0; \ 68 fe.fe_f1.fp_sticky = 0; \ 69 fe.fe_f1.fp_class = __fpu_ ## fname ## tof(&fe.fe_f1, __VA_ARGS__); \ 70 c[0] = __fpu_ftoq(&fe, &fe.fe_f1, c); \ 71 } 72 73 #define _QP_QTOT4(qname, fname, type, x) \ 74 type _Qp_qto ## qname(u_int *c); \ 75 type \ 76 _Qp_qto ## qname(u_int *c) \ 77 { \ 78 struct fpemu fe; \ 79 u_int *a; \ 80 type n; \ 81 __asm __volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :); \ 82 a = (u_int *)&n; \ 83 fe.fe_f1.fp_sign = c[0] >> 31; \ 84 fe.fe_f1.fp_sticky = 0; \ 85 fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, c[0], c[1], c[2], c[3]); \ 86 a[0] = __fpu_fto ## fname(&fe, &fe.fe_f1, x); \ 87 return (n); \ 88 } 89 90 #define _QP_QTOT3(qname, fname, type) \ 91 type _Qp_qto ## qname(u_int *c); \ 92 type \ 93 _Qp_qto ## qname(u_int *c) \ 94 { \ 95 struct fpemu fe; \ 96 u_int *a; \ 97 type n; \ 98 __asm __volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :); \ 99 a = (u_int *)&n; \ 100 fe.fe_f1.fp_sign = c[0] >> 31; \ 101 fe.fe_f1.fp_sticky = 0; \ 102 fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, c[0], c[1], c[2], c[3]); \ 103 a[0] = __fpu_fto ## fname(&fe, &fe.fe_f1); \ 104 return (n); \ 105 } 106 107 #define _QP_QTOT(qname, fname, type, ...) \ 108 type _Qp_qto ## qname(u_int *c); \ 109 type \ 110 _Qp_qto ## qname(u_int *c) \ 111 { \ 112 struct fpemu fe; \ 113 u_int *a; \ 114 type n; \ 115 __asm __volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :); \ 116 a = (u_int *)&n; \ 117 fe.fe_f1.fp_sign = c[0] >> 31; \ 118 fe.fe_f1.fp_sticky = 0; \ 119 fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, c[0], c[1], c[2], c[3]); \ 120 a[0] = __fpu_fto ## fname(&fe, &fe.fe_f1, ## __VA_ARGS__); \ 121 return (n); \ 122 } 123 124 #define FCC_EQ(fcc) ((fcc) == FSR_CC_EQ) 125 #define FCC_GE(fcc) ((fcc) == FSR_CC_EQ || (fcc) == FSR_CC_GT) 126 #define FCC_GT(fcc) ((fcc) == FSR_CC_GT) 127 #define FCC_LE(fcc) ((fcc) == FSR_CC_EQ || (fcc) == FSR_CC_LT) 128 #define FCC_LT(fcc) ((fcc) == FSR_CC_LT) 129 #define FCC_NE(fcc) ((fcc) != FSR_CC_EQ) 130 131 #define FSR_GET_FCC0(fsr) (((fsr) >> FSR_FCC_SHIFT) & FSR_FCC_MASK) 132 133 #define _QP_CMP(name, cmpe, test) \ 134 int _Qp_f ## name(u_int *a, u_int *b) ; \ 135 int \ 136 _Qp_f ## name(u_int *a, u_int *b) \ 137 { \ 138 struct fpemu fe; \ 139 __asm __volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :); \ 140 fe.fe_f1.fp_sign = a[0] >> 31; \ 141 fe.fe_f1.fp_sticky = 0; \ 142 fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, a[0], a[1], a[2], a[3]); \ 143 fe.fe_f2.fp_sign = b[0] >> 31; \ 144 fe.fe_f2.fp_sticky = 0; \ 145 fe.fe_f2.fp_class = __fpu_qtof(&fe.fe_f2, b[0], b[1], b[2], b[3]); \ 146 __fpu_compare(&fe, cmpe, 0); \ 147 return (test(FSR_GET_FCC0(fe.fe_fsr))); \ 148 } 149 150 void _Qp_sqrt(u_int *c, u_int *a); 151 void 152 _Qp_sqrt(u_int *c, u_int *a) 153 { 154 struct fpemu fe; 155 struct fpn *r; 156 __asm __volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :); 157 fe.fe_f1.fp_sign = a[0] >> 31; 158 fe.fe_f1.fp_sticky = 0; 159 fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, a[0], a[1], a[2], a[3]); 160 r = __fpu_sqrt(&fe); 161 c[0] = __fpu_ftoq(&fe, r, c); 162 } 163 164 _QP_OP(add) 165 _QP_OP(div) 166 _QP_OP(mul) 167 _QP_OP(sub) 168 169 _QP_TTOQ(d, d, double, u_int, 1, a[0], a[1]) 170 _QP_TTOQ(i, i, int, u_int, 1, a[0]) 171 _QP_TTOQ(s, s, float, u_int, 1, a[0]) 172 _QP_TTOQ(x, x, long, u_long, 1, a[0]) 173 _QP_TTOQ(ui, ui, u_int, u_int, 0, a[0]) 174 _QP_TTOQ(ux, ux, u_long, u_long, 0, a[0]) 175 176 _QP_QTOT4(d, d, double, a) 177 _QP_QTOT3(i, i, int) 178 _QP_QTOT3(s, s, float) 179 _QP_QTOT4(x, x, long, a) 180 _QP_QTOT3(ui, i, u_int) 181 _QP_QTOT4(ux, x, u_long, a) 182 183 _QP_CMP(eq, 0, FCC_EQ) 184 _QP_CMP(ge, 0, FCC_GE) 185 _QP_CMP(gt, 0, FCC_GT) 186 _QP_CMP(le, 0, FCC_LE) 187 _QP_CMP(lt, 0, FCC_LT) 188 _QP_CMP(ne, 0, FCC_NE) 189