Rivoreo Source Code Repositories
src.rivoreo.one / emulators / simh / 015f2bb82ec40e5c966a1e3d64603d2d7f7687d7 / . / HP2100 / hp2100_fp1.c
blob: 0ca5084829566681b135d7fbabb526006e743bcf [file] [log] [blame] [raw]
/* hp2100_fp1.c: HP 1000 multiple-precision floating point routines
Copyright (c) 2005-2008, J. David Bryan
Permission is hereby granted, free of charge, to any person obtaining a
copy of this software and associated documentation files (the "Software"),
to deal in the Software without restriction, including without limitation
the rights to use, copy, modify, merge, publish, distribute, sublicense,
and/or sell copies of the Software, and to permit persons to whom the
Software is furnished to do so, subject to the following conditions:
The above copyright notice and this permission notice shall be included in
all copies or substantial portions of the Software.
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
THE AUTHOR BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
Except as contained in this notice, the name of the author shall not be used
in advertising or otherwise to promote the sale, use or other dealings in
this Software without prior written authorization from the author.
08-Jun-08 JDB Quieted bogus gcc warning in fp_exec
10-May-08 JDB Fixed uninitialized return in fp_accum when setting
19-Mar-08 JDB Reworked "complement" to avoid inlining bug in gcc-4.x
01-Dec-06 JDB Reworked into generalized multiple-precision ops for FPP
12-Oct-06 JDB Altered x_trun for F-Series FFP compatibility
Added F-Series ..TCM FFP helpers
Primary references:
- HP 1000 M/E/F-Series Computers Engineering and Reference Documentation
(92851-90001, Mar-1981)
- HP 1000 M/E/F-Series Computers Technical Reference Handbook
(5955-0282, Mar-1980)
- DOS/RTE Relocatable Library Reference Manual
(24998-90001, Oct-1981)
This module implements multiple-precision floating-point operations to
support the 1000 F-Series hardware Floating Point Processor. It employs
64-bit integer arithmetic for speed and simplicity of implementation. The
host compiler must support 64-bit integers, and the HAVE_INT64 symbol must be
defined during compilation. If this symbol is not defined, then FPP support
is not available.
HP 2100/1000 computers used a proprietary floating-point format. The 2100
had optional firmware that provided two-word floating-point add, subtract,
multiply, and divide, as well as single-integer fix and float. The 1000-M/E
provided the same two-word firmware operations as standard equipment.
Three-word extended-precision instructions for the 2100 and 1000-M/E were
provided by the optional Fast FORTRAN Processor firmware.
The 1000-F substituted a hardware floating point processor for the firmware
in previous machines. In addition to the two- and three-word formats, the
F-Series introduced a four-word double-precision format. A five-word format
that provided extra range in the exponent by unpacking it from the mantissa
was also provided, although this capability was not documented in the user
manual. In addition, the FPP improved the accuracy of floating-point
calculations, as the firmware versions sacrificed a few bits of precision to
gain speed. Consequently, operations on the F-Series may return results that
differ slightly from the same operations on the M/E-Series or the 2100.
F-Series units after date code 1920 also provided two-word double-integer
instructions in firmware, as well as double-integer fix and float operations.
The original 32-bit floating-point format is as follows:
15 14 0
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
|MS| mantissa high | : M
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
| mantissa low | exponent |XS| : M + 1
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
15 8 7 1 0
Both 23-bit mantissa and 7-bit exponent are in twos-complement form. The
exponent sign bit has been rotated into the LSB of the second word.
The extended-precision floating-point format is a 48-bit extension of the
32-bit format used for single precision. A packed extended-precision value
consists of a 39-bit mantissa and a 7-bit exponent. The format is as
follows:
15 14 0
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
|MS| mantissa high | : M
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
| mantissa middle | : M + 1
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
| mantissa low | exponent |XS| : M + 2
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
15 8 7 1 0
The double-precision floating-point format is similar to the 48-bit
extended-precision format, although with a 55-bit mantissa:
15 14 0
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
|MS| mantissa high | : M
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
| mantissa middle high | : M + 1
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
| mantissa middle low | : M + 2
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
| mantissa low | exponent |XS| : M + 3
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
15 8 7 1 0
The FPP also supports a special five-word expanded-exponent format:
15 14 0
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
|MS| mantissa high | : M
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
| mantissa middle high | : M + 1
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
| mantissa middle low | : M + 2
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
| mantissa low | : M + 3
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
| exponent |XS| : M + 4
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+
15 8 7 1 0
The exponent is a full 16-bit twos-complement value, but the allowed range is
only 10 bits, i.e., -512 to +511.
In a normalized value, the sign and MSB of the mantissa differ. Zero is
represented by all words = 0.
Internally, unpacked floating-point values are contained in a structure
having a signed 64-bit mantissa and a signed 32-bit exponent. Mantissas are
left-justified with the unused bits masked to zero. Exponents are
right-justified. The precision is indicated by the value of a structure
field.
HP terminology for the three-word floating-point format is confused. Some
documents refer to it as "double precision," while others use "extended
precision." The instruction mnemonics begin with "X" (e.g., .XADD),
suggesting the extended-precision term.
HP apparently intended that the four-word double-precision format would be
called "triple-precision," as the instruction mnemonics begin with "T" (e.g.,
".TADD" for the four-word add instruction). The source files for the
software simulations of these instructions for the M/E-Series also explicitly
refer to "triple precision math." However, the engineering documentation and
the F-Series reference manual both use the double-precision term.
This module adopts the single/extended/double terminology and uses the
initial letters of the instructions (F/X/T) to indicate the precision used.
The FPP hardware consisted of two circuit boards that interfaced to the main
CPU via the Microprogammable Processor Port (MPP) that had been introduced
with the 1000 E-Series. One board contained argument registers and ALUs,
split into separate mantissa and exponent parts. The other contained a state
machine sequencer. FPP results were copied automatically to the argument
registers in addition to being available over the MPP, so that chained
operations could be executed from these "accumulators" without reloading.
The FPP operated independently of the CPU. An opcode, specifying one of the
six operations (add, subtract, multiply, divide, fix, or float) was sent to
the FPP, and a start command was given. Operands of appropriate precision
were then supplied to the FPP. Once the operands were received, the FPP
would execute and set a flag when the operation was complete. The result
would then be retrieved from the FPP. The floating-point instruction
firmware in the CPU initiated the desired FPP operation and handled operand
reads from and result writes to main memory.
Under simulation, "fp_exec" provides the six arithmetic operations analogous
to FPP execution. The remainder of the functions are helpers that were
provided by firmware in the 1000-F but that can reuse code needed to simulate
the FPP hardware. As with the hardware, "fp_exec" retains the last result
in an internal accumulator that may be referenced in subsequent operations.
NOTE: this module also provides the floating-point support for the firmware
single-precision 1000-M/E base set and extended-precision FFP instructions.
Because the firmware and hardware implementations returned slightly different
results, particularly with respect to round-off, conditional checks are
implemented in the arithmetic routines. In some cases, entirely different
algorithms are used to ensure fidelity with the real machines. Functionally,
this means that the 2100/1000-M/E and 1000-F floating-point diagnostics are
not interchangeable, and failures are to be expected if a diagnostic is run
on the wrong machine.
*/
#include "hp2100_defs.h"
#include "hp2100_cpu.h"
#include "hp2100_cpu1.h"
#include "hp2100_fp1.h"
#if defined (HAVE_INT64) /* we need int64 support */
/* Field widths. */
#define IN_W_SIGN 1
#define IN_W_SMAGN 15
#define IN_W_DMAGN 31
#define FP_W_MSIGN 1
#define FP_W_FMANT 23
#define FP_W_XMANT 39
#define FP_W_TMANT 55
#define FP_W_EMANT 55
#define FP_W_EXPANDEXP 9
#define FP_W_EXP 7
#define FP_W_ESIGN 1
/* Starting bit numbers. */
#define IN_V_SIGN (64 - IN_W_SIGN)
#define IN_V_SNUM (64 - IN_W_SIGN - IN_W_SMAGN)
#define IN_V_DNUM (64 - IN_W_SIGN - IN_W_DMAGN)
#define FP_V_FNUM (64 - FP_W_MSIGN - FP_W_FMANT - FP_W_EXP - FP_W_ESIGN)
#define FP_V_XNUM (64 - FP_W_MSIGN - FP_W_XMANT - FP_W_EXP - FP_W_ESIGN)
#define FP_V_TNUM (64 - FP_W_MSIGN - FP_W_TMANT - FP_W_EXP - FP_W_ESIGN)
#define FP_V_ENUM (64 - FP_W_MSIGN - FP_W_EMANT - FP_W_EXP - FP_W_ESIGN)
#define FP_V_MSIGN (64 - FP_W_MSIGN)
#define FP_V_FMANT (64 - FP_W_MSIGN - FP_W_FMANT)
#define FP_V_XMANT (64 - FP_W_MSIGN - FP_W_XMANT)
#define FP_V_TMANT (64 - FP_W_MSIGN - FP_W_TMANT)
#define FP_V_EMANT (64 - FP_W_MSIGN - FP_W_EMANT)
#define FP_V_EXP 1
#define FP_V_ESIGN 0
/* Right-aligned field masks. */
#define IN_M_SIGN (((t_uint64) 1 << IN_W_SIGN) - 1)
#define IN_M_SMAGN (((t_uint64) 1 << IN_W_SMAGN) - 1)
#define IN_M_DMAGN (((t_uint64) 1 << IN_W_DMAGN) - 1)
#define FP_M_MSIGN (((t_uint64) 1 << FP_W_MSIGN) - 1)
#define FP_M_FMANT (((t_uint64) 1 << FP_W_FMANT) - 1)
#define FP_M_XMANT (((t_uint64) 1 << FP_W_XMANT) - 1)
#define FP_M_TMANT (((t_uint64) 1 << FP_W_TMANT) - 1)
#define FP_M_EMANT (((t_uint64) 1 << FP_W_EMANT) - 1)
#define FP_M_EXPANDEXP ((1 << FP_W_EXPANDEXP) - 1)
#define FP_M_EXP ((1 << FP_W_EXP) - 1)
#define FP_M_ESIGN ((1 << FP_W_ESIGN) - 1)
/* In-place field masks. */
#define IN_SIGN (IN_M_SIGN << IN_V_SIGN)
#define IN_SMAGN (IN_M_SMAGN << IN_V_SNUM)
#define IN_DMAGN (IN_M_DMAGN << IN_V_DNUM)
#define FP_MSIGN (FP_M_MSIGN << FP_V_MSIGN)
#define FP_FMANT (FP_M_FMANT << FP_V_FMANT)
#define FP_XMANT (FP_M_XMANT << FP_V_XMANT)
#define FP_TMANT (FP_M_TMANT << FP_V_TMANT)
#define FP_EMANT (FP_M_EMANT << FP_V_EMANT)
#define FP_EXP (FP_M_EXP << FP_V_EXP)
#define FP_ESIGN (FP_M_ESIGN << FP_V_ESIGN)
/* In-place record masks. */
#define IN_SSMAGN (IN_SIGN | IN_SMAGN)
#define IN_SDMAGN (IN_SIGN | IN_DMAGN)
#define FP_SFMANT (FP_MSIGN | FP_FMANT)
#define FP_SXMANT (FP_MSIGN | FP_XMANT)
#define FP_STMANT (FP_MSIGN | FP_TMANT)
#define FP_SEMANT (FP_MSIGN | FP_EMANT)
#define FP_SEXP (FP_ESIGN | FP_EXP)
/* Minima and maxima. */
#define FP_ONEHALF ((t_int64) 1 << (FP_V_MSIGN - 1)) /* mantissa = 0.5 */
#define FP_MAXPMANT ((t_int64) FP_EMANT) /* maximum pos mantissa */
#define FP_MAXNMANT ((t_int64) FP_MSIGN) /* maximum neg mantissa */
#define FP_MAXPEXP (FP_M_EXPANDEXP) /* maximum pos expanded exponent */
#define FP_MAXNEXP (-(FP_MAXPEXP + 1)) /* maximum neg expanded exponent */
/* Floating-point helpers. */
#define DENORM(x) ((((x) ^ (x) << 1) & FP_MSIGN) == 0)
#define TO_EXP(e) (int8) ((e >> FP_V_EXP & FP_M_EXP) | \
(e & FP_M_ESIGN ? ~FP_M_EXP : 0))
/* Property constants. */
static const t_int64 p_half_lsb[6] = { ((t_int64) 1 << IN_V_SNUM) - 1, /* different than FP! */
((t_int64) 1 << IN_V_DNUM) - 1, /* different than FP! */
(t_int64) 1 << (FP_V_FMANT - 1),
(t_int64) 1 << (FP_V_XMANT - 1),
(t_int64) 1 << (FP_V_TMANT - 1),
(t_int64) 1 << (FP_V_EMANT - 1) };
static const t_int64 n_half_lsb[6] = { 0,
0,
((t_int64) 1 << (FP_V_FMANT - 1)) - 1,
((t_int64) 1 << (FP_V_XMANT - 1)) - 1,
((t_int64) 1 << (FP_V_TMANT - 1)) - 1,
((t_int64) 1 << (FP_V_EMANT - 1)) - 1 };
static const uint32 op_start[6] = { IN_V_SNUM,
IN_V_DNUM,
FP_V_FMANT,
FP_V_XMANT,
FP_V_TMANT,
FP_V_EMANT };
static const t_int64 mant_mask[6] = { IN_SSMAGN,
IN_SDMAGN,
FP_SFMANT,
FP_SXMANT,
FP_STMANT,
FP_SEMANT };
static const uint32 op_bits[6] = { IN_W_SMAGN,
IN_W_DMAGN,
FP_W_FMANT + FP_W_MSIGN,
FP_W_XMANT + FP_W_MSIGN,
FP_W_TMANT + FP_W_MSIGN,
FP_W_EMANT + FP_W_MSIGN };
static const t_int64 op_mask[6] = { ~(t_int64) 0 << IN_V_SNUM,
~(t_int64) 0 << IN_V_DNUM,
~(t_int64) 0 << FP_V_FNUM,
~(t_int64) 0 << FP_V_XNUM,
~(t_int64) 0 << FP_V_TNUM,
~(t_int64) 0 << FP_V_ENUM };
static const uint32 int_p_max[2] = { IN_M_SMAGN,
IN_M_DMAGN };
/* Internal unpacked floating-point representation. */
typedef struct {
t_int64 mantissa;
int32 exponent;
OPSIZE precision;
} FPU;
/* Low-level helper routines. */
/* Arithmetic shift right for mantissa only.
Returns TRUE if any one-bits are shifted out (for F-series only).
*/
static t_bool asr (FPU *operand, int32 shift)
{
t_uint64 mask;
t_bool bits_lost;
if (UNIT_CPU_MODEL == UNIT_1000_F) { /* F-series? */
mask = ((t_uint64) 1 << shift) - 1; /* mask for lost bits */
bits_lost = ((operand->mantissa & mask) != 0); /* flag if any lost */
}
else
bits_lost = FALSE;
operand->mantissa = operand->mantissa >> shift; /* mantissa is int, so ASR */
return bits_lost;
}
/* Logical shift right for mantissa and exponent.
Shifts mantissa and corrects exponent for mantissa overflow.
Returns TRUE if any one-bits are shifted out (for F-series only).
*/
static t_bool lsrx (FPU *operand, int32 shift)
{
t_uint64 mask;
t_bool bits_lost;
if (UNIT_CPU_MODEL == UNIT_1000_F) { /* F-series? */
mask = ((t_uint64) 1 << shift) - 1; /* mask for lost bits */
bits_lost = ((operand->mantissa & mask) != 0); /* flag if any lost */
}
else
bits_lost = FALSE;
operand->mantissa = (t_uint64) operand->mantissa >> shift; /* uint, so LSR */
operand->exponent = operand->exponent + shift; /* correct exponent */
return bits_lost;
}
/* Unpack an operand into a long integer.
Returns a left-aligned integer or mantissa. Does not mask to precision; this
should be done subsequently if desired.
*/
static t_int64 unpack_int (OP packed, OPSIZE precision)
{
uint32 i;
t_uint64 unpacked = 0;
if (precision == in_s)
unpacked = (t_uint64) packed.word << 48; /* unpack single integer */
else if (precision == in_d)
unpacked = (t_uint64) packed.dword << 32; /* unpack double integer */
else {
if (precision == fp_e) /* five word operand? */
precision = fp_t; /* only four mantissa words */
for (i = 0; i < 4; i++) /* unpack fp 2 to 4 words */
if (i < TO_COUNT (precision))
unpacked = unpacked << 16 | packed.fpk[i];
else
unpacked = unpacked << 16;
}
return (t_int64) unpacked;
}
/* Unpack a packed operand.
The packed value is split into separate mantissa and exponent variables. The
multiple words of the mantissa are concatenated into a single 64-bit signed
value, and the exponent is shifted with recovery of the sign.
*/
static FPU unpack (OP packed, OPSIZE precision)
{
FPU unpacked;
unpacked.precision = precision; /* set value's precision */
unpacked.mantissa = /* unpack and mask mantissa */
unpack_int (packed, precision) & mant_mask[precision];
switch (precision) {
case fp_f:
case fp_x:
case fp_t:
unpacked.exponent = /* unpack exponent from correct word */
TO_EXP (packed.fpk[(uint32) precision - 1]);
break;
case fp_e:
unpacked.exponent = /* unpack expanded exponent */
(int16) (packed.fpk[4] >> FP_V_EXP | /* rotate sign into place */
(packed.fpk[4] & 1 ? SIGN : 0));
break;
case fp_a: /* no action for value in accum */
case in_s: /* integers don't use exponent */
case in_d: /* integers don't use exponent */
default:
unpacked.exponent = 0;
break;
}
return unpacked;
}
/* Pack a long integer into an operand. */
static OP pack_int (t_int64 unpacked, OPSIZE precision)
{
int32 i;
OP packed;
if (precision == in_s)
packed.word = (uint16) (unpacked >> 48) & DMASK; /* pack single integer */
else if (precision == in_d)
packed.dword = (uint32) (unpacked >> 32) & DMASK32; /* pack double integer */
else {
if (precision == fp_e) /* five word operand? */
precision = fp_t; /* only four mantissa words */
for (i = 3; i >= 0; i--) { /* pack fp 2 to 4 words */
packed.fpk[i] = (uint16) unpacked & DMASK;
unpacked = unpacked >> 16;
}
}
return packed;
}
/* Pack an unpacked floating-point number.
The 64-bit mantissa is split into the appropriate number of 16-bit words.
The exponent is rotated to incorporate the sign bit and merged into the
appropriate word.
*/
static OP pack (FPU unpacked)
{
OP packed;
uint8 exp;
packed = pack_int (unpacked.mantissa, unpacked.precision); /* pack mantissa */
exp = ((uint8) unpacked.exponent << FP_V_EXP) | /* rotate exponent */
((unpacked.exponent < 0) << FP_V_ESIGN);
switch (unpacked.precision) { /* merge exponent into correct word */
case in_s: /* no action for integers */
case in_d:
break;
case fp_f: /* merge into last word */
case fp_x:
case fp_t:
packed.fpk[(uint32) unpacked.precision - 1] =
(packed.fpk[(uint32) unpacked.precision - 1] & ~FP_SEXP) | exp;
break;
case fp_e: /* place in separate word */
packed.fpk[4] = ((uint16) unpacked.exponent << FP_V_EXP) |
((unpacked.exponent < 0) << FP_V_ESIGN);
break;
case fp_a: /* no action for value in accum */
break;
}
return packed;
}
/* Normalize an unpacked floating-point number.
Floating-point numbers are in normal form if the sign bit and the MSB of the
mantissa differ. Unnormalized numbers are shifted as needed with appropriate
exponent modification.
*/
static void normalize (FPU *unpacked)
{
if (unpacked->mantissa) /* non-zero? */
while (DENORM (unpacked->mantissa)) { /* normal form? */
unpacked->exponent = unpacked->exponent - 1; /* no, so left shift */
unpacked->mantissa = unpacked->mantissa << 1;
}
else
unpacked->exponent = 0; /* clean for zero */
return;
}
/* Round an unpacked floating-point number and check for overflow.
An unpacked floating-point number is rounded by adding one-half of the LSB
value, maintaining symmetry around zero. If rounding resulted in a mantissa
overflow, the result logically is shifted to the right with an appropriate
exponent modification. Finally, the result is checked for exponent underflow
or overflow, and the appropriate approximation (zero or infinity) is
returned.
Rounding in hardware involves a special mantissa extension register that
holds three "guard" bits and one "sticky" bit. These represent the value of
bits right-shifted out the mantissa register. Under simulation, we track
such right-shifts and utilize the lower eight bits of the 64-bit mantissa
value to simulate the extension register.
Overflow depends on whether the FPP expanded-exponent form is being used
(this expands the exponent range by two bits). If overflow is detected, the
value representing infinity is dependent on whether the operation is on
behalf of the Fast FORTRAN Processor. The F-Series FPP returns positive
infinity on both positive and negative overflow for all precisions. The 2100
and M/E-Series FFPs return negative infinity on negative overflow of
extended-precision values. Single-precision overflows on these machines
always return positive infinity.
The number to be rounded must be normalized upon entry.
*/
static uint32 roundovf (FPU *unpacked, t_bool expand)
{
uint32 overflow;
t_bool sign;
sign = (unpacked->mantissa < 0); /* save mantissa sign */
if (sign) /* round and mask the number */
unpacked->mantissa =
(unpacked->mantissa + n_half_lsb[unpacked->precision]) &
mant_mask[unpacked->precision];
else
unpacked->mantissa =
(unpacked->mantissa + p_half_lsb[unpacked->precision]) &
mant_mask[unpacked->precision];
if (sign != (unpacked->mantissa < 0)) /* mantissa overflow? */
lsrx (unpacked, 1); /* correct by shifting */
else
normalize (unpacked); /* renorm may be needed */
if (unpacked->mantissa == 0) { /* result zero? */
unpacked->mantissa = 0; /* return zero */
unpacked->exponent = 0;
overflow = 0; /* with overflow clear */
}
else if (unpacked->exponent < /* result underflow? */
(FP_MAXNEXP >> (expand ? 0 : 2))) {
unpacked->mantissa = 0; /* return zero */
unpacked->exponent = 0;
overflow = 1; /* and set overflow */
}
else if (unpacked->exponent > /* result overflow? */
(FP_MAXPEXP >> (expand ? 0 : 2))) {
if (sign && /* negative value? */
(unpacked->precision == fp_x) && /* extended precision? */
(UNIT_CPU_MODEL != UNIT_1000_F)) { /* not F-series? */
unpacked->mantissa = FP_MAXNMANT; /* return negative infinity */
unpacked->exponent = FP_MAXPEXP & FP_M_EXP;
}
else {
unpacked->mantissa = FP_MAXPMANT; /* return positive infinity */
unpacked->exponent = FP_MAXPEXP & FP_M_EXP;
}
overflow = 1; /* and set overflow */
}
else
overflow = 0; /* value is in range */
return overflow;
}
/* Normalize, round, and pack an unpacked floating-point number. */
static uint32 nrpack (OP *packed, FPU unpacked, t_bool expand)
{
uint32 overflow;
normalize (&unpacked); /* normalize for rounding */
overflow = roundovf (&unpacked, expand); /* round and check for overflow */
*packed = pack (unpacked); /* pack result */
return overflow;
}
/* Low-level arithmetic routines. */
/* Complement an unpacked number. */
static void complement (FPU *result)
{
if (result->mantissa == FP_MAXNMANT) { /* maximum negative? */
result->mantissa = FP_ONEHALF; /* complement of -1.0 * 2 ^ n */
result->exponent = result->exponent + 1; /* is 0.5 * 2 ^ (n + 1) */
}
else
result->mantissa = -result->mantissa; /* negate mantissa */
return;
}
/* Add two unpacked numbers.
The mantissas are first aligned if necessary by scaling the smaller of the
two operands. If the magnitude of the difference between the exponents is
greater than the number of significant bits, then the smaller number has been
scaled to zero (swamped), and so the sum is simply the larger operand.
Otherwise, the sum is computed and checked for overflow, which has occured if
the signs of the operands are the same but differ from that of the result.
Scaling and renormalization is perfomed if overflow occurred.
*/
static void add (FPU *sum, FPU augend, FPU addend)
{
int32 magn;
t_bool bits_lost;
if (augend.mantissa == 0)
*sum = addend; /* X + 0 = X */
else if (addend.mantissa == 0)
*sum = augend; /* 0 + X = X */
else {
magn = augend.exponent - addend.exponent; /* difference exponents */
if (magn > 0) { /* addend smaller? */
*sum = augend; /* preset augend */
bits_lost = asr (&addend, magn); /* align addend */
}
else { /* augend smaller? */
*sum = addend; /* preset addend */
magn = -magn; /* make difference positive */
bits_lost = asr (&augend, magn); /* align augend */
}
if (magn <= (int32) op_bits[augend.precision]) { /* value swamped? */
sum->mantissa = /* no, add mantissas */
addend.mantissa + augend.mantissa;
if (((addend.mantissa < 0) == (augend.mantissa < 0)) && /* mantissa overflow? */
((addend.mantissa < 0) != (sum->mantissa < 0))) {
bits_lost = bits_lost | lsrx (sum, 1); /* restore value */
sum->mantissa = /* restore sign */
sum-> mantissa | (addend.mantissa & FP_MSIGN);
}
if (bits_lost) /* any bits lost? */
sum->mantissa = sum->mantissa | 1; /* include one for rounding */
}
}
return;
}
/* Multiply two unpacked numbers.
The single-precision firmware (FMP) operates differently from the firmware
extended-precision (.XMPY) and the hardware multiplies of any precision.
Firmware implementations form 16-bit x 16-bit = 32-bit partial products and
sum them to form the result. The hardware uses a series of shifts and adds.
This means that firmware FMP and hardware FMP return slightly different
values, as may be seen by attempting to run the firmware FMP diagnostic on
the FPP.
The FMP microcode calls a signed multiply routine to calculate three partial
products (all but LSB * LSB). Because the LSBs are unsigned, i.e., all bits
significant, the two MSB * LSB products are calculated using LSB/2. The
unsigned right-shift ensures a positive LSB with no significant bits lost,
because the lower eight bits are unused (they held the vacated exponent). In
order to sum the partial products, the LSB of the result of MSB * MSB is also
right-shifted before addition. Note, though, that this loses a significant
bit. After summation, the result is left-shifted to correct for the original
right shifts.
The .XMPY microcode negates both operands as necessary to produce positive
values and then forms six of the nine 16-bit x 16-bit = 32-bit unsigned
multiplications required for a full 96-bit product. Given a 48-bit
multiplicand "a1a2a3" and a 48-bit multiplier "b1b2b3", the firmware performs
these calculations to develop a 48-bit product:
a1 a2 a3
+-------+-------+-------+
b1 b2 b3
+-------+-------+-------+
_________________________
a1 * b3 [p1]
+-------+-------+
a2 * b2 [p2]
+-------+-------+
a1 * b2 [p3]
+-------+-------+
a3 * b1 [p4]
+-------+-------+
a2 * b1 [p5]
+-------+-------+
a1 * b1 [p6]
+-------+-------+
_________________________________
product
+-------+-------+-------+
The least-significant words of partial products [p1], [p2], and [p4] are used
only to develop a carry bit into the 48-bit sum. The product is complemented
as necessary to restore the sign.
The basic FPP hardware algorithm scans the multiplier and adds a shifted copy
of the multiplicand whenever a one-bit is detected. To avoid successive adds
when a string of ones is encountered (because adds are more expensive than
shifts), the hardware instead adds the multiplicand shifted by N+1+P and
subtracts the multiplicand shifted by P to obtain the equivalent value with a
maximum of two operations.
Instead of implementing either the .XMPY firmware algorithm or the hardware
shift-and-add algorithm directly, it is more efficient under simulation to
use 32 x 32 = 64-bit multiplications, thereby reducing the number required
from six to four (64-bit "c1c2" x 64-bit "d1d2"):
ah al
+-------+-------+
bh bl
+-------+-------+
_________________
al * bl [ll]
+-------+-------+
ah * bl [hl]
+-------+-------+
al * bh [lh]
+-------+-------+
ah * bh [hh]
+-------+-------+
_________________________________
product
+-------+-------+
However, the FMP algorithm is implemented directly from the microcode to
preserve the fidelity of the simulation, i.e., to lose the same amount
of precision.
*/
static void multiply (FPU *product, FPU multiplicand, FPU multiplier)
{
uint32 ah, al, bh, bl, sign = 0;
t_uint64 hh, hl, lh, ll, carry;
int16 ch, cl, dh, dl;
t_bool firmware;
product->precision = multiplicand.precision; /* set precision */
if ((multiplicand.mantissa == 0) || /* 0 * X = 0 */
(multiplier.mantissa == 0)) /* X * 0 = 0 */
product->mantissa = product->exponent = 0;
else {
firmware = (UNIT_CPU_MODEL != UNIT_1000_F); /* set firmware flag */
if (!firmware || (product->precision != fp_f)) { /* hardware? */
if (multiplicand.mantissa < 0) { /* negative? */
complement (&multiplicand); /* complement operand */
sign = ~sign; /* track sign */
}
if (multiplier.mantissa < 0) { /* negative? */
complement (&multiplier); /* complement operand */
sign = ~sign; /* track sign */
}
}
product->exponent = /* compute exponent */
multiplicand.exponent + multiplier.exponent + 1;
ah = (uint32) (multiplicand.mantissa >> 32); /* split multiplicand */
al = (uint32) (multiplicand.mantissa & DMASK32); /* into high and low parts */
bh = (uint32) (multiplier.mantissa >> 32); /* split multiplier */
bl = (uint32) (multiplier.mantissa & DMASK32); /* into high and low parts */
if (firmware && (product->precision == fp_f)) { /* single-precision firmware? */
ch = (int16) (ah >> 16) & DMASK; /* split 32-bit multiplicand */
cl = (int16) (ah & 0xfffe); /* into high and low parts */
dh = (int16) (bh >> 16) & DMASK; /* split 32-bit multiplier */
dl = (int16) (bh & 0xfffe); /* into high and low parts */
hh = (t_uint64) (((int32) ch * dh) & ~1); /* form cross products */
hl = (t_uint64) (((t_int64) ch * (t_int64) (uint16) dl +
(t_int64) dh * (t_int64) (uint16) cl) &
0xfffffffffffe0000);
product->mantissa = (t_uint64) (((t_int64) hh << 32) + /* sum partials */
((t_int64) hl << 16));
}
else {
hh = ((t_uint64) ah * bh); /* form four cross products */
hl = ((t_uint64) ah * bl); /* using 32 x 32 = */
lh = ((t_uint64) al * bh); /* 64-bit multiplies */
ll = ((t_uint64) al * bl);
carry = ((ll >> 32) + (uint32) hl + (uint32) lh) >> 32; /* form carry */
product->mantissa = hh + (hl >> 32) + (lh >> 32) + carry; /* sum partials */
if (sign) /* negate if required */
complement (product);
}
}
return;
}
/* Divide two unpacked numbers.
As with multiply, the single-precision firmware (FDV) operates differently
from the firmware extended-precision (.XDIV) and the hardware divisions of
any precision. Firmware implementations utilize a "divide and correct"
algorithm, wherein the quotient is estimated and then corrected by comparing
the dividend to the product of the quotient and the divisor. The hardware
uses a series of shifts and subtracts. This means that firmware FDV and
hardware FDV once again return slightly different values.
Under simulation, the classic divide-and-correct method is employed, using
64-bit / 32-bit = 32-bit divisions. This involves dividing the 64-bit
dividend "a1a2a3a4" by the first 32-bit digit "b1b2" of the 64-bit divisor
"b1b2b3b4". The resulting 32-bit quotient is ...
The microcoded single-precision division avoids overflows by right-shifting
some values, which leads to a loss of precision in the LSBs. We duplicate
the firmware algorithm here to preserve the fidelity of the simulation.
*/
static void divide (FPU *quotient, FPU dividend, FPU divisor)
{
uint32 sign = 0;
t_int64 bh, bl, r1, r0, p1, p0;
t_uint64 q, q1, q0;
t_bool firmware;
int32 ah, div, cp;
int16 dh, dl, pq1, pq2, cq;
quotient->precision = dividend.precision; /* set precision */
if (divisor.mantissa == 0) { /* division by zero? */
if (dividend.mantissa < 0)
quotient->mantissa = FP_MSIGN; /* return minus infinity */
else
quotient->mantissa = ~FP_MSIGN; /* or plus infinity */
quotient->exponent = FP_MAXPEXP + 1;
}
else if (dividend.mantissa == 0) /* dividend zero? */
quotient->mantissa = quotient->exponent = 0; /* yes; result is zero */
else {
firmware = (UNIT_CPU_MODEL != UNIT_1000_F); /* set firmware flag */
if (!firmware || (quotient->precision != fp_f)) { /* hardware or FFP? */
if (dividend.mantissa < 0) { /* negative? */
complement (&dividend); /* complement operand */
sign = ~sign; /* track sign */
}
if (divisor.mantissa < 0) { /* negative? */
complement (&divisor); /* complement operand */
sign = ~sign; /* track sign */
}
}
quotient->exponent = /* division subtracts exponents */
dividend.exponent - divisor.exponent;
bh = divisor.mantissa >> 32; /* split divisor */
bl = divisor.mantissa & DMASK32; /* into high and low parts */
if (firmware && (quotient->precision == fp_f)) { /* single-precision firmware? */
quotient->exponent = quotient->exponent + 1; /* fix exponent */
ah = (int32) (dividend.mantissa >> 32); /* split dividend */
dh = (int16) (bh >> 16); /* split divisor again */
dl = (int16) bh;
div = ah >> 2; /* ASR 2 to prevent overflow */
pq1 = div / dh; /* form first partial quotient */
div = ((div % dh) & ~1) << 15; /* ASR 1, move rem to upper */
pq2 = div / dh; /* form second partial quotient */
div = (uint16) dl << 13; /* move divisor LSB to upper, LSR 3 */
cq = div / dh; /* form correction quotient */
cp = -cq * pq1; /* and correction product */
cp = (((cp >> 14) & ~3) + (int32) pq2) << 1; /* add corr prod and 2nd partial quo */
quotient->mantissa = /* add 1st partial quo and align */
(t_uint64) (((int32) pq1 << 16) + cp) << 32;
}
else { /* hardware or FFP */
q1 = (t_uint64) (dividend.mantissa / bh); /* form 1st trial quotient */
r1 = dividend.mantissa % bh; /* and remainder */
p1 = (r1 << 24) - (bl >> 8) * q1; /* calculate correction */
while (p1 < 0) { /* correction needed? */
q1 = q1 - 1; /* trial quotient too large */
p1 = p1 + (divisor.mantissa >> 8); /* increase remainder */
}
q0 = (t_uint64) ((p1 << 8) / bh); /* form 2nd trial quotient */
r0 = (p1 << 8) % bh; /* and remainder */
p0 = (r0 << 24) - (bl >> 8) * q0; /* calculate correction */
while (p0 < 0) { /* correction needed? */
q0 = q0 - 1; /* trial quotient too large */
p0 = p0 + (divisor.mantissa >> 8); /* increase remainder */
}
q = (q1 << 32) + q0; /* sum quotient digits */
if (q1 & 0xffffffff00000000) { /* did we lose MSB? */
q = (q >> 1) | 0x8000000000000000; /* shift right and replace bit */
quotient->exponent = quotient->exponent + 1;/* bump exponent for shift */
}
if (q & 0x8000000000000000) /* lose normalization? */
q = q >> 1; /* correct */
quotient->mantissa = (t_int64) q;
}
if (sign)
complement (quotient); /* negate if required */
}
return;
}
/* Fix an unpacked number.
A floating-point value is converted to an integer. The desired precision of
the result (single or double integer) must be set before calling.
Values less than 0.5 (i.e., with negative exponents) underflow to zero. If
the value exceeds the specified integer range, the maximum integer value is
returned and overflow is set. Otherwise, the floating-point value is
right-shifted to zero the exponent. The result is then rounded.
*/
static uint32 fix (FPU *result, FPU operand)
{
uint32 overflow;
t_bool bits_lost;
if (operand.exponent < 0) { /* value < 0.5? */
result->mantissa = 0; /* result rounds to zero */
overflow = 0; /* clear for underflow */
}
else if (operand.exponent > /* value > integer size? */
(int32) op_bits[result->precision]) {
result->mantissa = /* return max int value */
(t_uint64) int_p_max[result->precision] <<
op_start[result->precision];
overflow = 1; /* and set overflow */
}
else { /* value in range */
bits_lost = asr (&operand, /* shift to zero exponent */
op_bits[result->precision] - operand.exponent);
if (operand.mantissa < 0) { /* value negative? */
if (bits_lost) /* bits lost? */
operand.mantissa = operand.mantissa | 1; /* include one for rounding */
operand.mantissa = operand.mantissa + /* round result */
p_half_lsb[result->precision];
}
result->mantissa = operand.mantissa & /* mask to precision */
op_mask[result->precision];
overflow = 0;
}
result->exponent = 0; /* tidy up for integer value */
return overflow;
}
/* Float an integer to an unpacked number.
An integer is converted to a floating-point value. The desired precision of
the result must be set before calling.
Conversion is simply a matter of copying the integer value, setting an
exponent that reflects the right-aligned position of the bits, and
normalizing.
*/
static void ffloat (FPU *result, FPU operand)
{
result->mantissa = operand.mantissa; /* set value */
result->exponent = op_bits[operand.precision]; /* set exponent */
normalize (result); /* normalize */
return;
}
/* High-level floating-point routines. */
/* Determine operand precisions.
The precisions of the operands and result are determined by decoding an
operation opcode and returned to the caller. Pass NULL for both of the
operands if only the result precision is wanted. Pass NULL for the result if
only the operand precisions are wanted.
Implementation note:
1. gcc-4.3.0 complains at -O3 that operand_l/r may not be initialized.
Because of the mask, the switch statement covers all cases, but gcc
doesn't realize this. The "default" case is redundant but eliminates the
warning.
*/
void fp_prec (uint16 opcode, OPSIZE *operand_l, OPSIZE *operand_r, OPSIZE *result)
{
OPSIZE fp_size, int_size;
fp_size = (OPSIZE) ((opcode & 0003) + 2); /* fp_f, fp_x, fp_t, fp_e */
int_size = (OPSIZE) ((opcode & 0004) >> 2); /* in_s, in_d */
if (operand_l && operand_r) { /* want operand precisions? */
switch (opcode & 0120) { /* mask out opcode bit 5 */
case 0000: /* add/mpy */
case 0020: /* sub/div */
*operand_l = fp_size; /* assume first op is fp */
if (opcode & 0004) /* operand internal? */
*operand_r = fp_a; /* second op is accum */
else
*operand_r = fp_size; /* second op is fp */
break;
case 0100: /* fix/accum as integer */
*operand_l = fp_size; /* first op is fp */
*operand_r = fp_a; /* second op is always null */
break;
case 0120: /* flt/accum as float */
default: /* keeps compiler quiet for uninit warning */
*operand_l = int_size; /* first op is integer */
*operand_r = fp_a; /* second op is always null */
break;
}
if (opcode & 0010) /* operand internal? */
*operand_l = fp_a; /* first op is accum */
}
if (result) /* want result precision? */
if ((opcode & 0120) == 0100) /* fix? */
*result = int_size; /* result is integer */
else /* all others */
*result = fp_size; /* result is fp */
return;
}
/* Floating Point Processor executor.
The executor simulates the MPP interface between the CPU and the FPP. The
operation to be performed is specified by the supplied opcode, which conforms
to the FPP hardware interface, as follows:
Bits Value Action
---- ----- ----------------------------------------------
7 0 Exponent range is standard (+/-127)
1 Exponent range is expanded (+/-511)
6-4 000 Add
001 Subtract
010 Multiply
011 Divide
100 Fix
101 Float
110 (diagnostic)
111 (diagnostic)
3 0 Left operand is supplied
1 Left operand in accumulator
2 0 Right operand is supplied (ADD/SUB/MPY/DIV)
Single integer operation (FIX/FLT)
1 Right operand in accumulator (ADD/SUB/MPY/DIV)
Double integer operation (FIX/FLT)
1-0 00 2-word operation
01 3-word operation
10 4-word operation
11 5-word operation
If the opcode specifies that the left (or right) operand is in the
accumulator, then the value supplied for that parameter is not used. All
results are automatically left in the accumulator. If the result is not
needed externally, then NULL may be passed for the result parameter.
To support accumulator set/get operations under simulation, the opcode is
expanded to include a special mode, indicated by bit 15 = 1. In this mode,
if the result parameter is NULL, then the accumulator is set from the value
passed as operand_l. If the result parameter is not null, then the
accumulator value is returned as the result, and operand_l is ignored. The
precision of the operation is performed as specified by the OPSIZE value
passed in bits 2-0 of the opcode.
The function returns 1 if the operation overflows and 0 if not.
*/
uint32 fp_exec (uint16 opcode, OP *result, OP operand_l, OP operand_r)
{
static FPU accumulator;
FPU uoperand_l, uoperand_r;
OPSIZE op_l_prec, op_r_prec, rslt_prec;
uint32 overflow;
if (opcode & SIGN) { /* accumulator mode? */
rslt_prec = (OPSIZE) (opcode & 0017); /* get operation precision */
if (result) { /* get accumulator? */
op_l_prec = accumulator.precision; /* save accum prec temp */
accumulator.precision = rslt_prec; /* set desired precision */
*result = pack (accumulator); /* pack accumulator */
accumulator.precision = op_l_prec; /* restore correct prec */
}
else /* set accumulator */
accumulator = unpack (operand_l, rslt_prec); /* unpack from operand */
return 0; /* no overflow from accum ops */
}
fp_prec (opcode, &op_l_prec, &op_r_prec, &rslt_prec); /* calc precs from opcode */
if (op_l_prec == fp_a) /* left operand in accum? */
uoperand_l = accumulator; /* copy it */
else /* operand supplied */
uoperand_l = unpack (operand_l, op_l_prec); /* unpack from parameter */
if (op_r_prec == fp_a) /* right operand in accum? */
uoperand_r = accumulator; /* copy it */
else /* operand supplied */
uoperand_r = unpack (operand_r, op_r_prec); /* unpack from parameter */
switch (opcode & 0160) { /* dispatch operation */
case 0000: /* add */
add (&accumulator, uoperand_l, uoperand_r);
break;
case 0020: /* subtract */
complement (&uoperand_r);
add (&accumulator, uoperand_l, uoperand_r);
break;
case 0040: /* multiply */
multiply (&accumulator, uoperand_l, uoperand_r);
break;
case 0060: /* divide */
divide (&accumulator, uoperand_l, uoperand_r);
break;
case 0100: /* fix */
accumulator.precision = rslt_prec;
overflow = fix (&accumulator, uoperand_l);
if (result) /* result wanted? */
*result = pack_int (accumulator.mantissa, /* pack integer */
rslt_prec);
return overflow;
case 0120: /* float */
accumulator.precision = rslt_prec;
ffloat (&accumulator, uoperand_l);
if (result) /* result wanted? */
*result = pack (accumulator); /* pack FP (FLT does not round) */
return 0;
case 0140: /* (diagnostic) */
case 0160: /* (diagnostic) */
return 0;
}
if (UNIT_CPU_MODEL != UNIT_1000_F) /* firmware implementation? */
accumulator.mantissa = accumulator.mantissa & /* mask to precision */
op_mask[accumulator.precision];
normalize (&accumulator); /* normalize */
overflow = roundovf (&accumulator, opcode & 0200); /* round and check for overflow */
if (result) /* result wanted? */
*result = pack (accumulator); /* pack result */
return overflow;
}
/* Set or get accumulator at desired precision.
This function provides access to the FPP accumulator. In hardware, the
accumulator may be read at a given precision by sending the FPP an opcode
encoded with the desired precision and then reading words from the FPP
/without/ initiating the operation, i.e., without starting the processor.
Under simulation, pass this function a NULL operand and the desired
precision to read the accumulator. Pass a pointer to an operand and the
desired precision to set the accumulator; the return value in this case is
not defined.
*/
OP fp_accum (const OP *operand, OPSIZE precision)
{
OP result = NOP;
uint16 opcode = (uint16) precision | SIGN; /* add special mode bit */
if (operand)
fp_exec (opcode, NULL, *operand, NOP); /* set accum */
else
fp_exec (opcode, &result, NOP, NOP); /* get accum */
return result;
}
/* Pack an unpacked floating-point number.
An unpacked mantissa is passed as a "packed" number with an unused exponent.
The mantissa and separately-passed exponent are packed into the in-memory
floating-point format. Note that all bits are significant in the mantissa
(no masking is done).
*/
uint32 fp_pack (OP *result, OP mantissa, int32 exponent, OPSIZE precision)
{
FPU unpacked;
unpacked.mantissa = unpack_int (mantissa, precision); /* unpack mantissa */
unpacked.exponent = exponent; /* set exponent */
unpacked.precision = precision; /* set precision */
*result = pack (unpacked); /* pack them */
return 0;
}
/* Normalize, round, and pack an unpacked floating-point number.
An unpacked mantissa is passed as a "packed" number with an unused exponent.
The mantissa and separately-passed exponent are normalized, rounded, and
packed into the in-memory floating-point format. Note that all bits are
significant in the mantissa (no masking is done).
*/
uint32 fp_nrpack (OP *result, OP mantissa, int32 exponent, OPSIZE precision)
{
FPU unpacked;
unpacked.mantissa = unpack_int (mantissa, precision); /* unpack mantissa */
unpacked.exponent = exponent; /* set exponent */
unpacked.precision = precision; /* set precision */
return nrpack (result, unpacked, FALSE); /* norm/rnd/pack them */
}
/* Unpack a packed floating-point number.
A floating-point number, packed into the in-memory format, is unpacked into
separate mantissa and exponent values. The unpacked mantissa is returned in
a "packed" structure with an exponent of zero. Mantissa or exponent may be
null if that part isn't wanted.
*/
uint32 fp_unpack (OP *mantissa, int32 *exponent, OP packed, OPSIZE precision)
{
FPU unpacked;
unpacked = unpack (packed, precision); /* unpack mantissa and exponent */
if (exponent) /* exponent wanted? */
*exponent = unpacked.exponent; /* return exponent */
if (mantissa) /* mantissa wanted? */
*mantissa = pack_int (unpacked.mantissa, fp_t); /* return full-size mantissa */
return 0;
}
/* Complement an unpacked mantissa.
An unpacked mantissa is passed as a "packed" number with a zero exponent.
The exponent increment, i.e., either zero or one, depending on whether a
renormalization was required, is returned. Note that all bits are
significant in the mantissa.
*/
uint32 fp_ucom (OP *mantissa, OPSIZE precision)
{
FPU unpacked;
unpacked.mantissa = unpack_int (*mantissa, precision); /* unpack mantissa */
unpacked.exponent = 0; /* clear undefined exponent */
unpacked.precision = precision; /* set precision */
complement (&unpacked); /* negate it */
*mantissa = pack_int (unpacked.mantissa, precision); /* replace mantissa */
return (uint32) unpacked.exponent; /* return exponent increment */
}
/* Complement a floating-point number. */
uint32 fp_pcom (OP *packed, OPSIZE precision)
{
FPU unpacked;
unpacked = unpack (*packed, precision); /* unpack the number */
complement (&unpacked); /* negate it */
return nrpack (packed, unpacked, FALSE); /* and norm/rnd/pack */
}
/* Truncate a floating-point number. */
uint32 fp_trun (OP *result, OP source, OPSIZE precision)
{
t_bool bits_lost;
FPU unpacked;
FPU one = { FP_ONEHALF, 1, 0 }; /* 0.5 * 2 ** 1 = 1.0 */
OP zero = { { 0, 0, 0, 0, 0 } }; /* 0.0 */
t_uint64 mask = mant_mask[precision] & ~FP_MSIGN;
unpacked = unpack (source, precision);
if (unpacked.exponent < 0) /* number < 0.5? */
*result = zero; /* return 0 */
else if (unpacked.exponent >= (int32) op_bits[precision]) /* no fractional bits? */
*result = source; /* already integer */
else {
mask = (mask >> unpacked.exponent) & mask; /* mask fractional bits */
bits_lost = ((unpacked.mantissa & mask) != 0); /* flag if bits lost */
unpacked.mantissa = unpacked.mantissa & ~mask; /* mask off fraction */
if ((unpacked.mantissa < 0) && bits_lost) /* negative? */
add (&unpacked, unpacked, one); /* truncate toward zero */
nrpack (result, unpacked, FALSE); /* (overflow cannot occur) */
}
return 0; /* clear overflow on return */
}
/* Convert a floating-point number from one precision to another. */
uint32 fp_cvt (OP *result, OPSIZE source_precision, OPSIZE dest_precision)
{
FPU unpacked;
unpacked = unpack (*result, source_precision);
unpacked.precision = dest_precision;
return nrpack (result, unpacked, FALSE); /* norm/rnd/pack */
}
#endif /* end of int64 support */