1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072 |
- #include <stdio.h>
- #if defined( LUA_NUMBER_INTEGRAL )
- #include <stdarg.h>
- int sprintf(char *s, const char *fmt, ...)
- {
- int n;
- va_list arg;
- va_start(arg, fmt);
- n = ets_vsprintf(s, fmt, arg);
- va_end(arg);
- return n;
- }
- int vsprintf (char *d, const char *s, va_list ap)
- {
- return ets_vsprintf(d, s, ap);
- }
- #else
- #define FLOATINGPT 1
- #define NEWFP 1
- #define ENDIAN_LITTLE 1234
- #define ENDIAN_BIG 4321
- #define ENDIAN_PDP 3412
- #define ENDIAN ENDIAN_LITTLE
- /* $Id: strichr.c,v 1.1.1.1 2006/08/23 17:03:06 pefo Exp $ */
- /*
- * Copyright (c) 2000-2002 Opsycon AB (www.opsycon.se)
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- * 1. Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the distribution.
- * 3. All advertising materials mentioning features or use of this software
- * must display the following acknowledgement:
- * This product includes software developed by Opsycon AB.
- * 4. The name of the author may not be used to endorse or promote products
- * derived from this software without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS
- * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
- * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
- * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
- * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
- * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
- * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
- * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
- * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
- * SUCH DAMAGE.
- *
- */
- #include <string.h>
- char *
- strichr(char *p, int c)
- {
- char *t;
- if (p != NULL) {
- for(t = p; *t; t++);
- for (; t >= p; t--) {
- *(t + 1) = *t;
- }
- *p = c;
- }
- return (p);
- }
- /* $Id: str_fmt.c,v 1.1.1.1 2006/08/23 17:03:06 pefo Exp $ */
- /*
- * Copyright (c) 2000-2002 Opsycon AB (www.opsycon.se)
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- * 1. Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the distribution.
- * 3. All advertising materials mentioning features or use of this software
- * must display the following acknowledgement:
- * This product includes software developed by Opsycon AB.
- * 4. The name of the author may not be used to endorse or promote products
- * derived from this software without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS
- * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
- * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
- * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
- * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
- * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
- * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
- * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
- * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
- * SUCH DAMAGE.
- *
- */
- #include <string.h>
- #define FMT_RJUST 0
- #define FMT_LJUST 1
- #define FMT_RJUST0 2
- #define FMT_CENTER 3
- /*
- * Format string by inserting blanks.
- */
- void
- str_fmt(char *p, int size, int fmt)
- {
- int n, m, len;
- len = strlen (p);
- switch (fmt) {
- case FMT_RJUST:
- for (n = size - len; n > 0; n--)
- strichr (p, ' ');
- break;
- case FMT_LJUST:
- for (m = size - len; m > 0; m--)
- strcat (p, " ");
- break;
- case FMT_RJUST0:
- for (n = size - len; n > 0; n--)
- strichr (p, '0');
- break;
- case FMT_CENTER:
- m = (size - len) / 2;
- n = size - (len + m);
- for (; m > 0; m--)
- strcat (p, " ");
- for (; n > 0; n--)
- strichr (p, ' ');
- break;
- }
- }
- /* $Id: strtoupp.c,v 1.1.1.1 2006/08/23 17:03:06 pefo Exp $ */
- /*
- * Copyright (c) 2000-2002 Opsycon AB (www.opsycon.se)
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- * 1. Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the distribution.
- * 3. All advertising materials mentioning features or use of this software
- * must display the following acknowledgement:
- * This product includes software developed by Opsycon AB.
- * 4. The name of the author may not be used to endorse or promote products
- * derived from this software without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS
- * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
- * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
- * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
- * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
- * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
- * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
- * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
- * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
- * SUCH DAMAGE.
- *
- */
- #include <string.h>
- #include <ctype.h>
- void
- strtoupper(char *p)
- {
- if(!p)
- return;
- for (; *p; p++)
- *p = toupper (*p);
- }
- /* $Id: atob.c,v 1.1.1.1 2006/08/23 17:03:06 pefo Exp $ */
- /*
- * Copyright (c) 2000-2002 Opsycon AB (www.opsycon.se)
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- * 1. Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the distribution.
- * 3. All advertising materials mentioning features or use of this software
- * must display the following acknowledgement:
- * This product includes software developed by Opsycon AB.
- * 4. The name of the author may not be used to endorse or promote products
- * derived from this software without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS
- * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
- * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
- * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
- * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
- * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
- * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
- * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
- * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
- * SUCH DAMAGE.
- *
- */
- //#include <sys/types.h>
- #include <string.h>
- #include <stdint.h>
- //#include <pmon.h>
- typedef unsigned int u_int;
- typedef unsigned long u_long;
- typedef int32_t register_t;
- typedef long long quad_t;
- typedef unsigned long long u_quad_t;
- typedef double rtype;
- #ifndef __P
- #define __P(args) args
- #endif
- static char * _getbase __P((char *, int *));
- static int _atob __P((unsigned long long *, char *p, int));
- static char *
- _getbase(char *p, int *basep)
- {
- if (p[0] == '0') {
- switch (p[1]) {
- case 'x':
- *basep = 16;
- break;
- case 't': case 'n':
- *basep = 10;
- break;
- case 'o':
- *basep = 8;
- break;
- default:
- *basep = 10;
- return (p);
- }
- return (p + 2);
- }
- *basep = 10;
- return (p);
- }
- /*
- * _atob(vp,p,base)
- */
- static int
- _atob (u_quad_t *vp, char *p, int base)
- {
- u_quad_t value, v1, v2;
- char *q, tmp[20];
- int digit;
- if (p[0] == '0' && (p[1] == 'x' || p[1] == 'X')) {
- base = 16;
- p += 2;
- }
- if (base == 16 && (q = strchr (p, '.')) != 0) {
- if (q - p > sizeof(tmp) - 1)
- return (0);
- strncpy (tmp, p, q - p);
- tmp[q - p] = '\0';
- if (!_atob (&v1, tmp, 16))
- return (0);
- q++;
- if (strchr (q, '.'))
- return (0);
- if (!_atob (&v2, q, 16))
- return (0);
- *vp = (v1 << 16) + v2;
- return (1);
- }
- value = *vp = 0;
- for (; *p; p++) {
- if (*p >= '0' && *p <= '9')
- digit = *p - '0';
- else if (*p >= 'a' && *p <= 'f')
- digit = *p - 'a' + 10;
- else if (*p >= 'A' && *p <= 'F')
- digit = *p - 'A' + 10;
- else
- return (0);
- if (digit >= base)
- return (0);
- value *= base;
- value += digit;
- }
- *vp = value;
- return (1);
- }
- /*
- * atob(vp,p,base)
- * converts p to binary result in vp, rtn 1 on success
- */
- int
- atob(uint32_t *vp, char *p, int base)
- {
- u_quad_t v;
- if (base == 0)
- p = _getbase (p, &base);
- if (_atob (&v, p, base)) {
- *vp = v;
- return (1);
- }
- return (0);
- }
- /*
- * llatob(vp,p,base)
- * converts p to binary result in vp, rtn 1 on success
- */
- int
- llatob(u_quad_t *vp, char *p, int base)
- {
- if (base == 0)
- p = _getbase (p, &base);
- return _atob(vp, p, base);
- }
- /*
- * char *btoa(dst,value,base)
- * converts value to ascii, result in dst
- */
- char *
- btoa(char *dst, u_int value, int base, int plussgn)
- {
- char buf[34], digit;
- int i, j, rem, neg;
- if (value == 0) {
- dst[0] = '0';
- dst[1] = 0;
- return (dst);
- }
- neg = 0;
- if (base == -10) {
- base = 10;
- if (value & (1L << 31)) {
- value = (~value) + 1;
- neg = 1;
- }
- }
- for (i = 0; value != 0; i++) {
- rem = value % base;
- value /= base;
- if (rem >= 0 && rem <= 9)
- digit = rem + '0';
- else if (rem >= 10 && rem <= 36)
- digit = (rem - 10) + 'a';
- buf[i] = digit;
- }
- buf[i] = 0;
- if (neg)
- strcat (buf, "-");
- else if (plussgn)
- strcat (buf, "+");
- /* reverse the string */
- for (i = 0, j = strlen (buf) - 1; j >= 0; i++, j--)
- dst[i] = buf[j];
- dst[i] = 0;
- return (dst);
- }
- /*
- * char *btoa(dst,value,base)
- * converts value to ascii, result in dst
- */
- char *
- llbtoa(char *dst, u_quad_t value, int base, int plussgn)
- {
- char buf[66], digit;
- int i, j, rem, neg;
- if (value == 0) {
- dst[0] = '0';
- dst[1] = 0;
- return (dst);
- }
- neg = 0;
- if (base == -10) {
- base = 10;
- if (value & (1LL << 63)) {
- value = (~value) + 1;
- neg = 1;
- }
- }
- for (i = 0; value != 0; i++) {
- rem = value % base;
- value /= base;
- if (rem >= 0 && rem <= 9)
- digit = rem + '0';
- else if (rem >= 10 && rem <= 36)
- digit = (rem - 10) + 'a';
- buf[i] = digit;
- }
- buf[i] = 0;
- if (neg)
- strcat (buf, "-");
- else if (plussgn)
- strcat (buf, "+");
- /* reverse the string */
- for (i = 0, j = strlen (buf) - 1; j >= 0; i++, j--)
- dst[i] = buf[j];
- dst[i] = 0;
- return (dst);
- }
- /*
- * gethex(vp,p,n)
- * convert n hex digits from p to binary, result in vp,
- * rtn 1 on success
- */
- int
- gethex(int32_t *vp, char *p, int n)
- {
- u_long v;
- int digit;
- for (v = 0; n > 0; n--) {
- if (*p == 0)
- return (0);
- if (*p >= '0' && *p <= '9')
- digit = *p - '0';
- else if (*p >= 'a' && *p <= 'f')
- digit = *p - 'a' + 10;
- else if (*p >= 'A' && *p <= 'F')
- digit = *p - 'A' + 10;
- else
- return (0);
- v <<= 4;
- v |= digit;
- p++;
- }
- *vp = v;
- return (1);
- }
- /* $Id: vsprintf.c,v 1.1.1.1 2006/08/23 17:03:06 pefo Exp $ */
- /*
- * Copyright (c) 2000-2002 Opsycon AB (www.opsycon.se)
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- * 1. Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the distribution.
- * 3. All advertising materials mentioning features or use of this software
- * must display the following acknowledgement:
- * This product includes software developed by Opsycon AB.
- * 4. The name of the author may not be used to endorse or promote products
- * derived from this software without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS
- * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
- * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
- * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
- * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
- * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
- * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
- * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
- * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
- * SUCH DAMAGE.
- *
- */
- //#include <stdio.h>
- //#include <pmon.h>
- #include <stdarg.h>
- #include <string.h>
- #include <ctype.h>
- /*
- * int vsprintf(d,s,ap)
- */
- int
- vsprintf (char *d, const char *s, va_list ap)
- {
- const char *t;
- char *p, *dst, tmp[40];
- unsigned int n;
- int fmt, trunc, haddot, width, base, longlong, plussgn;
- #ifdef FLOATINGPT
- double dbl;
- #ifndef NEWFP
- EP ex;
- #endif
- #endif
- dst = d;
- for (; *s;) {
- if (*s == '%') {
- s++;
- fmt = FMT_RJUST;
- width = trunc = haddot = longlong = plussgn = 0;
- for (; *s; s++) {
- if (strchr("bcdefgilopPrRsuxX%", *s))
- break;
- else if (*s == '-')
- fmt = FMT_LJUST;
- else if (*s == '+')
- plussgn = 1;
- else if (*s == '0')
- fmt = FMT_RJUST0;
- else if (*s == '~')
- fmt = FMT_CENTER;
- else if (*s == '*') {
- if (haddot)
- trunc = va_arg(ap, int);
- else
- width = va_arg(ap, int);
- } else if (*s >= '1' && *s <= '9') {
- for (t = s; isdigit(*s); s++);
- strncpy(tmp, t, s - t);
- tmp[s - t] = '\0';
- atob(&n, tmp, 10);
- if (haddot)
- trunc = n;
- else
- width = n;
- s--;
- } else if (*s == '.')
- haddot = 1;
- }
- if (*s == '%') {
- *d++ = '%';
- *d = 0;
- } else if (*s == 's') {
- p = va_arg(ap, char *);
- if (p)
- strcpy(d, p);
- else
- strcpy(d, "(null)");
- } else if (*s == 'c') {
- n = va_arg (ap, int);
- *d = n;
- d[1] = 0;
- } else {
- if (*s == 'l') {
- if (*++s == 'l') {
- longlong = 1;
- ++s;
- }
- }
- if (strchr("bdiopPrRxXu", *s)) {
- if (*s == 'd' || *s == 'i')
- base = -10;
- else if (*s == 'u')
- base = 10;
- else if (*s == 'x' || *s == 'X')
- base = 16;
- else if(*s == 'p' || *s == 'P') {
- base = 16;
- if (*s == 'p') {
- *d++ = '0';
- *d++ = 'x';
- }
- fmt = FMT_RJUST0;
- if (sizeof(long) > 4) {
- width = 16;
- longlong = 1;
- } else {
- width = 8;
- }
- }
- else if(*s == 'r' || *s == 'R') {
- base = 16;
- if (*s == 'r') {
- *d++ = '0';
- *d++ = 'x';
- }
- fmt = FMT_RJUST0;
- if (sizeof(register_t) > 4) {
- width = 16;
- longlong = 1;
- } else {
- width = 8;
- }
- }
- else if (*s == 'o')
- base = 8;
- else if (*s == 'b')
- base = 2;
- if (longlong)
- llbtoa(d, va_arg (ap, quad_t),
- base, plussgn);
- else
- btoa(d, va_arg (ap, int), base, plussgn);
- if (*s == 'X')
- strtoupper(d);
- }
- #ifdef FLOATINGPT
- else if (strchr ("eEfgG", *s)) {
- //static void dtoa (char *, double, int, int, int, int);
- void dtoa (char *dbuf, rtype arg, int fmtch, int width, int prec, int plussgn);
- dbl = va_arg(ap, double);
- if (!haddot) {
- trunc = 6;
- }
- dtoa(d, dbl, *s, width, trunc, plussgn);
- trunc = 0;
- }
- #endif
- }
- if (trunc)
- d[trunc] = 0;
- if (width)
- str_fmt (d, width, fmt);
- for (; *d; d++);
- s++;
- } else
- *d++ = *s++;
- }
- *d = 0;
- return (d - dst);
- }
- #ifdef FLOATINGPT
- /*
- * Floating point output, cvt() onward lifted from BSD sources:
- *
- * Copyright (c) 1990 The Regents of the University of California.
- * All rights reserved.
- *
- * This code is derived from software contributed to Berkeley by
- * Chris Torek.
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- * 1. Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the distribution.
- * 3. All advertising materials mentioning features or use of this software
- * must display the following acknowledgement:
- * This product includes software developed by the University of
- * California, Berkeley and its contributors.
- * 4. Neither the name of the University nor the names of its contributors
- * may be used to endorse or promote products derived from this software
- * without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
- * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
- * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
- * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
- * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
- * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
- * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
- * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
- * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
- * SUCH DAMAGE.
- */
- #define MAX_FCONVERSION 512 /* largest possible real conversion */
- #define MAX_EXPT 5 /* largest possible exponent field */
- #define MAX_FRACT 39 /* largest possible fraction field */
- #define TESTFLAG(x) 0
- typedef double rtype;
- extern double modf(double, double *);
- #define to_char(n) ((n) + '0')
- #define to_digit(c) ((c) - '0')
- #define _isNan(arg) ((arg) != (arg))
- static int cvt (rtype arg, int prec, char *signp, int fmtch,
- char *startp, char *endp, int plussgn);
- static char *c_round (double fract, int *exp, char *start, char *end,
- char ch, char *signp);
- static char *exponent(char *p, int exp, int fmtch);
- /*
- * _finite arg not Infinity or Nan
- */
- static int _finite(rtype d)
- {
- #if ENDIAN == ENDIAN_LITTLE
- struct IEEEdp {
- unsigned manl:32;
- unsigned manh:20;
- unsigned exp:11;
- unsigned sign:1;
- } *ip;
- #else
- struct IEEEdp {
- unsigned sign:1;
- unsigned exp:11;
- unsigned manh:20;
- unsigned manl:32;
- } *ip;
- #endif
- ip = (struct IEEEdp *)&d;
- return (ip->exp != 0x7ff);
- }
- void dtoa (char *dbuf, rtype arg, int fmtch, int width, int prec, int plussgn)
- {
- char buf[MAX_FCONVERSION+1], *cp;
- char sign;
- int size;
- if( !_finite(arg) ) {
- if( _isNan(arg) )
- strcpy (dbuf, "NaN");
- else if( arg < 0)
- strcpy (dbuf, "-Infinity");
- else
- strcpy (dbuf, "Infinity");
- return;
- }
- if (prec > MAX_FRACT)
- prec = MAX_FRACT;
- /* leave room for sign at start of buffer */
- cp = buf + 1;
- /*
- * cvt may have to round up before the "start" of
- * its buffer, i.e. ``intf("%.2f", (double)9.999);'';
- * if the first character is still NUL, it did.
- * softsign avoids negative 0 if _double < 0 but
- * no significant digits will be shown.
- */
- *cp = '\0';
- size = cvt (arg, prec, &sign, fmtch, cp, buf + sizeof(buf), plussgn);
- if (*cp == '\0')
- cp++;
- if (sign)
- *--cp = sign, size++;
- cp[size] = 0;
- memcpy (dbuf, cp, size + 1);
- }
- static int
- cvt(rtype number, int prec, char *signp, int fmtch, char *startp, char *endp, int plussgn)
- {
- register char *p, *t;
- register double fract;
- double integer, tmp;
- int dotrim, expcnt, gformat;
- dotrim = expcnt = gformat = 0;
- if (number < 0) {
- number = -number;
- *signp = '-';
- } else if (plussgn) {
- *signp = '+';
- } else
- *signp = 0;
- fract = modf(number, &integer);
- /* get an extra slot for rounding. */
- t = ++startp;
- /*
- * get integer portion of number; put into the end of the buffer; the
- * .01 is added for modf(356.0 / 10, &integer) returning .59999999...
- */
- for (p = endp - 1; integer; ++expcnt) {
- tmp = modf(integer / 10, &integer);
- *p-- = to_char((int)((tmp + .01) * 10));
- }
- switch (fmtch) {
- case 'f':
- /* reverse integer into beginning of buffer */
- if (expcnt)
- for (; ++p < endp; *t++ = *p);
- else
- *t++ = '0';
- /*
- * if precision required or alternate flag set, add in a
- * decimal point.
- */
- if (prec || TESTFLAG(ALTERNATE_FORM))
- *t++ = '.';
- /* if requires more precision and some fraction left */
- if (fract) {
- if (prec)
- do {
- fract = modf(fract * 10, &tmp);
- *t++ = to_char((int)tmp);
- } while (--prec && fract);
- if (fract)
- startp = c_round(fract, (int *)NULL, startp,
- t - 1, (char)0, signp);
- }
- for (; prec--; *t++ = '0');
- break;
- case 'e':
- case 'E':
- eformat: if (expcnt) {
- *t++ = *++p;
- if (prec || TESTFLAG(ALTERNATE_FORM))
- *t++ = '.';
- /* if requires more precision and some integer left */
- for (; prec && ++p < endp; --prec)
- *t++ = *p;
- /*
- * if done precision and more of the integer component,
- * round using it; adjust fract so we don't re-round
- * later.
- */
- if (!prec && ++p < endp) {
- fract = 0;
- startp = c_round((double)0, &expcnt, startp,
- t - 1, *p, signp);
- }
- /* adjust expcnt for digit in front of decimal */
- --expcnt;
- }
- /* until first fractional digit, decrement exponent */
- else if (fract) {
- /* adjust expcnt for digit in front of decimal */
- for (expcnt = -1;; --expcnt) {
- fract = modf(fract * 10, &tmp);
- if (tmp)
- break;
- }
- *t++ = to_char((int)tmp);
- if (prec || TESTFLAG(ALTERNATE_FORM))
- *t++ = '.';
- }
- else {
- *t++ = '0';
- if (prec || TESTFLAG(ALTERNATE_FORM))
- *t++ = '.';
- }
- /* if requires more precision and some fraction left */
- if (fract) {
- if (prec)
- do {
- fract = modf(fract * 10, &tmp);
- *t++ = to_char((int)tmp);
- } while (--prec && fract);
- if (fract)
- startp = c_round(fract, &expcnt, startp,
- t - 1, (char)0, signp);
- }
- /* if requires more precision */
- for (; prec--; *t++ = '0');
- /* unless alternate flag, trim any g/G format trailing 0's */
- if (gformat && !TESTFLAG(ALTERNATE_FORM)) {
- while (t > startp && *--t == '0');
- if (*t == '.')
- --t;
- ++t;
- }
- t = exponent(t, expcnt, fmtch);
- break;
- case 'g':
- case 'G':
- /* a precision of 0 is treated as a precision of 1. */
- if (!prec)
- ++prec;
- /*
- * ``The style used depends on the value converted; style e
- * will be used only if the exponent resulting from the
- * conversion is less than -4 or greater than the precision.''
- * -- ANSI X3J11
- */
- if (expcnt > prec || (!expcnt && fract && fract < .0001)) {
- /*
- * g/G format counts "significant digits, not digits of
- * precision; for the e/E format, this just causes an
- * off-by-one problem, i.e. g/G considers the digit
- * before the decimal point significant and e/E doesn't
- * count it as precision.
- */
- --prec;
- fmtch -= 2; /* G->E, g->e */
- gformat = 1;
- goto eformat;
- }
- /*
- * reverse integer into beginning of buffer,
- * note, decrement precision
- */
- if (expcnt)
- for (; ++p < endp; *t++ = *p, --prec);
- else
- *t++ = '0';
- /*
- * if precision required or alternate flag set, add in a
- * decimal point. If no digits yet, add in leading 0.
- */
- if (prec || TESTFLAG(ALTERNATE_FORM)) {
- dotrim = 1;
- *t++ = '.';
- }
- else
- dotrim = 0;
- /* if requires more precision and some fraction left */
- if (fract) {
- if (prec) {
- do {
- fract = modf(fract * 10, &tmp);
- *t++ = to_char((int)tmp);
- } while(!tmp && !expcnt);
- while (--prec && fract) {
- fract = modf(fract * 10, &tmp);
- *t++ = to_char((int)tmp);
- }
- }
- if (fract)
- startp = c_round(fract, (int *)NULL, startp,
- t - 1, (char)0, signp);
- }
- /* alternate format, adds 0's for precision, else trim 0's */
- if (TESTFLAG(ALTERNATE_FORM))
- for (; prec--; *t++ = '0');
- else if (dotrim) {
- while (t > startp && *--t == '0');
- if (*t != '.')
- ++t;
- }
- }
- return (t - startp);
- }
- static char *
- c_round(double fract, int *exp, char *start, char *end, char ch, char *signp)
- {
- double tmp;
- if (fract)
- (void)modf(fract * 10, &tmp);
- else
- tmp = to_digit(ch);
- if (tmp > 4)
- for (;; --end) {
- if (*end == '.')
- --end;
- if (++*end <= '9')
- break;
- *end = '0';
- if (end == start) {
- if (exp) { /* e/E; increment exponent */
- *end = '1';
- ++*exp;
- }
- else { /* f; add extra digit */
- *--end = '1';
- --start;
- }
- break;
- }
- }
- /* ``"%.3f", (double)-0.0004'' gives you a negative 0. */
- else if (*signp == '-' || *signp == '+')
- for (;; --end) {
- if (*end == '.')
- --end;
- if (*end != '0')
- break;
- if (end == start)
- *signp = 0;
- }
- return (start);
- }
- static char *
- exponent(char *p, int exp, int fmtch)
- {
- char *t;
- char expbuf[MAX_FCONVERSION];
- *p++ = fmtch;
- if (exp < 0) {
- exp = -exp;
- *p++ = '-';
- }
- else
- *p++ = '+';
- t = expbuf + MAX_FCONVERSION;
- if (exp > 9) {
- do {
- *--t = to_char(exp % 10);
- } while ((exp /= 10) > 9);
- *--t = to_char(exp);
- for (; t < expbuf + MAX_FCONVERSION; *p++ = *t++);
- }
- else {
- *p++ = '0';
- *p++ = to_char(exp);
- }
- return (p);
- }
- int sprintf(char *s, const char *fmt, ...)
- {
- int n;
- va_list arg;
- va_start(arg, fmt);
- n = vsprintf(s, fmt, arg);
- va_end(arg);
- return n;
- }
- #endif /* FLOATINGPT */
- #endif
|