X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=Usermode%2FLibraries%2Flibc.so_src%2Fstdio.c;h=a85bb5987b57986063dc3d378b939e1debfcea25;hb=2103edc7b67600818930793851b57e3583f73954;hp=39d37a4b0e17e358ce8ae6d79fe373df8f99ba84;hpb=be5123fe1f4aa66b76ce8ef589362ad21b6bbf72;p=tpg%2Facess2.git diff --git a/Usermode/Libraries/libc.so_src/stdio.c b/Usermode/Libraries/libc.so_src/stdio.c index 39d37a4b..a85bb598 100644 --- a/Usermode/Libraries/libc.so_src/stdio.c +++ b/Usermode/Libraries/libc.so_src/stdio.c @@ -254,48 +254,6 @@ EXPORT int fseek(FILE *fp, long int amt, int whence) return _SysSeek(fp->FD, amt, whence); } - -/** - * \fn EXPORT int vfprintf(FILE *fp, const char *format, va_list args) - * \brief Print to a file from a variable argument list - */ -EXPORT int vfprintf(FILE *fp, const char *format, va_list args) -{ - va_list tmpList; - int size; - - if(!fp || !format) return -1; - - va_copy(tmpList, args); - - size = vsnprintf(NULL, 0, (char*)format, tmpList); - char buf[size+1]; - vsnprintf(buf, size+1, (char*)format, args); - - // Write to stream - fwrite(buf, size, 1, fp); - - // Return written byte count - return size; -} - -/** - * \fn int fprintf(FILE *fp, const char *format, ...) - * \brief Print a formatted string to a stream - */ -EXPORT int fprintf(FILE *fp, const char *format, ...) -{ - va_list args; - int ret; - - // Get Size - va_start(args, format); - ret = vfprintf(fp, (char*)format, args); - va_end(args); - - return ret; -} - /** * \fn EXPORT size_t fwrite(void *ptr, size_t size, size_t num, FILE *fp) * \brief Write to a stream @@ -453,300 +411,3 @@ EXPORT int puts(const char *str) return len; } -EXPORT int vsprintf(char * __s, const char *__format, va_list __args) -{ - return vsnprintf(__s, 0x7FFFFFFF, __format, __args); -} - - -/** - * \fn EXPORT void vsnprintf(char *buf, const char *format, va_list args) - * \brief Prints a formatted string to a buffer - * \param buf Pointer - Destination Buffer - * \param format String - Format String - * \param args VarArgs List - Arguments - */ -EXPORT int vsnprintf(char *buf, size_t __maxlen, const char *format, va_list args) -{ - char tmp[65]; - int c, minSize, precision, len; - size_t pos = 0; - char *p; - char pad; - uint64_t arg; - int bLongLong, bPadLeft; - - #define _addchar(ch) do { \ - if(buf && pos < __maxlen) buf[pos] = (ch); \ - else (void)(ch); \ - pos ++; \ - } while(0) - - tmp[32] = '\0'; - - while((c = *format++) != 0) - { - // Non-control character - if (c != '%') { - _addchar(c); - continue; - } - - // Control Character - c = *format++; - if(c == '%') { // Literal % - _addchar('%'); - continue; - } - - bPadLeft = 0; - bLongLong = 0; - minSize = 0; - precision = -1; - pad = ' '; - - // Padding Character - if(c == '0') { - pad = '0'; - c = *format++; - } - // Padding length - if( c == '*' ) { - // Variable length - minSize = va_arg(args, size_t); - c = *format++; - } - else { - if('1' <= c && c <= '9') - { - minSize = 0; - while('0' <= c && c <= '9') - { - minSize *= 10; - minSize += c - '0'; - c = *format++; - } - } - } - - // Precision - if(c == '.') { - c = *format++; - if(c == '*') { - precision = va_arg(args, size_t); - c = *format++; - } - else if('1' <= c && c <= '9') - { - precision = 0; - while('0' <= c && c <= '9') - { - precision *= 10; - precision += c - '0'; - c = *format++; - } - } - } - - // Check for long long - bLongLong = 0; - if(c == 'l') - { - c = *format++; - if(c == 'l') { - bLongLong = 1; - } - } - - // Just help things along later - p = tmp; - - // Get Type - switch( c ) - { - // Signed Integer - case 'd': case 'i': - // Get Argument - if(bLongLong) arg = va_arg(args, int64_t); - else arg = va_arg(args, int32_t); - itoa(tmp, arg, 10, minSize, pad, 1); - precision = -1; - goto sprintf_puts; - - // Unsigned Integer - case 'u': - // Get Argument - if(bLongLong) arg = va_arg(args, uint64_t); - else arg = va_arg(args, uint32_t); - itoa(tmp, arg, 10, minSize, pad, 0); - precision = -1; - goto sprintf_puts; - - // Pointer - case 'p': - _addchar('*'); - _addchar('0'); - _addchar('x'); - arg = va_arg(args, intptr_t); - itoa(tmp, arg, 16, minSize, pad, 0); - precision = -1; - goto sprintf_puts; - // Unsigned Hexadecimal - case 'x': - if(bLongLong) arg = va_arg(args, uint64_t); - else arg = va_arg(args, uint32_t); - itoa(tmp, arg, 16, minSize, pad, 0); - precision = -1; - goto sprintf_puts; - - // Unsigned Octal - case 'o': - if(bLongLong) arg = va_arg(args, uint64_t); - else arg = va_arg(args, uint32_t); - itoa(tmp, arg, 8, minSize, pad, 0); - precision = -1; - goto sprintf_puts; - - // Unsigned binary - case 'b': - if(bLongLong) arg = va_arg(args, uint64_t); - else arg = va_arg(args, uint32_t); - itoa(tmp, arg, 2, minSize, pad, 0); - precision = -1; - goto sprintf_puts; - - // String - case 's': - p = va_arg(args, char*); - sprintf_puts: - if(!p) p = "(null)"; - //_SysDebug("vsnprintf: p = '%s'", p); - if(precision >= 0) - len = strnlen(p, precision); - else - len = strlen(p); - if(bPadLeft) while(minSize > len++) _addchar(pad); - while( *p ) { - if(precision >= 0 && precision -- == 0) - break; - _addchar(*p++); - } - if(!bPadLeft) while(minSize > len++) _addchar(pad); - break; - - // Unknown, just treat it as a character - default: - arg = va_arg(args, uint32_t); - _addchar(arg); - break; - } - } - _addchar('\0'); - pos --; - #undef _addchar - - //_SysDebug("vsnprintf: buf = '%s'", buf); - - return pos; -} - -const char cUCDIGITS[] = "0123456789ABCDEF"; -/** - * \fn static void itoa(char *buf, uint64_t num, int base, int minLength, char pad, int bSigned) - * \brief Convert an integer into a character string - * \param buf Destination Buffer - * \param num Number to convert - * \param base Base-n number output - * \param minLength Minimum length of output - * \param pad Padding used to ensure minLength - * \param bSigned Signed number output? - */ -EXPORT void itoa(char *buf, uint64_t num, size_t base, int minLength, char pad, int bSigned) -{ - char tmpBuf[64]; - int pos=0, i; - - if(!buf) return; - if(base > 16 || base < 2) { - buf[0] = 0; - return; - } - - if(bSigned && (int64_t)num < 0) - { - num = -num; - bSigned = 1; - } else - bSigned = 0; - - // Encode into reversed string - while(num > base-1) { - tmpBuf[pos++] = cUCDIGITS[ num % base ]; - num = (uint64_t) num / (uint64_t)base; // Shift {number} right 1 digit - } - - tmpBuf[pos++] = cUCDIGITS[ num % base ]; // Last digit of {number} - if(bSigned) tmpBuf[pos++] = '-'; // Append sign symbol if needed - - i = 0; - minLength -= pos; - while(minLength-- > 0) buf[i++] = pad; - while(pos-- > 0) buf[i++] = tmpBuf[pos]; // Reverse the order of characters - buf[i] = 0; -} - -/** - * \fn EXPORT int printf(const char *format, ...) - * \brief Print a string to stdout - */ -EXPORT int printf(const char *format, ...) -{ - int size; - va_list args; - - // Get final size - va_start(args, format); - size = vsnprintf(NULL, 0, (char*)format, args); - va_end(args); - char buf[size+1]; - // Fill Buffer - va_start(args, format); - vsnprintf(buf, size+1, (char*)format, args); - va_end(args); - - // Send to stdout - _SysWrite(_stdout, buf, size); - - // Free buffer - free(buf); - // Return - return size; -} - -/** - * \fn EXPORT int sprintf(const char *buf, char *format, ...) - * \brief Print a formatted string to a buffer - */ -EXPORT int sprintf(char *buf, const char *format, ...) -{ - int ret; - va_list args; - va_start(args, format); - ret = vsprintf((char*)buf, (char*)format, args); - va_end(args); - return ret; -} - -/** - * \fn EXPORT int snprintf(const char *buf, size_t maxlen, char *format, ...) - * \brief Print a formatted string to a buffer - */ -EXPORT int snprintf(char *buf, size_t maxlen, const char *format, ...) -{ - int ret; - va_list args; - va_start(args, format); - ret = vsnprintf((char*)buf, maxlen, (char*)format, args); - va_end(args); - return ret; -}