mysnprintf.c

FreeWRLduneInputDevice和FreeWRL一起可以让用户用带有6DoF的输入设备检索3D VRML/X3D数据。它基于FreeWRL的"/tmp/inpdev"扩展传感器输入接口和w

  int caps = 0;
  
  if (max < 0)
    max = 0;

  uvalue = value;

  if(!(flags & DP_F_UNSIGNED))
  {
    if( value < 0 ) {
      signvalue = '-';
      uvalue = -value;
    }
    else
      if (flags & DP_F_PLUS)  /* Do a sign (+/i) */
	signvalue = '+';
    else
      if (flags & DP_F_SPACE)
	signvalue = ' ';
  }
  
  if (flags & DP_F_UP) caps = 1; /* Should characters be upper case? */

  do {
    convert[place++] =
      (caps? "0123456789ABCDEF":"0123456789abcdef")
      [uvalue % (unsigned)base  ];
    uvalue = (uvalue / (unsigned)base );
  } while(uvalue && (place < 20));
  if (place == 20) place--;
  convert[place] = 0;

  zpadlen = max - place;
  spadlen = min - MAX (max, place) - (signvalue ? 1 : 0);
  if (zpadlen < 0) zpadlen = 0;
  if (spadlen < 0) spadlen = 0;
  if (flags & DP_F_ZERO)
  {
    zpadlen = MAX(zpadlen, spadlen);
    spadlen = 0;
  }
  if (flags & DP_F_MINUS) 
    spadlen = -spadlen; /* Left Justifty */

#ifdef DEBUG_SNPRINTF
  dprint (1, (debugfile, "zpad: %d, spad: %d, min: %d, max: %d, place: %d\n",
      zpadlen, spadlen, min, max, place));
#endif

  /* Spaces */
  while (spadlen > 0) 
  {
    dopr_outch (buffer, currlen, maxlen, ' ');
    --spadlen;
  }

  /* Sign */
  if (signvalue) 
    dopr_outch (buffer, currlen, maxlen, signvalue);

  /* Zeros */
  if (zpadlen > 0) 
  {
    while (zpadlen > 0)
    {
      dopr_outch (buffer, currlen, maxlen, '0');
      --zpadlen;
    }
  }

  /* Digits */
  while (place > 0) 
    dopr_outch (buffer, currlen, maxlen, convert[--place]);
  
  /* Left Justified spaces */
  while (spadlen < 0) {
    dopr_outch (buffer, currlen, maxlen, ' ');
    ++spadlen;
  }
}

static long double abs_val (long double value)
{
  long double result = value;

  if (value < 0)
    result = -value;

  return result;
}

static long double mypow10 (int exp)
{
  long double result = 1;

  while (exp)
  {
    result *= 10;
    exp--;
  }
  
  return result;
}

#ifdef WIN32
static long round (long double value)
{
  long intpart;

  intpart = value;
  value = value - intpart;
  if (value >= 0.5)
    intpart++;

  return intpart;
}
#endif

