lib/libc/sparc64/fpu/fpu_qp.c

   1 /*-
   2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
   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 __FBSDID("$FreeBSD$");
  31
  32 #include <sys/types.h>
  33 #include <machine/fsr.h>
  34
  35 #include "fpu_emu.h"
  36 #include "fpu_extern.h"
  37
  38 #define _QP_OP(op) \
  39 void _Qp_ ## op(u_int *c, u_int *a, u_int *b); \
  40 void \
  41 _Qp_ ## op(u_int *c, u_int *a, u_int *b) \
  42 { \
  43         struct fpemu fe; \
  44         struct fpn *r; \
  45         __asm __volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :); \
  46         fe.fe_cx = 0; \
  47         fe.fe_f1.fp_sign = a[0] >> 31; \
  48         fe.fe_f1.fp_sticky = 0; \
  49         fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, a[0], a[1], a[2], a[3]); \
  50         fe.fe_f2.fp_sign = b[0] >> 31; \
  51         fe.fe_f2.fp_sticky = 0; \
  52         fe.fe_f2.fp_class = __fpu_qtof(&fe.fe_f2, b[0], b[1], b[2], b[3]); \
  53         r = __fpu_ ## op(&fe); \
  54         c[0] = __fpu_ftoq(&fe, r, c); \
  55         fe.fe_fsr |= fe.fe_cx << FSR_AEXC_SHIFT; \
  56         __asm __volatile("ldx %0, %%fsr" : : "m" (fe.fe_fsr)); \
  57 }
  58
  59 #define _QP_TTOQ(qname, fname, ntype, signpos, atype, ...) \
  60 void _Qp_ ## qname ## toq(u_int *c, ntype n); \
  61 void \
  62 _Qp_ ## qname ## toq(u_int *c, ntype n) \
  63 { \
  64         struct fpemu fe; \
  65         union { atype a[2]; ntype n; } u = { .n = n }; \
  66         __asm __volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :); \
  67         fe.fe_cx = 0; \
  68         fe.fe_f1.fp_sign = (signpos >= 0) ? u.a[0] >> signpos : 0; \
  69         fe.fe_f1.fp_sticky = 0; \
  70         fe.fe_f1.fp_class = __fpu_ ## fname ## tof(&fe.fe_f1, __VA_ARGS__); \
  71         c[0] = __fpu_ftoq(&fe, &fe.fe_f1, c); \
  72         fe.fe_fsr |= fe.fe_cx << FSR_AEXC_SHIFT; \
  73         __asm __volatile("ldx %0, %%fsr" : : "m" (fe.fe_fsr)); \
  74 }
  75
  76 #define _QP_QTOT(qname, fname, type, ...) \
  77 type _Qp_qto ## qname(u_int *c); \
  78 type \
  79 _Qp_qto ## qname(u_int *c) \
  80 { \
  81         struct fpemu fe; \
  82         union { u_int a; type n; } u; \
  83         __asm __volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :); \
  84         fe.fe_cx = 0; \
  85         fe.fe_f1.fp_sign = c[0] >> 31; \
  86         fe.fe_f1.fp_sticky = 0; \
  87         fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, c[0], c[1], c[2], c[3]); \
  88         u.a = __fpu_fto ## fname(&fe, &fe.fe_f1, ## __VA_ARGS__); \
  89         fe.fe_fsr |= fe.fe_cx << FSR_AEXC_SHIFT; \
  90         __asm __volatile("ldx %0, %%fsr" : : "m" (fe.fe_fsr)); \
  91         return (u.n); \
  92 }
  93
  94 #define FCC_EQ(fcc)     ((fcc) == FSR_CC_EQ)
  95 #define FCC_GE(fcc)     ((fcc) == FSR_CC_EQ || (fcc) == FSR_CC_GT)
  96 #define FCC_GT(fcc)     ((fcc) == FSR_CC_GT)
  97 #define FCC_LE(fcc)     ((fcc) == FSR_CC_EQ || (fcc) == FSR_CC_LT)
  98 #define FCC_LT(fcc)     ((fcc) == FSR_CC_LT)
  99 #define FCC_NE(fcc)     ((fcc) != FSR_CC_EQ)
 100 #define FCC_ID(fcc)     (fcc)
 101
 102 #define _QP_CMP(name, cmpe, test) \
 103 int _Qp_ ## name(u_int *a, u_int *b) ; \
 104 int \
 105 _Qp_ ## name(u_int *a, u_int *b) \
 106 { \
 107         struct fpemu fe; \
 108         __asm __volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :); \
 109         fe.fe_cx = 0; \
 110         fe.fe_f1.fp_sign = a[0] >> 31; \
 111         fe.fe_f1.fp_sticky = 0; \
 112         fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, a[0], a[1], a[2], a[3]); \
 113         fe.fe_f2.fp_sign = b[0] >> 31; \
 114         fe.fe_f2.fp_sticky = 0; \
 115         fe.fe_f2.fp_class = __fpu_qtof(&fe.fe_f2, b[0], b[1], b[2], b[3]); \
 116         __fpu_compare(&fe, cmpe, 0); \
 117         fe.fe_fsr |= fe.fe_cx << FSR_AEXC_SHIFT; \
 118         __asm __volatile("ldx %0, %%fsr" : : "m" (fe.fe_fsr)); \
 119         return (test(FSR_GET_FCC0(fe.fe_fsr))); \
 120 }
 121
 122 void _Qp_sqrt(u_int *c, u_int *a);
 123 void
 124 _Qp_sqrt(u_int *c, u_int *a)
 125 {
 126         struct fpemu fe;
 127         struct fpn *r;
 128         __asm __volatile("stx %%fsr, %0" : "=m" (fe.fe_fsr) :);
 129         fe.fe_cx = 0;
 130         fe.fe_f1.fp_sign = a[0] >> 31;
 131         fe.fe_f1.fp_sticky = 0;
 132         fe.fe_f1.fp_class = __fpu_qtof(&fe.fe_f1, a[0], a[1], a[2], a[3]);
 133         r = __fpu_sqrt(&fe);
 134         c[0] = __fpu_ftoq(&fe, r, c);
 135         fe.fe_fsr |= fe.fe_cx << FSR_AEXC_SHIFT;
 136         __asm __volatile("ldx %0, %%fsr" : : "m" (fe.fe_fsr));
 137 }
 138
 139 _QP_OP(add)
 140 _QP_OP(div)
 141 _QP_OP(mul)
 142 _QP_OP(sub)
 143
 144 _QP_TTOQ(d,     d,      double, 31, u_int,  u.a[0], u.a[1])
 145 _QP_TTOQ(i,     i,      int,    31, u_int,  u.a[0])
 146 _QP_TTOQ(s,     s,      float,  31, u_int,  u.a[0])
 147 _QP_TTOQ(x,     x,      long,   63, u_long, u.a[0])
 148 _QP_TTOQ(ui,    i,      u_int,  -1, u_int,  u.a[0])
 149 _QP_TTOQ(ux,    x,      u_long, -1, u_long, u.a[0])
 150
 151 _QP_QTOT(d,     d,      double, &u.a)
 152 _QP_QTOT(i,     i,      int)
 153 _QP_QTOT(s,     s,      float)
 154 _QP_QTOT(x,     x,      long,   &u.a)
 155 _QP_QTOT(ui,    i,      u_int)
 156 _QP_QTOT(ux,    x,      u_long, &u.a)
 157
 158 _QP_CMP(feq,    0,      FCC_EQ)
 159 _QP_CMP(fge,    1,      FCC_GE)
 160 _QP_CMP(fgt,    1,      FCC_GT)
 161 _QP_CMP(fle,    1,      FCC_LE)
 162 _QP_CMP(flt,    1,      FCC_LT)
 163 _QP_CMP(fne,    0,      FCC_NE)
 164 _QP_CMP(cmp,    0,      FCC_ID)
 165 _QP_CMP(cmpe,   1,      FCC_ID)