123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107 |
- #include "c_stdio.h"
- // #include "driver/uart.h"
- int c_stdin = 999;
- int c_stdout = 1000;
- int c_stderr = 1001;
- // FILE *c_fopen(const char *_name, const char *_type){
- // }
- // FILE *c_freopen(const char *_name, const char *_type, FILE *_f){
- // }
- // FILE *c_tmpfile(void){
- // }
- // int c_putchar(int c){
- // }
- // int c_printf(const char *c, ...){
- // }
- // int c_sprintf(char *c, const char *s, ...){
- // }
- // int c_fprintf(FILE *f, const char *s, ...){
- // }
- // int c_fscanf(FILE *f, const char *s, ...){
- // }
- // int c_fclose(FILE *f){
- // }
- // int c_fflush(FILE *f){
- // }
- // int c_setvbuf(FILE *f, char *c, int d, size_t t){
- // }
- // void c_clearerr(FILE *f){
- // }
- // int c_fseek(FILE *f, long l, int d){
- // }
- // long c_ftell( FILE *f){
- // }
- // int c_fputs(const char *c, FILE *f){
- // }
- // char *c_fgets(char *c, int d, FILE *f){
- // }
- // int c_ungetc(int d, FILE *f){
- // }
- // size_t c_fread(void *p, size_t _size, size_t _n, FILE *f){
- // }
- // size_t c_fwrite(const void *p, size_t _size, size_t _n, FILE *f){
- // }
- // int c_feof(FILE *f){
- // }
- // int c_ferror(FILE *f){
- // }
- // int c_getc(FILE *f){
- // }
- #if defined( LUA_NUMBER_INTEGRAL )
- #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>
- #include "c_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>
- #include "c_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>
- #include "c_string.h"
- #include "c_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 <pmon.h>
- #include "c_string.h"
- typedef unsigned int u_int32_t;
- 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(u_int32_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)
- {
- 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, "-");
- /* 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)
- {
- 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, "-");
- /* 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 <stdarg.h>
- //#include <string.h>
- //#include <ctype.h>
- //#include <pmon.h>
- #include "c_stdarg.h"
- #include "c_string.h"
- #include "c_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;
- #ifdef FLOATINGPT
- double dbl;
- #ifndef NEWFP
- EP ex;
- #endif
- #endif
- dst = d;
- for (; *s;) {
- if (*s == '%') {
- s++;
- fmt = FMT_RJUST;
- width = trunc = haddot = longlong = 0;
- for (; *s; s++) {
- if (strchr("bcdefgilopPrRsuxX%", *s))
- break;
- else if (*s == '-')
- fmt = FMT_LJUST;
- 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);
- else
- btoa(d, va_arg (ap, int), base);
- if (*s == 'X')
- strtoupper(d);
- }
- #ifdef FLOATINGPT
- else if (strchr ("eEfgG", *s)) {
- //static void dtoa (char *, double, int, int, int);
- void dtoa (char *dbuf, rtype arg, int fmtch, int width, int prec);
- dbl = va_arg(ap, double);
- dtoa(d, dbl, *s, width, trunc);
- 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);
- 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)
- {
- 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 == 0)
- prec = 6;
- else 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));
- 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)
- {
- 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
- *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 == '-')
- 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);
- }
- #endif /* FLOATINGPT */
- int c_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
|