static void fmtfp (char *buffer, size_t *currlen, size_t maxlen,
		   long double fvalue, int min, int max, int flags)
{
  int signvalue = 0;
  long double ufvalue;
  char iconvert[20];
  char fconvert[20];
  int iplace = 0;
  int fplace = 0;
  int padlen = 0; /* amount to pad */
  int zpadlen = 0; 
  int caps = 0;
  long intpart;
  long fracpart;
  long old_fracpart;
  int zeros;
  int i;

  /* 
   * AIX manpage says the default is 0, but Solaris says the default
   * is 6, and sprintf on AIX defaults to 6
   */
  if (max < 0)
    max = 6;

  ufvalue = abs_val (fvalue);

  if (fvalue < 0)
    signvalue = '-';
  else
    if (flags & DP_F_PLUS)  /* Do a sign (+/i) */
      signvalue = '+';
    else
      if (flags & DP_F_SPACE)
	signvalue = ' ';

#if 0
  if (flags & DP_F_UP) caps = 1; /* Should characters be upper case? */
#endif

  intpart = ufvalue;

  /* 
   * Sorry, we only support 9 digits past the decimal because of our 
   * conversion method
   */
  if (max > 9)
    max = 9;

  /* We "cheat" by converting the fractional part to integer by
   * multiplying by a factor of 10
   */
  
  fracpart = (mypow10 (max)) * (ufvalue - intpart);
  if (fracpart>0)
     {
     zeros=fabs(floor(log(ufvalue - intpart)/log(10))+1);
     if (zeros>=20)
       zeros=20;
     }
  else
     {
     fracpart=0;
     zeros=0;
     }
  old_fracpart=fracpart;

  if (fracpart >= mypow10 (max))
  {
    intpart++;
    fracpart -= mypow10 (max);
  }

#ifdef DEBUG_SNPRINTF
  dprint (1, (debugfile, "fmtfp: %f =? %d.%d\n", fvalue, intpart, fracpart));
#endif

  /* Convert integer part */
  do {
    iconvert[iplace++] =
      (caps? "0123456789ABCDEF":"0123456789abcdef")[intpart % 10];
    intpart = (intpart / 10);
  } while(intpart && (iplace < 20));
  if (iplace == 20) iplace--;
  iconvert[iplace] = 0;

  /* Convert fractional part */
  do {
    fconvert[fplace++] =
      (caps? "0123456789ABCDEF":"0123456789abcdef")[fracpart % 10];
    fracpart = (fracpart / 10);
  } while(fracpart && (fplace-zeros < 20));
  for (i=0;(i<zeros);i++)
     fconvert[fplace++]='0';
  if (fplace == 20) fplace--;
  fconvert[fplace] = 0;

  /* -1 for decimal point, another -1 if we are printing a sign */
  padlen = min - iplace - max - 1 - ((signvalue) ? 1 : 0); 
  zpadlen = max - fplace;
  if (zpadlen < 0)
    zpadlen = 0;
  if (padlen < 0) 
    padlen = 0;
  if (flags & DP_F_MINUS) 
    padlen = -padlen; /* Left Justifty */

  if ((flags & DP_F_ZERO) && (padlen > 0)) 
  {
    if (signvalue) 
    {
      dopr_outch (buffer, currlen, maxlen, signvalue);
      --padlen;
      signvalue = 0;
    }
    while (padlen > 0)
    {
      dopr_outch (buffer, currlen, maxlen, '0');
      --padlen;
    }
  }
  while (padlen > 0)
  {
    dopr_outch (buffer, currlen, maxlen, ' ');
    --padlen;
  }
  if (signvalue) 
    dopr_outch (buffer, currlen, maxlen, signvalue);

  while (iplace > 0) 
    dopr_outch (buffer, currlen, maxlen, iconvert[--iplace]);

  if (old_fracpart!=0) {
     /*
      * Decimal point.  This should probably use locale to find the correct
      * char to print out.
      */
     dopr_outch (buffer, currlen, maxlen, '.');
   
     while (fplace > 0) 
       dopr_outch (buffer, currlen, maxlen, fconvert[--fplace]);
   
     while (zpadlen > 0)
     {
       dopr_outch (buffer, currlen, maxlen, '0');
       --zpadlen;
     }
   
     while (padlen < 0) 
     {
       dopr_outch (buffer, currlen, maxlen, ' ');
       ++padlen;
     }
  }
}


static void dopr_outch (char *buffer, size_t *currlen, size_t maxlen, char c)
{
  if (*currlen < maxlen)
    buffer[(*currlen)++] = c;
}

int myvsnprintf (char *str, size_t count, const char *fmt, va_list args)
{
  str[0] = 0;
  dopr(str, count, fmt, args);
  return(mystrlen(str));
}

/* VARARGS3 */
#ifdef HAVE_STDARGS
int mysnprintf (char *str,size_t count,const char *fmt,...)
#else
int mysnprintf (va_alist) va_dcl
#endif
{
#ifndef HAVE_STDARGS
  char *str;
  size_t count;
  char *fmt;
#endif
  VA_LOCAL_DECL;
    
  VA_START (fmt);
  VA_SHIFT (str, char *);
  VA_SHIFT (count, size_t );
  VA_SHIFT (fmt, char *);
  (void) myvsnprintf(str, count, fmt, ap);
  VA_END;
  return(mystrlen(str));
}

#ifdef WIN32
/* VARARGS3 */
#ifdef HAVE_STDARGS
int __cdecl msgboxprintf (FILE * f,const char *fmt,...)
#else
int __cdecl msgboxprintf (va_alist) va_dcl
#endif
{
#ifndef HAVE_STDARGS
  FILE* f;
  char *fmt;
#endif
  char text[1024];
  VA_LOCAL_DECL;
    
  VA_START (fmt);
  VA_SHIFT (text, char *);
  VA_SHIFT (1024, size_t );
  VA_SHIFT (fmt, char *);
  (void) myvsnprintf(text, 1024, fmt, ap);
  VA_END;
  MessageBox(NULL,text,"white_dune",MB_ICONINFORMATION);
  return(mystrlen(text));
}
#endif

static void fmtefp (char *buffer, size_t *currlen, size_t maxlen,
		   long double evalue, int min, int max, int flags)
{
  long double fvalue;
  int exp;
  
  if (evalue==0)
     dopr_outch(buffer, currlen, maxlen, '0');
  else
     {
     exp=floor(log(fabs(evalue))/log(10.0));
     if ((exp>2) || (exp<-1))
        {
        fvalue=evalue*pow(10.0,-(double)exp);  
        fmtfp (buffer, currlen, maxlen, fvalue, min, max, flags);  
        dopr_outch(buffer, currlen, maxlen, 'e');
        fmtint (buffer,currlen, maxlen,exp,10,min,max,flags);
        }
     else
        fmtfp (buffer, currlen, maxlen, evalue, min, max, flags);
     }
  
}

