| 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 |  | 
|---|