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); \ 37PROTO_NORMAL(_Qp_ ## op); \ 38void \ 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} \ 53DEF_STRONG(_Qp_ ## op); \ 54asm(".protected _Qp_"#op); 55 56#define _QP_TTOQ(qname, fname, ntype, signpos, atype, ...) \ 57void _Qp_ ## qname ## toq(u_int *c, ntype n); \ 58PROTO_NORMAL(_Qp_ ## qname ## toq); \ 59void \ 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} \ 71DEF_STRONG(_Qp_ ## qname ## toq); 72 73#define _QP_QTOT4(qname, fname, type, x) \ 74type _Qp_qto ## qname(u_int *c); \ 75PROTO_NORMAL(_Qp_qto ## qname); \ 76type \ 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} \ 90DEF_STRONG(_Qp_qto ## qname); 91 92#define _QP_QTOT3(qname, fname, type) \ 93type _Qp_qto ## qname(u_int *c); \ 94PROTO_NORMAL(_Qp_qto ## qname); \ 95type \ 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} \ 109DEF_STRONG(_Qp_qto ## qname); 110 111#define _QP_QTOT(qname, fname, type, ...) \ 112type _Qp_qto ## qname(u_int *c); \ 113PROTO_NORMAL(_Qp_qto ## qname); \ 114type \ 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} \ 128DEF_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) \ 141int _Qp_ ## name(u_int *a, u_int *b) ; \ 142PROTO_NORMAL(_Qp_ ## name); \ 143int \ 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} \ 157DEF_STRONG(_Qp_ ## name); 158 159void _Qp_sqrt(u_int *c, u_int *a); 160PROTO_NORMAL(_Qp_sqrt); 161void 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} 173DEF_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