116 lines
2.3 KiB
C
116 lines
2.3 KiB
C
#include <_ansi.h>
|
|
#include <limits.h>
|
|
#include <errno.h>
|
|
#include <stdlib.h>
|
|
#include <reent.h>
|
|
#include "fix64.h"
|
|
|
|
/*
|
|
* Convert a string to a fixed-point 64-bit unsigned value.
|
|
*
|
|
* Ignores `locale' stuff.
|
|
*/
|
|
__uint64_t
|
|
_DEFUN (_strtoufix64_r, (rptr, nptr, endptr),
|
|
struct _reent *rptr _AND
|
|
_CONST char *nptr _AND
|
|
char **endptr)
|
|
{
|
|
union long_double_union ldbl;
|
|
int exp, sign, negexp, ld_type;
|
|
__uint64_t tmp, tmp2, result = 0;
|
|
|
|
init(ldbl);
|
|
|
|
_simdstrtold ((char *)nptr, endptr, &ldbl);
|
|
|
|
/* treat NAN as domain error, +/- infinity as saturation */
|
|
ld_type = _simdldcheck (&ldbl.ld);
|
|
if (ld_type != 0)
|
|
{
|
|
if (ld_type == 1)
|
|
{
|
|
rptr->_errno = EDOM;
|
|
return 0;
|
|
}
|
|
rptr->_errno = ERANGE;
|
|
if (word0(ldbl) & Sign_bit)
|
|
return 0;
|
|
return ULONG_LONG_MAX;
|
|
}
|
|
|
|
/* strip off sign and exponent */
|
|
sign = word0(ldbl) & Sign_bit;
|
|
exp = ((word0(ldbl) & Exp_mask) >> Exp_shift) - Bias;
|
|
negexp = -exp;
|
|
if (negexp > 63)
|
|
return 0;
|
|
word0(ldbl) &= ~(Exp_mask | Sign_bit);
|
|
/* add in implicit normalized bit */
|
|
word0(ldbl) |= Exp_msk1;
|
|
/* shift so result is contained in single word */
|
|
tmp = word0(ldbl) << Ebits;
|
|
tmp |= ((unsigned long)word1(ldbl) >> (32 - Ebits));
|
|
tmp <<= 32;
|
|
if (Ebits < 32)
|
|
tmp |= ((unsigned long)word1(ldbl) << Ebits);
|
|
tmp |= ((unsigned long)word2(ldbl) >> (32 - Ebits));
|
|
|
|
/* check for saturation */
|
|
if (sign)
|
|
{
|
|
rptr->_errno = ERANGE;
|
|
return 0;
|
|
}
|
|
else
|
|
{
|
|
if (exp > 0 || (exp == 0 && tmp >= 0x8000000000000000LL))
|
|
{
|
|
rptr->_errno = ERANGE;
|
|
return ULONG_LONG_MAX;
|
|
}
|
|
}
|
|
|
|
/* otherwise we have normal number in range */
|
|
if (negexp > 1)
|
|
{
|
|
tmp2 = tmp + (1 << (negexp - 2));
|
|
result = (tmp2 >> (negexp - 1));
|
|
/* if rounding causes carry, add carry bit in */
|
|
if (tmp2 < tmp)
|
|
result += 1 << (64 - negexp);
|
|
}
|
|
else
|
|
{
|
|
if (Ebits < 32)
|
|
{
|
|
result = tmp + ((word2(ldbl) & (1 << (64 - Ebits - 1))) != 0);
|
|
/* if rounding causes carry, then saturation has occurred */
|
|
if (result < tmp)
|
|
{
|
|
rptr->_errno = ERANGE;
|
|
return ULONG_LONG_MAX;
|
|
}
|
|
}
|
|
else
|
|
result = tmp;
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
#ifndef _REENT_ONLY
|
|
|
|
__uint64_t
|
|
_DEFUN (strtoufix64, (s, ptr, base),
|
|
_CONST char *s _AND
|
|
char **ptr)
|
|
{
|
|
return _strtoufix64_r (_REENT, s, ptr);
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|