[1] | 1 | /* $Id: vsprintf.c,v 1.1.1.1 2003/07/02 13:57:04 eleph Exp $
|
---|
| 2 | *
|
---|
| 3 | * vsprintf and sprintf
|
---|
| 4 | *
|
---|
| 5 | * Copyright (c) 1999 knut st. osmundsen
|
---|
| 6 | *
|
---|
| 7 | * Project Odin Software License can be found in LICENSE.TXT
|
---|
| 8 | *
|
---|
| 9 | */
|
---|
| 10 |
|
---|
| 11 | /*******************************************************************************
|
---|
| 12 | * Defined Constants *
|
---|
| 13 | *******************************************************************************/
|
---|
| 14 | #define ISDIGIT(c) ((c) >= '0' && (c) <= '9')
|
---|
| 15 | #define MAX(a, b) ((a) >= (b) ? (a) : (b))
|
---|
| 16 | #define MIN(a, b) ((a) < (b) ? (a) : (b))
|
---|
| 17 |
|
---|
| 18 | #define NTSF_CAPITAL 0x0001
|
---|
| 19 | #define NTSF_LEFT 0x0002
|
---|
| 20 | #define NTSF_ZEROPAD 0x0004
|
---|
| 21 | #define NTSF_SPECIAL 0x0008
|
---|
| 22 | #define NTSF_VALSIGNED 0x0010
|
---|
| 23 | #define NTSF_PLUS 0x0020
|
---|
| 24 | #define NTSF_BLANK 0x0040
|
---|
| 25 |
|
---|
| 26 | #define INCL_NOAPI
|
---|
| 27 |
|
---|
| 28 | /*******************************************************************************
|
---|
| 29 | * Header Files *
|
---|
| 30 | *******************************************************************************/
|
---|
| 31 | #include <os2.h>
|
---|
| 32 |
|
---|
| 33 | #include <stdarg.h>
|
---|
| 34 |
|
---|
| 35 |
|
---|
| 36 |
|
---|
| 37 | /*******************************************************************************
|
---|
| 38 | * Internal Functions *
|
---|
| 39 | *******************************************************************************/
|
---|
| 40 | static unsigned _strnlen(const char *psz, unsigned cchMax);
|
---|
| 41 | static int _atoi_skip(const char **ppsz);
|
---|
| 42 |
|
---|
| 43 |
|
---|
| 44 | /**
|
---|
| 45 | * Read an integer (decimal) and update the string pointer while reading.
|
---|
| 46 | * Do not support sign values.
|
---|
| 47 | * @returns Integer value.
|
---|
| 48 | * @param ppsz Pointer to pointer to string. The string to be converted.
|
---|
| 49 | */
|
---|
| 50 | static int _atoi_skip(const char **ppsz)
|
---|
| 51 | {
|
---|
| 52 | int iValue = 0;
|
---|
| 53 |
|
---|
| 54 | while (ISDIGIT(**ppsz))
|
---|
| 55 | {
|
---|
| 56 | iValue *= 10;
|
---|
| 57 | iValue += **ppsz - '0';
|
---|
| 58 | (*ppsz)++;
|
---|
| 59 | }
|
---|
| 60 |
|
---|
| 61 | return iValue;
|
---|
| 62 | }
|
---|
| 63 |
|
---|
| 64 |
|
---|
| 65 | /**
|
---|
| 66 | * Finds the length of a string up to cchMax.
|
---|
| 67 | * @returns Length.
|
---|
| 68 | * @param psz Pointer to string.
|
---|
| 69 | * @param cchMax Max length.
|
---|
| 70 | */
|
---|
| 71 | static unsigned _strnlen(const char *psz, unsigned cchMax)
|
---|
| 72 | {
|
---|
| 73 | const char *pszC = psz;
|
---|
| 74 |
|
---|
| 75 | while (cchMax-- > 0 && *psz != '\0')
|
---|
| 76 | psz++;
|
---|
| 77 |
|
---|
| 78 | return psz - pszC;
|
---|
| 79 | }
|
---|
| 80 |
|
---|
| 81 |
|
---|
| 82 | /**
|
---|
| 83 | * Formats a number according to the parameters.
|
---|
| 84 | * @returns Pointer to next char. (after number)
|
---|
| 85 | * @param psz Pointer to output string.
|
---|
| 86 | * @param lValue Value
|
---|
| 87 | * @param uiBase Number representation base.
|
---|
| 88 | * @param cchWidth Width
|
---|
| 89 | * @param cchPrecision Precision.
|
---|
| 90 | * @param fFlags Flags (NTFS_*).
|
---|
| 91 | */
|
---|
| 92 | static char * numtostr(char *psz, long lValue, unsigned int uiBase,
|
---|
| 93 | signed int cchWidth, signed int cchPrecision,
|
---|
| 94 | unsigned int fFlags
|
---|
| 95 | )
|
---|
| 96 | {
|
---|
| 97 | char * achDigits = "0123456789abcdef";
|
---|
| 98 | int cchValue;
|
---|
| 99 | unsigned long ul;
|
---|
| 100 | int i;
|
---|
| 101 | int j;
|
---|
| 102 |
|
---|
| 103 | #ifdef DEBUG
|
---|
| 104 | if (uiBase < 2 || uiBase > 16)
|
---|
| 105 | return NULL;
|
---|
| 106 | #endif
|
---|
| 107 | if (fFlags & NTSF_CAPITAL)
|
---|
| 108 | achDigits = "0123456789ABCDEF";
|
---|
| 109 | if (fFlags & NTSF_LEFT)
|
---|
| 110 | fFlags &= ~NTSF_ZEROPAD;
|
---|
| 111 |
|
---|
| 112 | /* determin value length */
|
---|
| 113 | cchValue = 0;
|
---|
| 114 | ul = (unsigned long)((fFlags & NTSF_VALSIGNED) && lValue < 0L ? -lValue : lValue);
|
---|
| 115 | do
|
---|
| 116 | {
|
---|
| 117 | cchValue++;
|
---|
| 118 | ul /= uiBase;
|
---|
| 119 | } while (ul > 0);
|
---|
| 120 |
|
---|
| 121 | i = 0;
|
---|
| 122 | if (fFlags & NTSF_VALSIGNED)
|
---|
| 123 | {
|
---|
| 124 | if (lValue < 0)
|
---|
| 125 | {
|
---|
| 126 | lValue = -lValue;
|
---|
| 127 | psz[i++] = '-';
|
---|
| 128 | }
|
---|
| 129 | else if (fFlags & (NTSF_PLUS | NTSF_BLANK))
|
---|
| 130 | psz[i++] = (char)(fFlags & NTSF_PLUS ? '+' : ' ');
|
---|
| 131 | }
|
---|
| 132 |
|
---|
| 133 | if (fFlags & NTSF_SPECIAL && (uiBase % 8) == 0)
|
---|
| 134 | {
|
---|
| 135 | psz[i++] = '0';
|
---|
| 136 | if (uiBase == 16)
|
---|
| 137 | psz[i++] = (char)(fFlags & NTSF_CAPITAL ? 'X' : 'x');
|
---|
| 138 | }
|
---|
| 139 |
|
---|
| 140 |
|
---|
| 141 | /* width - only if ZEROPAD */
|
---|
| 142 | cchWidth -= i + cchValue;
|
---|
| 143 | if (fFlags & NTSF_ZEROPAD)
|
---|
| 144 | while (--cchWidth >= 0)
|
---|
| 145 | {
|
---|
| 146 | psz[i++] = '0';
|
---|
| 147 | cchPrecision--;
|
---|
| 148 | }
|
---|
| 149 | else if (!(fFlags & NTSF_LEFT) && cchWidth > 0)
|
---|
| 150 | {
|
---|
| 151 | for (j = i-1; j >= 0; j--)
|
---|
| 152 | psz[cchWidth + j] = psz[j];
|
---|
| 153 | for (j = 0; j < cchWidth; j++)
|
---|
| 154 | psz[j] = ' ';
|
---|
| 155 | i += cchWidth;
|
---|
| 156 | }
|
---|
| 157 |
|
---|
| 158 | psz += i;
|
---|
| 159 |
|
---|
| 160 | /* percision */
|
---|
| 161 | while (--cchPrecision >= cchValue)
|
---|
| 162 | *psz++ = '0';
|
---|
| 163 |
|
---|
| 164 | /* write number - not good enough but it works */
|
---|
| 165 | i = -1;
|
---|
| 166 | psz += cchValue;
|
---|
| 167 | do
|
---|
| 168 | {
|
---|
| 169 | psz[i--] = achDigits[lValue % uiBase];
|
---|
| 170 | lValue /= uiBase;
|
---|
| 171 | } while (lValue > 0);
|
---|
| 172 |
|
---|
| 173 | /* width if NTSF_LEFT */
|
---|
| 174 | if (fFlags & NTSF_LEFT)
|
---|
| 175 | while (--cchWidth >= 0)
|
---|
| 176 | *psz++ = ' ';
|
---|
| 177 |
|
---|
| 178 |
|
---|
| 179 | return psz;
|
---|
| 180 | }
|
---|
| 181 |
|
---|
| 182 |
|
---|
| 183 | #pragma info(notrd)
|
---|
| 184 | /**
|
---|
| 185 | * Partial vsprintf implementation.
|
---|
| 186 | * @returns number of
|
---|
| 187 | * @param pszBuffer Output buffer.
|
---|
| 188 | * @param pszFormat Format string.
|
---|
| 189 | * @param args Argument list.
|
---|
| 190 | */
|
---|
| 191 | int vsprintf(char *pszBuffer, const char *pszFormat, va_list args)
|
---|
| 192 | {
|
---|
| 193 | char *psz = pszBuffer;
|
---|
| 194 |
|
---|
| 195 | while (*pszFormat != '\0')
|
---|
| 196 | {
|
---|
| 197 | if (*pszFormat == '%')
|
---|
| 198 | {
|
---|
| 199 | pszFormat++; /* skip '%' */
|
---|
| 200 | if (*pszFormat == '%') /* '%%'-> '%' */
|
---|
| 201 | *psz++ = *pszFormat++;
|
---|
| 202 | else
|
---|
| 203 | {
|
---|
| 204 | long lValue;
|
---|
| 205 | unsigned int fFlags = 0;
|
---|
| 206 | int cchWidth = -1;
|
---|
| 207 | int cchPrecision = -1;
|
---|
| 208 | unsigned int uiBase = 10;
|
---|
| 209 | char chArgSize;
|
---|
| 210 |
|
---|
| 211 | /* flags */
|
---|
| 212 | #pragma info(none)
|
---|
| 213 | while (1)
|
---|
| 214 | #pragma info(restore)
|
---|
| 215 | {
|
---|
| 216 | switch (*pszFormat++)
|
---|
| 217 | {
|
---|
| 218 | case '#': fFlags |= NTSF_SPECIAL; continue;
|
---|
| 219 | case '-': fFlags |= NTSF_LEFT; continue;
|
---|
| 220 | case '+': fFlags |= NTSF_PLUS; continue;
|
---|
| 221 | case ' ': fFlags |= NTSF_BLANK; continue;
|
---|
| 222 | case '0': fFlags |= NTSF_ZEROPAD; continue;
|
---|
| 223 | }
|
---|
| 224 | pszFormat--;
|
---|
| 225 | break;
|
---|
| 226 | }
|
---|
| 227 | /* width */
|
---|
| 228 | if (ISDIGIT(*pszFormat))
|
---|
| 229 | cchWidth = _atoi_skip(&pszFormat);
|
---|
| 230 | else if (*pszFormat == '*')
|
---|
| 231 | {
|
---|
| 232 | pszFormat++;
|
---|
| 233 | cchWidth = va_arg(args, int);
|
---|
| 234 | if (cchWidth < 0)
|
---|
| 235 | {
|
---|
| 236 | cchWidth = -cchWidth;
|
---|
| 237 | fFlags |= NTSF_LEFT;
|
---|
| 238 | }
|
---|
| 239 | }
|
---|
| 240 |
|
---|
| 241 | /* precision */
|
---|
| 242 | if (*pszFormat == '.')
|
---|
| 243 | {
|
---|
| 244 | pszFormat++;
|
---|
| 245 | if (ISDIGIT(*pszFormat))
|
---|
| 246 | cchPrecision = _atoi_skip(&pszFormat);
|
---|
| 247 | else if (*pszFormat == '*')
|
---|
| 248 | {
|
---|
| 249 | pszFormat++;
|
---|
| 250 | cchPrecision = va_arg(args, int);
|
---|
| 251 | }
|
---|
| 252 | if (cchPrecision < 0)
|
---|
| 253 | cchPrecision = 0;
|
---|
| 254 | }
|
---|
| 255 |
|
---|
| 256 | /* argsize */
|
---|
| 257 | chArgSize = *pszFormat;
|
---|
| 258 | if (chArgSize != 'l' && chArgSize != 'L' && chArgSize != 'H')
|
---|
| 259 | chArgSize = 0;
|
---|
| 260 | else
|
---|
| 261 | pszFormat++;
|
---|
| 262 |
|
---|
| 263 | /* type */
|
---|
| 264 | switch (*pszFormat++)
|
---|
| 265 | {
|
---|
| 266 | /* char */
|
---|
| 267 | case 'c':
|
---|
| 268 | if (!(fFlags & NTSF_LEFT))
|
---|
| 269 | while (--cchWidth > 0)
|
---|
| 270 | *psz++ = ' ';
|
---|
| 271 |
|
---|
| 272 | *psz++ = va_arg(args, int);
|
---|
| 273 |
|
---|
| 274 | while (--cchWidth > 0)
|
---|
| 275 | *psz++ = ' ';
|
---|
| 276 | continue;
|
---|
| 277 |
|
---|
| 278 | case 'd': /* signed decimal integer */
|
---|
| 279 | case 'i':
|
---|
| 280 | fFlags |= NTSF_VALSIGNED;
|
---|
| 281 | break;
|
---|
| 282 |
|
---|
| 283 | case 'o':
|
---|
| 284 | uiBase = 8;
|
---|
| 285 | break;
|
---|
| 286 |
|
---|
| 287 | case 'p':
|
---|
| 288 | fFlags |= NTSF_SPECIAL; /* Note not standard behaviour (but I like it this way!) */
|
---|
| 289 | uiBase = 16;
|
---|
| 290 | break;
|
---|
| 291 |
|
---|
| 292 | case 's': /* string */
|
---|
| 293 | {
|
---|
| 294 | int i;
|
---|
| 295 | int cchStr;
|
---|
| 296 | char *pszStr = va_arg(args, char*);
|
---|
| 297 |
|
---|
| 298 | if (pszStr < (char*)0x10000)
|
---|
| 299 | pszStr = "<NULL>";
|
---|
| 300 | cchStr = _strnlen(pszStr, (unsigned)cchPrecision);
|
---|
| 301 | if (!(fFlags & NTSF_LEFT))
|
---|
| 302 | while (--cchWidth >= cchStr)
|
---|
| 303 | *psz++ = ' ';
|
---|
| 304 | for (i = cchStr; i > 0; i--)
|
---|
| 305 | *psz++ = *pszStr++;
|
---|
| 306 |
|
---|
| 307 | while (--cchWidth >= cchStr)
|
---|
| 308 | *psz++ = ' ';
|
---|
| 309 | continue;
|
---|
| 310 | }
|
---|
| 311 |
|
---|
| 312 | case 'u':
|
---|
| 313 | uiBase = 10;
|
---|
| 314 | break;
|
---|
| 315 |
|
---|
| 316 | case 'x':
|
---|
| 317 | case 'X':
|
---|
| 318 | uiBase = 16;
|
---|
| 319 | break;
|
---|
| 320 |
|
---|
| 321 | default:
|
---|
| 322 | continue;
|
---|
| 323 | }
|
---|
| 324 | /*-----------------*/
|
---|
| 325 | /* integer/pointer */
|
---|
| 326 | /*-----------------*/
|
---|
| 327 | /* get value */
|
---|
| 328 | if (pszFormat[-1] == 'p')
|
---|
| 329 | lValue = (signed long)va_arg(args, char *);
|
---|
| 330 | else if (chArgSize == 'l')
|
---|
| 331 | lValue = va_arg(args, signed long);
|
---|
| 332 | else if (chArgSize == 'h')
|
---|
| 333 | lValue = va_arg(args, signed short);
|
---|
| 334 | else
|
---|
| 335 | lValue = va_arg(args, signed int);
|
---|
| 336 | psz = numtostr(psz, lValue, uiBase, cchWidth,
|
---|
| 337 | cchPrecision, fFlags);
|
---|
| 338 | }
|
---|
| 339 | }
|
---|
| 340 | else
|
---|
| 341 | *psz++ = *pszFormat++;
|
---|
| 342 | }
|
---|
| 343 | *psz = '\0';
|
---|
| 344 |
|
---|
| 345 | return psz - pszBuffer;
|
---|
| 346 | }
|
---|
| 347 |
|
---|
| 348 |
|
---|
| 349 | /**
|
---|
| 350 | * sprintf - wraps arguments into a vsprintf call.
|
---|
| 351 | * @returns number of bytes written.
|
---|
| 352 | * @param pszBuffer Pointer to output buffer.
|
---|
| 353 | * @param pszFormat Pointer to format string.
|
---|
| 354 | * @param ... Optional parameters.
|
---|
| 355 | */
|
---|
| 356 | int sprintf(char *pszBuffer, const char *pszFormat, ...)
|
---|
| 357 | {
|
---|
| 358 | int cch;
|
---|
| 359 | va_list arguments;
|
---|
| 360 |
|
---|
| 361 | va_start(arguments, pszFormat);
|
---|
| 362 | cch = vsprintf(pszBuffer, pszFormat, arguments);
|
---|
| 363 | va_end(arguments);
|
---|
| 364 |
|
---|
| 365 | return cch;
|
---|
| 366 | }
|
---|
| 367 |
|
---|