int mywritestr(int filedes,const char *str)
  {
  int position_written;
  int restlength;
  restlength=mystrlen(str);
  position_written=0;
  while (restlength>0)
     {
     int writereturn;
     if ( (writereturn = write(filedes,str+position_written,restlength)) < 0 )
        return(-1);
     restlength=restlength-writereturn;
     position_written=position_written+writereturn;
     }
  return(0);
  }

/* VARARGS3 */
#ifdef HAVE_STDARGS
int mywritef (int filedes,const char *fmt,...)
#else
int mywritef (va_alist) va_dcl
#endif
{ 
  char str[8000];
#ifndef HAVE_STDARGS
  int filedes;
  char *fmt;
#endif
  VA_LOCAL_DECL;
    
  VA_START (fmt);
  VA_SHIFT (filedes, int);
  VA_SHIFT (fmt, char *);
  (void) myvsnprintf(str,8000, fmt, ap);
  VA_END;
  /* error, myvsnprintf possibly truncated data */
  if (mystrlen(str)>=7999)
     return(-2);
  return mywritestr(filedes,str);
}

char* mystrncpy(char* str1,const char *str2,int n)
   {
   str1[n-1]=0;
   if (strlen(str2)==n)
      return strncpy(str1,str2,n-1);
   else
      return strncpy(str1,str2,n);
   }

#ifdef TEST_SNPRINTF
#ifndef LONG_STRING
#define LONG_STRING 1024
#endif
#include <stdio.h>
int main (void)
{
  char buf1[LONG_STRING];
  char buf2[LONG_STRING];
  char *fp_fmt[] = {
    "%-1.5f",
    "%g",
    "%f",
    "%-1.5f",
    "%1.5f",
    "%123.9f",
    "%10.5f",
    "% 10.5f",
    "%+22.9f",
    "%+4.9f",
    "%01.3f",
    "%4f",
    "%3.1f",
    "%3.2f",
    NULL
  };
  float test_fp_nums[] = { -1, 1, 0.5, 0102.1, 1.0032, 203.9,-1.5, 134.21, 91340.2, 341.1234, 0203.9, 0.96, 0.996, 
    0.9996, 1.996, 1.003, 4.136, 0};
  char *int_fmt[] = {
    "%-1.5d",
    "%1.5d",
    "%123.9d",
    "%5.5d",
    "%10.5d",
    "% 10.5d",
    "%+22.33d",
    "%01.3d",
    "%4d",
    NULL
  };
  long int_nums[] = { -1, 134, 91340, 341, 0203, 0};
  int x, y;
  int fail = 0;
  int num = 0;

  printf ("Testing snprintf format codes against system sprintf...\n");

  for (x = 0; fp_fmt[x] != NULL ; x++)
    {
    for (y = 0; test_fp_nums[y] != 0 ; y++)
    {
      mysnprintf (buf1, sizeof (buf1), fp_fmt[x], test_fp_nums[y]);
      sprintf (buf2, fp_fmt[x], test_fp_nums[y]);
      if (strcmp (buf1, buf2))
      {
	printf("snprintf %lf doesn't match Format: %s\n\tsnprintf = %s\n\tsprintf  = %s\n", 
	    test_fp_nums[y],fp_fmt[x], buf1, buf2);
	fail++;
      }
    }
   mysnprintf (buf1, sizeof (buf1), fp_fmt[x],0);
   sprintf (buf2, fp_fmt[x], 0);
   if (strcmp (buf1, buf2))
   {
      printf("snprintf %lf doesn't match Format: %s\n\tsnprintf = %s\n\tsprintf  = %s\n", 
      test_fp_nums[y],fp_fmt[x], buf1, buf2);
      fail++;
   }
   num++;
  }

  for (x = 0; int_fmt[x] != NULL ; x++)
    for (y = 0; int_nums[y] != 0 ; y++)
    {
      mysnprintf (buf1, sizeof (buf1), int_fmt[x], int_nums[y]);
      sprintf (buf2, int_fmt[x], int_nums[y]);
      if (strcmp (buf1, buf2))
      {
	printf("snprintf doesn't match Format: %s\n\tsnprintf = %s\n\tsprintf  = %s\n", 
	    int_fmt[x], buf1, buf2);
	fail++;
      }
      num++;
    }
  printf ("%d tests failed out of %d.\n", fail, num);
}
#endif /* SNPRINTF_TEST */