arch/arm/nwfpe/double_cpdo.c

   1 /*
   2     NetWinder Floating Point Emulator
   3     (c) Rebel.COM, 1998,1999
   4
   5     Direct questions, comments to Scott Bambrough <scottb@netwinder.org>
   6
   7     This program is free software; you can redistribute it and/or modify
   8     it under the terms of the GNU General Public License as published by
   9     the Free Software Foundation; either version 2 of the License, or
  10     (at your option) any later version.
  11
  12     This program is distributed in the hope that it will be useful,
  13     but WITHOUT ANY WARRANTY; without even the implied warranty of
  14     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15     GNU General Public License for more details.
  16
  17     You should have received a copy of the GNU General Public License
  18     along with this program; if not, write to the Free Software
  19     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  20 */
  21
  22 #include "fpa11.h"
  23 #include "softfloat.h"
  24 #include "fpopcode.h"
  25
  26 union float64_components {
  27         float64 f64;
  28         unsigned int i[2];
  29 };
  30
  31 float64 float64_exp(float64 Fm);
  32 float64 float64_ln(float64 Fm);
  33 float64 float64_sin(float64 rFm);
  34 float64 float64_cos(float64 rFm);
  35 float64 float64_arcsin(float64 rFm);
  36 float64 float64_arctan(float64 rFm);
  37 float64 float64_log(float64 rFm);
  38 float64 float64_tan(float64 rFm);
  39 float64 float64_arccos(float64 rFm);
  40 float64 float64_pow(float64 rFn, float64 rFm);
  41 float64 float64_pol(float64 rFn, float64 rFm);
  42
  43 static float64 float64_rsf(struct roundingData *roundData, float64 rFn, float64 rFm)
  44 {
  45         return float64_sub(roundData, rFm, rFn);
  46 }
  47
  48 static float64 float64_rdv(struct roundingData *roundData, float64 rFn, float64 rFm)
  49 {
  50         return float64_div(roundData, rFm, rFn);
  51 }
  52
  53 static float64 (*const dyadic_double[16])(struct roundingData*, float64 rFn, float64 rFm) = {
  54         [ADF_CODE >> 20] = float64_add,
  55         [MUF_CODE >> 20] = float64_mul,
  56         [SUF_CODE >> 20] = float64_sub,
  57         [RSF_CODE >> 20] = float64_rsf,
  58         [DVF_CODE >> 20] = float64_div,
  59         [RDF_CODE >> 20] = float64_rdv,
  60         [RMF_CODE >> 20] = float64_rem,
  61
  62         /* strictly, these opcodes should not be implemented */
  63         [FML_CODE >> 20] = float64_mul,
  64         [FDV_CODE >> 20] = float64_div,
  65         [FRD_CODE >> 20] = float64_rdv,
  66 };
  67
  68 static float64 float64_mvf(struct roundingData *roundData,float64 rFm)
  69 {
  70         return rFm;
  71 }
  72
  73 static float64 float64_mnf(struct roundingData *roundData,float64 rFm)
  74 {
  75         union float64_components u;
  76
  77         u.f64 = rFm;
  78 #ifdef __ARMEB__
  79         u.i[0] ^= 0x80000000;
  80 #else
  81         u.i[1] ^= 0x80000000;
  82 #endif
  83
  84         return u.f64;
  85 }
  86
  87 static float64 float64_abs(struct roundingData *roundData,float64 rFm)
  88 {
  89         union float64_components u;
  90
  91         u.f64 = rFm;
  92 #ifdef __ARMEB__
  93         u.i[0] &= 0x7fffffff;
  94 #else
  95         u.i[1] &= 0x7fffffff;
  96 #endif
  97
  98         return u.f64;
  99 }
 100
 101 static float64 (*const monadic_double[16])(struct roundingData *, float64 rFm) = {
 102         [MVF_CODE >> 20] = float64_mvf,
 103         [MNF_CODE >> 20] = float64_mnf,
 104         [ABS_CODE >> 20] = float64_abs,
 105         [RND_CODE >> 20] = float64_round_to_int,
 106         [URD_CODE >> 20] = float64_round_to_int,
 107         [SQT_CODE >> 20] = float64_sqrt,
 108         [NRM_CODE >> 20] = float64_mvf,
 109 };
 110
 111 unsigned int DoubleCPDO(struct roundingData *roundData, const unsigned int opcode, FPREG * rFd)
 112 {
 113         FPA11 *fpa11 = GET_FPA11();
 114         float64 rFm;
 115         unsigned int Fm, opc_mask_shift;
 116
 117         Fm = getFm(opcode);
 118         if (CONSTANT_FM(opcode)) {
 119                 rFm = getDoubleConstant(Fm);
 120         } else {
 121                 switch (fpa11->fType[Fm]) {
 122                 case typeSingle:
 123                         rFm = float32_to_float64(fpa11->fpreg[Fm].fSingle);
 124                         break;
 125
 126                 case typeDouble:
 127                         rFm = fpa11->fpreg[Fm].fDouble;
 128                         break;
 129
 130                 default:
 131                         return 0;
 132                 }
 133         }
 134
 135         opc_mask_shift = (opcode & MASK_ARITHMETIC_OPCODE) >> 20;
 136         if (!MONADIC_INSTRUCTION(opcode)) {
 137                 unsigned int Fn = getFn(opcode);
 138                 float64 rFn;
 139
 140                 switch (fpa11->fType[Fn]) {
 141                 case typeSingle:
 142                         rFn = float32_to_float64(fpa11->fpreg[Fn].fSingle);
 143                         break;
 144
 145                 case typeDouble:
 146                         rFn = fpa11->fpreg[Fn].fDouble;
 147                         break;
 148
 149                 default:
 150                         return 0;
 151                 }
 152
 153                 if (dyadic_double[opc_mask_shift]) {
 154                         rFd->fDouble = dyadic_double[opc_mask_shift](roundData, rFn, rFm);
 155                 } else {
 156                         return 0;
 157                 }
 158         } else {
 159                 if (monadic_double[opc_mask_shift]) {
 160                         rFd->fDouble = monadic_double[opc_mask_shift](roundData, rFm);
 161                 } else {
 162                         return 0;
 163                 }
 164         }
 165
 166         return 1;
 167 }