/* $Id: vprntf16.c,v 1.2 2000-02-26 17:49:28 bird Exp $ * * vprintf and printf - 16-bit. * * WARNING: Do not include stdarg.h! AND it's only for use during init!!! * * Copyright (c) 1999 knut st. osmundsen * * Project Odin Software License can be found in LICENSE.TXT * */ /******************************************************************************* * Defined Constants * *******************************************************************************/ #define ISDIGIT(c) ((c) >= '0' && (c) <= '9') #define MAX(a, b) ((a) >= (b) ? (a) : (b)) #define MIN(a, b) ((a) < (b) ? (a) : (b)) #define NTSF_CAPITAL 0x0001 #define NTSF_LEFT 0x0002 #define NTSF_ZEROPAD 0x0004 #define NTSF_SPECIAL 0x0008 #define NTSF_VALSIGNED 0x0010 #define NTSF_PLUS 0x0020 #define NTSF_BLANK 0x0040 #define INCL_DOSPROCESS #define INCL_DOSERRORS #define INCL_NOPMAPI /******************************************************************************* * Header Files * *******************************************************************************/ #include #include "vprntf16.h" #ifdef RING0 #include "options.h" #include "conio.h" #endif #include "dev16.h" /******************************************************************************* * Global Variables * *******************************************************************************/ static char chNewLine = '\n'; static char chReturn = '\r'; /******************************************************************************* * Internal Functions * *******************************************************************************/ static int _atoi_skip(const char _far **ppsz); static unsigned _strnlen(const char *psz, unsigned cchMax); static void choutconsole(int ch); static char * stroutconsole(char *psz, signed cchMax); static void chout(int ch); static char * strout(char *psz, signed cchMax); /** * Read an integer (decimal) and update the string pointer while reading. * Do not support sign values. * @returns Integer value. * @param ppsz Pointer to pointer to string. The string to be converted. */ static int _atoi_skip(const char _far **ppsz) { int iValue = 0; while (ISDIGIT(**ppsz)) { iValue *= 10; iValue += **ppsz - '0'; (*ppsz)++; } return iValue; } /** * Finds the length of a string up to cchMax. * @returns Length. * @param psz Pointer to string. * @param cchMax Max length. */ static unsigned _strnlen(const char *psz, unsigned cchMax) { const char *pszC = psz; while (*psz != '\0' && cchMax-- > 0) psz++; return psz - pszC; } /** * Formats a number according to the parameters. * @returns Pointer to next char. (after number) * @param psz Pointer to output string. * @param lValue Value * @param uiBase Number representation base. * @param cchWidth Width * @param cchPrecision Precision. * @param fFlags Flags (NTFS_*). */ static char * numtostr(long lValue, unsigned int uiBase, signed int cchWidth, signed int cchPrecision, unsigned int fFlags ) { char * achDigits = "0123456789abcdef"; int cchValue; unsigned long ul; int i; int j; #ifdef DEBUG if (uiBase < 2 || uiBase > 16) return NULL; #endif if (fFlags & NTSF_CAPITAL) achDigits = "0123456789ABCDEF"; if (fFlags & NTSF_LEFT) fFlags &= ~NTSF_ZEROPAD; /* determin value length */ cchValue = 0; ul = (unsigned long)((fFlags & NTSF_VALSIGNED) && lValue < 0L ? -lValue : lValue); do { cchValue++; ul /= uiBase; } while (ul > 0); i = 0; if (fFlags & NTSF_VALSIGNED) { if (lValue < 0) { lValue = -lValue; chout('-'); i++; } else if (fFlags & (NTSF_PLUS | NTSF_BLANK)) { chout(fFlags & NTSF_PLUS ? '+' : ' '); i++; } } if (fFlags & NTSF_SPECIAL && (uiBase % 8) == 0) { chout('0'); i++; if (uiBase == 16) { chout(fFlags & NTSF_CAPITAL ? 'X' : 'x'); i++; } } /* width - only if ZEROPAD */ cchWidth -= i + cchValue; if (fFlags & NTSF_ZEROPAD) while (--cchWidth >= 0) { chout('0'); cchPrecision--; } #if 0 else if (!(fFlags & NTSF_LEFT) && cchWidth > 0) { /* not yet supported! */ /* for (j = i-1; j >= 0; j--) psz[cchWidth + j] = psz[j]; for (j = 0; j < cchWidth; j++) psz[j] = ' '; i += cchWidth; */ } #endif /* percision */ while (--cchPrecision >= cchValue) chout('0'); ul = 1; for (i = 1; i < cchValue; i++) ul *= uiBase; for (i = 0; i < cchValue; i++) { chout(achDigits[lValue / ul]); lValue %= ul; ul /= uiBase; } /* width if NTSF_LEFT */ if (fFlags & NTSF_LEFT) while (--cchWidth >= 0) chout(' '); return NULL; } /** * Partial vprintf implementation. * This function don't check the fLogging flag, and will therefore allways write. * @returns number of * @param pszFormat Format string. * @param args Argument list. */ int vprintf16(const char *pszFormat, va_list args) { int cch = 0; while (*pszFormat != '\0') { if (*pszFormat == '%') { if (cch > 0) { strout((char*)(pszFormat - cch), cch); cch = 0; } pszFormat++; /* skip '%' */ if (*pszFormat == '%') /* '%%'-> '%' */ chout(*pszFormat++); else { long lValue; unsigned int fFlags = 0; int cchWidth = -1; int cchPrecision = -1; unsigned int uiBase = 10; char chArgSize; /* flags */ while (1) { switch (*pszFormat++) { case '#': fFlags |= NTSF_SPECIAL; continue; case '-': fFlags |= NTSF_LEFT; continue; case '+': fFlags |= NTSF_PLUS; continue; case ' ': fFlags |= NTSF_BLANK; continue; case '0': fFlags |= NTSF_ZEROPAD; continue; } pszFormat--; break; } /* width */ if (ISDIGIT(*pszFormat)) cchWidth = _atoi_skip(&pszFormat); else if (*pszFormat == '*') { pszFormat++; cchWidth = va_arg(args, int); if (cchWidth < 0) { cchWidth = -cchWidth; fFlags |= NTSF_LEFT; } } /* precision */ if (*pszFormat == '.') { pszFormat++; if (ISDIGIT(*pszFormat)) cchPrecision = _atoi_skip(&pszFormat); else if (*pszFormat == '*') { pszFormat++; cchPrecision = va_arg(args, int); } if (cchPrecision < 0) cchPrecision = 0; } /* argsize */ chArgSize = *pszFormat; if (chArgSize != 'l' && chArgSize != 'L' && chArgSize != 'H') chArgSize = 0; else pszFormat++; /* type */ switch (*pszFormat++) { /* char */ case 'c': if (!(fFlags & NTSF_LEFT)) while (--cchWidth > 0) chout(' '); chout(va_arg(args, int)); while (--cchWidth > 0) chout(' '); continue; case 'd': /* signed decimal integer */ case 'i': fFlags |= NTSF_VALSIGNED; break; case 'o': uiBase = 8; break; case 'p': fFlags |= NTSF_SPECIAL; /* Note not standard behaviour (but I like it this way!) */ uiBase = 16; break; case 's': /* string */ { int cchStr; char *pszStr = va_arg(args, char*); if (pszStr < (char*)0x10000) pszStr = ""; cchStr = _strnlen(pszStr, (unsigned)cchPrecision); if (!(fFlags & NTSF_LEFT)) while (--cchWidth >= cchStr) chout(' '); pszStr = strout(pszStr, cchStr); while (--cchWidth >= cchStr) chout(' '); continue; } case 'u': uiBase = 10; break; case 'x': case 'X': uiBase = 16; break; default: continue; } /*-----------------*/ /* integer/pointer */ /*-----------------*/ /* get value */ if (pszFormat[-1] == 'p') lValue = (signed long)va_arg(args, char *); else if (chArgSize == 'l') lValue = va_arg(args, signed long); else if (chArgSize == 'h') lValue = va_arg(args, signed short); else lValue = va_arg(args, signed int); numtostr(lValue, uiBase, cchWidth, cchPrecision, fFlags); } } else { cch++; pszFormat++; } } if (cch > 0) { strout((char*)(pszFormat - cch), cch); cch = 0; } return 0UL; } /** * printf - wraps arguments into a vprintf16 call. * @returns number of bytes written. * @param pszFormat Pointer to format string. * @param ... Optional parameters. */ int printf16(const char *pszFormat, ...) { int cch; va_list arguments; va_start(arguments, pszFormat); cch = vprintf16(pszFormat, arguments); va_end(arguments); return cch; } /** * Writes a char to output device. * @param ch Char to write. * @status completely * @author knut st. osmundsen */ static void choutconsole(int ch) { USHORT usWrote; if (ch != '\r') { if (ch == '\n') { usWrote = 1; DosWrite(1, (PVOID)&chReturn, 1, &usWrote); } usWrote = 1; DosWrite(1, (PVOID)&ch, 1, &usWrote); } } /** * Write a string to the output device. * @returns pointer end of string. * @param psz Pointer to the string to write. * @param cchMax Max count of chars to write. (or until '\0') * @status completely implemented. * @author knut st. osmundsen * @remark At inittime the text is outputed to both screen and com-port. * At runtime the text is only sendt to com-port. */ static char *stroutconsole(char *psz, signed cchMax) { while (cchMax > 0 && *psz != '\0') { USHORT cch = 0; USHORT us; while (cchMax - cch > 0 && psz[cch] != '\0' && psz[cch] != '\r' && psz[cch] != '\n') cch++; /* write string part */ us = cch; DosWrite(1, (PVOID)psz, cch, &us); /* cr and lf check + skip */ if (psz[cch] == '\n' || psz[cch] == '\r') { if (psz[cch] == '\n') { DosWrite(1, (PVOID)&chReturn, 1, &us); DosWrite(1, (PVOID)&chNewLine, 1, &us); } while (cchMax - cch > 0 && (psz[cch] == '\r' || psz[cch] == '\n')) cch++; } /* next */ psz += cch; cchMax -= cch; } return psz; } /** * Writes a char to output device. * @param ch Char to write. * @status completely * @author knut st. osmundsen */ static void chout(int ch) { #ifdef RING0 if (fInitTime) choutconsole(ch); if (!options.fLogging) return; if (ch != '\r') { if (ch == '\n') { while (!(inp(options.usCom + 5) & 0x20)); /* Waits for the port to be ready. */ outp(options.usCom, chReturn); /* Put the char. */ } while (!(inp(options.usCom + 5) & 0x20)); /* Waits for the port to be ready. */ outp(options.usCom, ch); /* Put the char. */ /* Yield(); - no 16-bit yield */ } #else return choutconsole(ch); #endif } /** * Write a string to the output device. * @returns pointer end of string. * @param psz Pointer to the string to write. * @param cchMax Max count of chars to write. (or until '\0') * @status completely implemented. * @author knut st. osmundsen */ static char *strout(char *psz, signed cchMax) { #ifdef RING0 int cchYield = 0; if (fInitTime) stroutconsole(psz, cchMax); if (!options.fLogging) return psz; while (cchMax > 0 && *psz != '\0') { ULONG cch = 0; ULONG ul; while (cchMax - cch > 0 && psz[cch] != '\0' && psz[cch] != '\r' && psz[cch] != '\n') cch++; /* write string part */ for (ul = 0; ul < cch; ul++) { while (!(inp(options.usCom + 5) & 0x20)); /* Waits for the port to be ready. */ outp(options.usCom, psz[ul]); /* Put the char. */ } /* cr and lf check + skip */ if (psz[cch] == '\n' || psz[cch] == '\r') { if (psz[cch] == '\n') { while (!(inp(options.usCom + 5) & 0x20)); /* Waits for the port to be ready. */ outp(options.usCom, chReturn); /* Put the char. */ while (!(inp(options.usCom + 5) & 0x20)); /* Waits for the port to be ready. */ outp(options.usCom, chNewLine); /* Put the char. */ cchYield ++; } while (cchMax - cch > 0 && (psz[cch] == '\r' || psz[cch] == '\n')) cch++; } /* next */ psz += cch; cchMax -= cch; cchYield += cch; if (cchYield > 3) /* if (Yield()) no 16-bit yield. */ cchYield = 0; } return psz; #else return stroutconsole(psz, cchMax); #endif }