// // printf_lite.c // // Created by jief the 04 Apr 2019. // Imported in CLover the 24 Feb 2020 // /* This code should be pasted within the files where this function is needed. This function will not create any code conflicts. The function call is similar to printf: ardprintf("Test %d %s", 25, "string"); To print the '%' character, use '%%' This code was first posted on http://arduino.stackexchange.com/a/201 */ #include "printf_lite.h" //#include #include //#include #include #include #if defined(__cplusplus) extern "C" { #endif #if PRINTF_LITE_BUF_SIZE == 0 #define PRINTF_LITE_REENTRANT 1 // call printf_with_callback from print_timestamp #endif #if PRINTF_UTF8_OUTPUT_SUPPORT == 1 && PRINTF_UNICODE_OUTPUT_SUPPORT == 1 #define print_char_macro(c, printfParams) printfParams->printCharFunction(c, printfParams); #elif PRINTF_UNICODE_OUTPUT_SUPPORT == 1 #define print_char_macro(c, printfParams) print_wchar(c, printfParams); #elif PRINTF_UTF8_OUTPUT_SUPPORT == 1 #define print_char_macro(c, printfParams) print_utf8_char(c, printfParams); #endif typedef struct PrintfParams PrintfParams; #if PRINTF_UTF8_OUTPUT_SUPPORT == 1 && PRINTF_UNICODE_OUTPUT_SUPPORT == 1 typedef void (*printCharType)(int c, PrintfParams* printfParams); #endif // using int for flags because this is what generate less code. It's a bit more on the stack but it's temporary. typedef struct PrintfParams { #if PRINTF_LITE_BUF_SIZE > 1 union { #if PRINTF_UTF8_OUTPUT_SUPPORT == 1 # if PRINTF_UNICODE_OUTPUT_SUPPORT == 1 char buf[PRINTF_LITE_BUF_SIZE*sizeof(wchar_t)]; # else char buf[PRINTF_LITE_BUF_SIZE]; # endif #endif #if PRINTF_UNICODE_OUTPUT_SUPPORT == 1 wchar_t wbuf[PRINTF_LITE_BUF_SIZE]; #endif } buf; unsigned char bufIdx; #endif printf_callback_t transmitBufCallBack; #if PRINTF_UTF8_OUTPUT_SUPPORT == 1 && PRINTF_UNICODE_OUTPUT_SUPPORT == 1 // using a print_char function pointer forces to declare print_char and print_wchar the same prototype, withc is an int // that breaks compiler type checking. If print_char is called with a char > 255, that won't work ! // if this is compiled with short-wchar and print_wchar is called with a char > 0xFFFF, that won't work ! int unicode_output; printCharType printCharFunction; #endif int inDirective; int l_modifier; #if PRINTF_LITE_ZSPECIFIER_SUPPORT == 1 int z_modifier; #endif #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 int inWidthField; int width_specifier; #endif #if PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 || (PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 && PRINTF_LITE_FIELDWIDTH_SUPPORT == 1) // in that case, we need the inPrecisionField to know we are currently ignoring precision field int inPrecisionField; #endif #if PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 int precision_specifier; #endif #if PRINTF_LITE_PADCHAR_SUPPORT == 1 char pad_char; #endif #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 int *newlinePtr; int timestamp; // not using bool in case of C compilation #endif #if PRINTF_LITE_XSPECIFIER_SUPPORT == 1 int uppercase; #endif #if PRINTF_EMIT_CR_SUPPORT int emitCr; #endif void* context; } PrintfParams; #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 # if PRINTF_LITE_TIMESTAMP_CUSTOM_FUNCTION == 1 extern char* printf_lite_get_timestamp(void); # else static void print_timestamp(PrintfParams* printfParams); # endif #endif #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 void printf_with_callback(const char* format, transmitBufCallBackType transmitBufCallBack, void* context, ...); #ifdef ARDUINO void printf_with_callback(const __FlashStringHelper* format, transmitBufCallBackType transmitBufCallBack #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 , int* newline, int timestamp, #endif // PRINTF_LITE_TIMESTAMP_SUPPORT ...); #endif // ARDUINO //#include // for PRIu32 #endif // PRINTF_LITE_REENTRANT #if PRINTF_UTF8_OUTPUT_SUPPORT == 1 // Print a char as is. No analyse is made to check if it's a utf8 partial char // c is an int for prototype compatibility, but must be < 255 static void print_utf8_char(int c, PrintfParams* printfParams) { #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 if ( printfParams->newlinePtr ) { if ( *printfParams->newlinePtr ) { *printfParams->newlinePtr = 0; // to do BEFORE call to printTimeStamp #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 #if PRINTF_LITE_TIMESTAMP_CUSTOM_FUNCTION == 1 char* ts = printf_lite_get_timestamp(); if ( printfParams->timestamp && ts ) { while (*ts ) print_utf8_char(*ts++, printfParams); } #else if ( printfParams->timestamp ) print_timestamp(printfParams); #endif #endif } #if PRINTF_EMIT_CR_SUPPORT == 1 if ( printfParams->emitCr && c == '\n' ) print_utf8_char('\r', printfParams); #endif #if PRINTF_LITE_BUF_SIZE > 1 printfParams->buf.buf[(printfParams->bufIdx)++] = (char)c; #else printfParams->transmitBufCallBack(&c, 1); #endif if ( c == '\n' ) *printfParams->newlinePtr = 1; }else{ #if PRINTF_EMIT_CR_SUPPORT == 1 if ( printfParams->emitCr && c == '\n' ) print_utf8_char('\r', printfParams); #endif #if PRINTF_LITE_BUF_SIZE > 1 printfParams->buf.buf[(printfParams->bufIdx)++] = (char)c; #else printfParams->transmitBufCallBack(&c, 1); #endif } #else { #if PRINTF_EMIT_CR_SUPPORT == 1 if ( printfParams.emit_cr && c == '\n' ) print_utf8_char('\r', printfParams); #endif #if PRINTF_LITE_BUF_SIZE > 1 printfParams->buf.buf[(printfParams->bufIdx)++] = (char)c; #else printfParams->transmitBufCallBack.transmitBufCallBack((const char*)&c, (size_t)1); #endif } #endif #if PRINTF_LITE_BUF_SIZE > 1 if ( printfParams->bufIdx == PRINTF_LITE_BUF_SIZE ) { printfParams->transmitBufCallBack.transmitBufCallBack(printfParams->buf.buf, printfParams->bufIdx, printfParams->context); printfParams->bufIdx = 0; } #endif } #endif #if PRINTF_UNICODE_OUTPUT_SUPPORT == 1 // print wchar_t char as is. No check is made if it's surrogate or not. Just send the wchar_t as is. // c is an int for prototype compatibility, but it's a wchar_t. Assumption : a wchar_t cannot be bigger than an int. Don't know yet if it's 100% on embedded platform. static void print_wchar(int c, PrintfParams* printfParams) { #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 if ( printfParams->newlinePtr ) { if ( *printfParams->newlinePtr ) { *printfParams->newlinePtr = 0; // to do BEFORE call to printTimeStamp #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 #if PRINTF_LITE_TIMESTAMP_CUSTOM_FUNCTION == 1 char* ts = printf_lite_get_timestamp(); if ( printfParams->timestamp ) printf_with_callback("%s", printfParams->transmitBufCallBack.transmitBufCallBack, printfParams->context, ts); #else if ( printfParams->timestamp ) print_timestamp(printfParams); #endif #endif } #if PRINTF_EMIT_CR_SUPPORT == 1 if ( printfParams->emitCr && c == '\n' ) print_wchar('\r', printfParams); #endif #if PRINTF_LITE_BUF_SIZE > 1 printfParams->buf.wbuf[(printfParams->bufIdx)++] = (wchar_t)c; #else printfParams->transmitWBufCallBack(&c, 1); #endif if ( c == '\n' ) { *printfParams->newlinePtr = 1; } }else{ #if PRINTF_EMIT_CR_SUPPORT == 1 if ( printfParams->emitCr && c == '\n' ) print_wchar('\r', printfParams); #endif #if PRINTF_LITE_BUF_SIZE > 1 printfParams->buf.wbuf[(printfParams->bufIdx)++] = (wchar_t)c; #else printfParams->transmitWBufCallBack(&c, 1); #endif } #else { #if PRINTF_EMIT_CR_SUPPORT == 1 if ( printfParams.emit_cr && c == '\n' ) print_wchar('\r', printfParams); #endif #if PRINTF_LITE_BUF_SIZE > 1 printfParams->buf.wbuf[(printfParams->bufIdx)++] = (wchar_t)c; // cast suposed to be safe, as this function must be called #else printfParams->transmitWBufCallBack(&c, 1); #endif } #endif #if PRINTF_LITE_BUF_SIZE > 1 if ( printfParams->bufIdx == PRINTF_LITE_BUF_SIZE ) { printfParams->transmitBufCallBack.transmitWBufCallBack(printfParams->buf.wbuf, printfParams->bufIdx, printfParams->context); printfParams->bufIdx = 0; } #endif } #endif #if PRINTF_UTF8_OUTPUT_SUPPORT == 1 && PRINTF_UNICODE_INPUT_SUPPORT == 1 #define halfBase 0x0010000UL #define halfMask 0x3FFUL #define halfShift 10 /* used for shifting by 10 bits */ #define UNI_SUR_HIGH_START 0xD800u #define UNI_SUR_LOW_START 0xDC00u #if __WCHAR_MAX__ <= 0xFFFFu static inline int printf_is_surrogate(char16_t uc) { return (uc - 0xd800u) < 2048u; } static inline int printf_is_high_surrogate(char16_t uc) { return (uc & 0xfffffc00) == 0xd800; } static inline int printf_is_low_surrogate(char16_t uc) { return (uc & 0xfffffc00) == 0xdc00; } static inline char32_t printf_surrogate_to_utf32(char16_t high, char16_t low) { return (char32_t)((high << 10) + low - 0x35fdc00); // Safe cast, it fits in 32 bits } #endif /* * Print char32_t to utf8 string. * Only needed if PRINTF_UNICODE_OUTPUT_SUPPORT == 1 && PRINTF_UTF8_INPUT_SUPPORT == 1 */ static void print_char32_as_utf8_string(const char32_t utf32_char, PrintfParams* printfParams) { /* assertion: utf32_char is a single UTF-4 value */ int bits; if (utf32_char < 0x80) { print_utf8_char((char)utf32_char, printfParams); bits = -6; } else if (utf32_char < 0x800) { print_utf8_char((char)(((utf32_char >> 6) & 0x1F) | 0xC0), printfParams); bits = 0; } else if (utf32_char < 0x10000) { print_utf8_char((char)(((utf32_char >> 12) & 0x0F) | 0xE0), printfParams); bits = 6; } else { print_utf8_char((char)(((utf32_char >> 18) & 0x07) | 0xF0), printfParams); bits = 12; } for (; bits >= 0; bits -= 6) { print_utf8_char((char)(((utf32_char >> bits) & 0x3F) | 0x80), printfParams); } } /* * Print wchar string to utf8 string. * Only needed if PRINTF_UNICODE_OUTPUT_SUPPORT == 1 && PRINTF_UTF8_INPUT_SUPPORT == 1 */ static void output_wchar_string_as_utf8(const wchar_t* s, PrintfParams* printfParams) { if ( !s ) return; int precision_specifier = printfParams->precision_specifier; while ( *s && (printfParams->precision_specifier <= 0 || precision_specifier--) ) { // while ( *s ) { #if __WCHAR_MAX__ <= 0xFFFFu const char16_t uc = *s++; if (!printf_is_surrogate(uc)) { print_char32_as_utf8_string((char32_t)uc, printfParams); } else { if (printf_is_high_surrogate(uc) && *s && printf_is_low_surrogate(*s)) { print_char32_as_utf8_string(printf_surrogate_to_utf32(uc, *s++), printfParams); } else { continue; } } #else print_char32_as_utf8_string((char32_t)(*s++), printfParams); #endif } } #endif /* UTF8 Number Bits for First Last of bytes code point code point code point Byte 1 Byte 2 Byte 3 Byte 4 1 7 U+0000 U+007F 0xxxxxxx 2 11 U+0080 U+07FF 110xxxxx 10xxxxxx 3 16 U+0800 U+FFFF 1110xxxx 10xxxxxx 10xxxxxx 4 21 U+10000 U+10FFFF 11110xxx 10xxxxxx 10xxxxxx 10xxxxxx */ #if PRINTF_UNICODE_OUTPUT_SUPPORT == 1 && PRINTF_UTF8_INPUT_SUPPORT == 1 /* * Print UTF8 string to wchar string. * Only needed if PRINTF_UNICODE_OUTPUT_SUPPORT == 1 && PRINTF_UTF8_INPUT_SUPPORT == 1 */ static void output_utf8_string_as_wchar(const char* s, PrintfParams* printfParams) { if ( !s ) return; int precision_specifier = printfParams->precision_specifier; while ( *s && (printfParams->precision_specifier == 0 || precision_specifier--) ) { char32_t c; if ( *((unsigned char*)s) & 0x80 ) { if (*(s+1) == 0) { // Finished in the middle of an utf8 multibyte char return; } if ((*(((unsigned char*)s)+1) & 0xc0) != 0x80) { s += 1; continue; } if ((*((unsigned char*)s) & 0xe0) == 0xe0) { if (*(s+2) == 0) { // Finished in the middle of an utf8 multibyte char return; } if ((*(((unsigned char*)s)+2) & 0xc0) != 0x80) { s += 2; continue; } if ((*((unsigned char*)s) & 0xf0) == 0xf0) { if (*(s+3) == 0) { // Finished in the middle of an utf8 multibyte char return; } if ((*((unsigned char*)s) & 0xf8) != 0xf0 || (*(((unsigned char*)s)+3) & 0xc0) != 0x80) { s += 3; continue; } /* 4-byte code */ c = (char32_t)((*((char32_t*)s) & 0x7) << 18); c |= (char32_t)((*(((unsigned char*)s)+1) & 0x3f) << 12); c |= (char32_t)((*(((unsigned char*)s)+2) & 0x3f) << 6); c |= *(((unsigned char*)s)+3) & 0x3f; s += 4; } else { /* 3-byte code */ c = (char32_t)((*((unsigned char*)s) & 0xf) << 12); c |= (char32_t)((*(((unsigned char*)s)+1) & 0x3f) << 6); c |= *(((unsigned char*)s)+2) & 0x3f; s += 3; } } else { /* 2-byte code */ c = (char32_t)((*((unsigned char*)s) & 0x1f) << 6); c |= *(((unsigned char*)s)+1) & 0x3f; s += 2; } } else { /* 1-byte code */ c = *((unsigned char*)s); s += 1; } #if __WCHAR_MAX__ > 0xFFFFu print_wchar((wchar_t)c, printfParams); #else if ( c <= 0xFFFF) { print_wchar((wchar_t)c, printfParams); } else { c -= halfBase; print_wchar((wchar_t)((c >> halfShift) + UNI_SUR_HIGH_START), printfParams); print_wchar((wchar_t)((c & halfMask) + UNI_SUR_LOW_START), printfParams); } #endif } } #endif /* * Print string with no conversion */ #if DEFINE_SECTIONS == 1 __attribute__((noinline, section(".output_utf8_string"))) #elif DEFINE_SECTIONS == 2 __attribute__((noinline, section(".printf_lite"))) #endif static void output_utf8_string_as_utf8(const char* s, PrintfParams* printfParams) { if ( !s ) return; //#if PRINTF_LITE_STRING_WIDTH_SPECIFIER_SUPPORT == 1 // size_t len = lengt //#endif if ( printfParams->precision_specifier >= 0 ) { while ( *s && printfParams->precision_specifier-- ) print_utf8_char(*s++, printfParams); } else { while ( *s ) print_utf8_char(*s++, printfParams); } } #if DEFINE_SECTIONS == 1 __attribute__((noinline, section(".output_wchar_string"))) #elif DEFINE_SECTIONS == 2 __attribute__((noinline, section(".printf_lite"))) #endif #if PRINTF_UNICODE_OUTPUT_SUPPORT static void output_wchar_string(const wchar_t* s, PrintfParams* printfParams) { if ( !s ) return; if ( printfParams->precision_specifier >= 0 ) { while ( *s && printfParams->precision_specifier-- ) print_wchar(*s++, printfParams); }else{ while ( *s ) print_wchar(*s++, printfParams); } } #endif #if defined(ARDUINO) && PRINTF_LITE_FLASHSTRING_SUPPORT == 1 static void print_Fstring(const char* s, PrintfParams* printfParams) { PGM_P p_to_print = reinterpret_cast(s); unsigned char c_to_print = pgm_read_byte(p_to_print++); while ( c_to_print != 0 ) { print_char_macro(c_to_print, printfParams); c_to_print = pgm_read_byte(p_to_print++); } } #endif #if PRINTF_LITE_LONGLONGINT_SUPPORT == 1 && PRINTF_LITE_LONGINT_SUPPORT == 1 #define INT_BIGGEST_TYPE long long int #define UINT_BIGGEST_TYPE unsigned long long int #else #if PRINTF_LITE_LONGINT_SUPPORT == 1 #define INT_BIGGEST_TYPE long int #define UINT_BIGGEST_TYPE unsigned long int #else #define INT_BIGGEST_TYPE int #define UINT_BIGGEST_TYPE unsigned int #endif #endif /* Jief : I found this here : https://github.com/cjlano/tinyprintf/blob/master/tinyprintf.c. Thanks CJlano */ #if DEFINE_SECTIONS == 1 __attribute__((noinline, section(".print_ulonglong"))) #elif DEFINE_SECTIONS == 2 __attribute__((noinline, section(".printf_lite"))) #endif static void print_ulonglong(UINT_BIGGEST_TYPE v, unsigned int base, PrintfParams* printfParams, int printfSign) { int n = 0; unsigned INT_BIGGEST_TYPE d = 1; #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 int nbDigits = 1 + printfSign; #endif while (v / d >= base) { d *= base; #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 nbDigits += 1; #endif } #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 && PRINTF_LITE_PADCHAR_SUPPORT == 1 if ( printfSign && printfParams->pad_char != ' ' ) print_char_macro('-', printfParams); #endif #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 while ( printfParams->width_specifier > nbDigits ) { #if PRINTF_LITE_PADCHAR_SUPPORT == 1 print_char_macro(printfParams->pad_char, printfParams); #else printfParams->printCharFunction(' ', printfParams); #endif nbDigits += 1; } #endif #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 && PRINTF_LITE_PADCHAR_SUPPORT == 1 if ( printfSign && printfParams->pad_char == ' ' ) print_char_macro('-', printfParams); #else if ( printfSign ) print_char_macro('-', printfParams); #endif while (d != 0) { unsigned int dgt = (unsigned int)(v / d); // cast is safe as v/d < 10 v %= d; d /= base; #if PRINTF_LITE_XSPECIFIER_SUPPORT == 1 print_char_macro( (char)(dgt + (dgt < 10 ? '0' : (printfParams->uppercase ? 'A' : 'a') - 10)), printfParams); #else print_char_macro( (char)(dgt + '0'), printfParams); #endif n += 1; } } #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 #if defined(EFIAPI) extern uint32_t getUptimeInMilliseconds(); #elif defined(__APPLE__) #include #include uint32_t getUptimeInMilliseconds() { static mach_timebase_info_data_t s_timebase_info; kern_return_t result = mach_timebase_info(&s_timebase_info); (void)result; // assert(result == 0); uint64_t time = mach_absolute_time(); time *= s_timebase_info.numer; time /= s_timebase_info.denom; time /= 1000; time /= 1000; return (uint32_t)(time); } #elif _MSC_VER #include //#include #endif #endif //PRINTF_LITE_TIMESTAMP_SUPPORT #ifdef __clang__ static void print_longlong(INT_BIGGEST_TYPE v, unsigned int base, PrintfParams* printfParams) __attribute__((no_sanitize("undefined"))); // disable sanitize because we'll do -v #endif #if DEFINE_SECTIONS == 1 __attribute__((noinline, section(".print_longlong"))) #elif DEFINE_SECTIONS == 2 __attribute__((noinline, section(".printf_lite"))) #endif static void print_longlong(INT_BIGGEST_TYPE v, unsigned int base, PrintfParams* printfParams) { if ( v >= 0 ) print_ulonglong((UINT_BIGGEST_TYPE)v, base, printfParams, 0); // cast ok, v >= 0 else print_ulonglong((UINT_BIGGEST_TYPE)-v, base, printfParams, 1); // -(INT64_MIN) == INT64_MIN !!! But cast as UINT64, it becomes +v. Good for us. } #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 && PRINTF_LITE_TIMESTAMP_CUSTOM_FUNCTION == 0 static void print_timestamp(PrintfParams* printfParams) { #if defined(WIN32) || defined(_WIN32) || defined(__WIN32__) || defined(WIN64) || defined(__NT__) SYSTEMTIME systime; GetSystemTime(&systime); uint32_t ms = systime.wMilliseconds; uint32_t s = systime.wSecond; uint32_t m = systime.wMinute; uint32_t h = systime.wHour; #else #ifdef USE_HAL_DRIVER uint32_t ms = HAL_GetTick(); #endif #ifdef ARDUINO uint32_t ms = millis(); #endif #ifdef NRF51 uint32_t p_ticks; uint32_t error_code = app_timer_cnt_get(&p_ticks); APP_ERROR_CHECK(error_code); uint32_t ms = p_ticks * ((NRF_RTC1->PRESCALER + 1) * 1000) / APP_TIMER_CLOCK_FREQ; #endif #ifdef __APPLE__ uint32_t ms = getUptimeInMilliseconds(); #endif uint32_t s = ms / 1000; uint32_t m = s / 60; uint32_t h = m / 60; #endif m %= 60; s %= 60; ms %= 1000; #if PRINTF_LITE_REENTRANT == 1 #ifdef ARDUINO printf_with_callback(F("%03" PRIu32 ":%02" PRIu32 ":%02" PRIu32 ".%03" PRIu32 " - "), printfParams->transmitBufCallBack.transmitBufCallBack, NULL, h, m, s, ms); #else printf_with_callback("%03" PRIu32 ":%02" PRIu32 ":%02" PRIu32 ".%03" PRIu32 " - ", printfParams->transmitBufCallBack.transmitBufCallBack, NULL, h, m, s, ms); #endif #else // non reentrant version take a bit more code size #if PRINTF_LITE_PADCHAR_SUPPORT == 1 char pad_char = printfParams->pad_char; printfParams->pad_char = '0'; #endif #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 int width_specifier = printfParams->width_specifier; printfParams->width_specifier = 3; #endif print_longlong(h, 10, printfParams); printfParams->printCharFunction(':', printfParams); #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 printfParams->width_specifier = 2; #endif print_longlong(m, 10, printfParams); printfParams->printCharFunction(':', printfParams); print_longlong(s, 10, printfParams); printfParams->printCharFunction('.', printfParams); #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 printfParams->width_specifier = 3; #endif print_longlong(ms, 10, printfParams); printfParams->printCharFunction(' ', printfParams); printfParams->printCharFunction('-', printfParams); printfParams->printCharFunction(' ', printfParams); #if PRINTF_LITE_PADCHAR_SUPPORT == 1 printfParams->pad_char = pad_char; #endif #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 printfParams->width_specifier = width_specifier; #endif #endif } #endif #if PRINTF_LITE_FLOAT_SUPPORT == 1 /* Jief : I found this in Arduino code */ /* According to snprintf(), * * nextafter((double)numeric_limits::max(), 0.0) ~= 9.22337e+18 * * This slightly smaller value was picked semi-arbitrarily. */ #define LARGE_DOUBLE_TRESHOLD (9.1e18) /* THIS FUNCTION SHOULDN'T BE USED IF YOU NEED ACCURATE RESULTS. * * This implementation is meant to be simple and not occupy too much * code size. However, printing floating point values accurately is a * subtle task, best left to a well-tested library function. * * See Steele and White 2003 for more details: * * http://kurtstephens.com/files/p372-steele.pdf */ static void print_double(double number, PrintfParams* printfParams) { // Hackish fail-fast behavior for large-magnitude doubles if (number >= LARGE_DOUBLE_TRESHOLD || number <= -LARGE_DOUBLE_TRESHOLD) { if (number < 0.0) { print_char_macro('-', printfParams); } #if PRINTF_UNICODE_OUTPUT_SUPPORT == 1 && PRINTF_UTF8_OUTPUT_SUPPORT == 0 output_utf8_string(L"", printfParams); #else output_utf8_string_as_utf8("", printfParams); #endif } int negative = 0; if (number < 0.0) { negative = 1; number = -number; } // Simplistic rounding strategy so that e.g. print(1.999, 2) // prints as "2.00" double rounding = 0.5; #if PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 if ( printfParams->precision_specifier < 0 ) printfParams->precision_specifier = 6; for (int i = 0; i < printfParams->precision_specifier; i++) { rounding /= 10.0; } #else for (unsigned int i = 0; i < 6; i++) { rounding /= 10.0; } #endif number += rounding; // Extract the integer part of the number and print it unsigned INT_BIGGEST_TYPE int_part = (unsigned INT_BIGGEST_TYPE)number; // we're sure it's positive number here. double remainder = number - (double)int_part; #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 int width_specifier = printfParams->width_specifier == -1 ? 6 : 0; #if PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 printfParams->width_specifier -= printfParams->precision_specifier + (printfParams->precision_specifier ? 1 : 0); // doesn't matter if width_specifier is negative. #else printfParams->width_specifier -= 7; // doesn't matter if width_specifier is negative. #endif #endif print_ulonglong(int_part, 10, printfParams, negative); #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 printfParams->width_specifier = width_specifier; #endif #if PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 // Print the decimal point, but only if there are digits beyond if (printfParams->precision_specifier > 0) { print_char_macro('.', printfParams); } #else // if no precision support, it's always 6, so always a decimal point. printfParams->printCharFunction('.', printfParams); #endif // Extract digits from the remainder one at a time #if PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 while (printfParams->precision_specifier-- > 0) { #else for ( int i=0 ; i<6 ; i++) { #endif remainder *= 10.0; int to_print = (int)remainder; print_char_macro((char)(to_print + '0'), printfParams); remainder -= to_print; } } #endif #if DEFINE_SECTIONS == 1 __attribute__((noinline, section(".printf_handle_format_char"))) #elif DEFINE_SECTIONS == 2 __attribute__((noinline, section(".printf_lite"))) #endif void printf_handle_format_char(char c, VALIST_PARAM_TYPE valist, PrintfParams* printfParams) { if ( printfParams->inDirective ) { switch(c) { #if PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 || PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 || PRINTF_LITE_PADCHAR_SUPPORT == 1 case '0': #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 if ( printfParams->inWidthField ) { printfParams->width_specifier *= 10; }else #endif #if PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 if ( printfParams->inPrecisionField ) { printfParams->precision_specifier *= 10; } else #endif #if PRINTF_LITE_PADCHAR_SUPPORT == 1 printfParams->pad_char = '0'; #else #if PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 0 printfParams->inDirective = 0; #endif #endif break; case '1': case '2': case '3': case '4': case '5': case '6': case '7': case '8': case '9': #if PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 || (PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 && PRINTF_LITE_FIELDWIDTH_SUPPORT == 1) if ( printfParams->inPrecisionField ) { #if PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 // just ignore if we don't support precision field printfParams->precision_specifier *= 10; printfParams->precision_specifier += ( c - '0'); #endif } else #endif { #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 printfParams->inWidthField = 1; printfParams->width_specifier *= 10; printfParams->width_specifier += ( c - '0'); #else #if PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 // We just have to ignore field width #else // It's considered a mistake. Get out directive. Nothing will be printed. Harder to debug the format string for the user, but save space. printfParams->inDirective = 0; #endif #endif } break; #ifdef PRINTF_LITE_DOT_STAR_SUPPORT case '*': #if PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 || (PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 && PRINTF_LITE_FIELDWIDTH_SUPPORT == 1) if ( printfParams->inPrecisionField ) { #if PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 // just ignore if we don't support precision field printfParams->precision_specifier = -2; #endif } else #endif { #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 printfParams->width_specifier = -1; #else #if PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 // We just have to ignore field width #else // It's considered a mistake. Get out directive. Nothing will be printed. Harder to debug the format string for the user, but save space. printfParams->inDirective = 0; #endif #endif } break; #endif #if PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 case '.': #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 printfParams->inWidthField = 0; #endif #if PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 || (PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 && PRINTF_LITE_FIELDWIDTH_SUPPORT == 1) printfParams->inPrecisionField = 1; #endif #if PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 printfParams->precision_specifier = 0; #endif break; #endif #endif // PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 || PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 #if PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_ZSPECIFIER_SUPPORT == 1 case 'z': #if PRINTF_LITE_ZSPECIFIER_SUPPORT == 1 printfParams->z_modifier = 1; #else printfParams->l_modifier = 12; #endif break; #endif // PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_ZSPECIFIER_SUPPORT == 1 #if PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_XSPECIFIER_SUPPORT == 1 case 'x': case 'X': #if PRINTF_LITE_XSPECIFIER_SUPPORT == 1 printfParams->uppercase = c == 'X'; #if PRINTF_LITE_ZSPECIFIER_SUPPORT == 1 if ( printfParams->z_modifier ) { print_ulonglong(va_arg(VALIST_ACCESS(valist), size_t), 16, printfParams, 0); }else #endif #if PRINTF_LITE_LONGLONGINT_SUPPORT == 1 && PRINTF_LITE_LONGINT_SUPPORT == 1 if ( printfParams->l_modifier > 11 ) { print_ulonglong(va_arg(VALIST_ACCESS(valist), unsigned long long int), 16, printfParams, 0); }else #endif #if PRINTF_LITE_LONGINT_SUPPORT == 1 if ( printfParams->l_modifier == 11 ) { print_ulonglong(va_arg(VALIST_ACCESS(valist), unsigned long int), 16, printfParams, 0); }else #endif #if PRINTF_LITE_SHORTINT_SUPPORT == 1 if ( printfParams->l_modifier == 9 ) { print_ulonglong((unsigned short)va_arg(VALIST_ACCESS(valist), unsigned int), 16, printfParams, 0); // we are using longlong version for every int to save code size. }else #endif #if PRINTF_LITE_SHORTSHORTINT_SUPPORT == 1 if ( printfParams->l_modifier < 9 ) { print_ulonglong((unsigned char)va_arg(VALIST_ACCESS(valist), unsigned int), 16, printfParams, 0); // we are using longlong version for every int to save code size. }else #endif print_ulonglong(va_arg(VALIST_ACCESS(valist), unsigned int), 16, printfParams, 0); printfParams->inDirective = 0; break; #endif #endif // PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_XSPECIFIER_SUPPORT == 1 #if PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_USPECIFIER_SUPPORT == 1 case 'u': #if PRINTF_LITE_USPECIFIER_SUPPORT == 1 #if PRINTF_LITE_ZSPECIFIER_SUPPORT == 1 if ( printfParams->z_modifier ) print_ulonglong(va_arg(VALIST_ACCESS(valist), size_t), 10, printfParams, 0); else #endif #if PRINTF_LITE_LONGLONGINT_SUPPORT == 1 && PRINTF_LITE_LONGINT_SUPPORT == 1 if ( printfParams->l_modifier > 11 ) print_ulonglong(va_arg(VALIST_ACCESS(valist), unsigned long long int), 10, printfParams, 0); else #endif // PRINTF_LITE_LONGLONGINT_SUPPORT == 1 && PRINTF_LITE_LONGINT_SUPPORT == 1 #if PRINTF_LITE_LONGINT_SUPPORT == 1 if ( printfParams->l_modifier == 11 ) print_ulonglong(va_arg(VALIST_ACCESS(valist), unsigned long int), 10, printfParams, 0); else #endif // PRINTF_LITE_LONGINT_SUPPORT == 1 #if PRINTF_LITE_SHORTINT_SUPPORT == 1 if ( printfParams->l_modifier == 9 ) { print_ulonglong((unsigned short)va_arg(VALIST_ACCESS(valist), unsigned int), 10, printfParams, 0); // we are using longlong version for every int to save code size. }else #endif #if PRINTF_LITE_SHORTSHORTINT_SUPPORT == 1 if ( printfParams->l_modifier < 9 ) { print_ulonglong((unsigned char)va_arg(VALIST_ACCESS(valist), unsigned int), 10, printfParams, 0); // we are using longlong version for every int to save code size. }else #endif print_ulonglong(va_arg(VALIST_ACCESS(valist), unsigned int), 10, printfParams, 0); printfParams->inDirective = 0; break; #endif // PRINTF_LITE_USPECIFIER_SUPPORT #endif // PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_USPECIFIER_SUPPORT == 1 case 'd': #if PRINTF_LITE_ZSPECIFIER_SUPPORT == 1 if ( printfParams->z_modifier ) print_ulonglong((UINT_BIGGEST_TYPE)va_arg(VALIST_ACCESS(valist), size_t), (unsigned int)10, printfParams, 0); // we are using longlong version for every int to save code size. else #endif #if PRINTF_LITE_LONGLONGINT_SUPPORT == 1 && PRINTF_LITE_LONGINT_SUPPORT == 1 if ( printfParams->l_modifier > 11 ) print_longlong(va_arg(VALIST_ACCESS(valist), long long int), 10, printfParams); // we are using longlong version for every int to save code size. else #endif #if PRINTF_LITE_LONGINT_SUPPORT == 1 if ( printfParams->l_modifier == 11 ) print_longlong(va_arg(VALIST_ACCESS(valist), long int), 10, printfParams); // we are using longlong version for every int to save code size. else #endif // #if PRINTF_LITE_SHORTINT_SUPPORT == 1 // if ( printfParams->l_modifier == 9 ) print_longlong(va_arg(VALIST_ACCESS(valist), short int), 10, printfParams); // we are using longlong version for every int to save code size. // else // #endif // #if PRINTF_LITE_SHORTSHORTINT_SUPPORT == 1 // if ( printfParams->l_modifier < 9 ) print_longlong(va_arg(VALIST_ACCESS(valist), char), 10, printfParams); // we are using longlong version for every int to save code size. // else // #endif print_longlong(va_arg(VALIST_ACCESS(valist), int), 10, printfParams); printfParams->inDirective = 0; break; #if PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_FLOAT_SUPPORT == 1 case 'f': #if PRINTF_LITE_FLOAT_SUPPORT == 1 print_double(va_arg(VALIST_ACCESS(valist), double), printfParams); // 'float' is promoted to 'double' when passed through '...' #elif PRINTF_LITE_FLOAT_AS_INT_SUPPORT == 1 print_longlong((INT_BIGGEST_TYPE)va_arg(VALIST_ACCESS(valist), double), 10, printfParams); // Cost 144 byte on Arduino #else va_arg(VALIST_ACCESS(valist), double); // this cost 16 bytes on stm32, 8 bytes on Arduino #endif printfParams->inDirective = 0; break; #endif // PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_FLOAT_SUPPORT == 1 #if PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_LONGINT_SUPPORT == 1 || PRINTF_LITE_FLOAT_SUPPORT == 1 case 'l': #if PRINTF_LITE_LONGINT_SUPPORT == 1 printfParams->l_modifier += 1; #endif break; case 'h': #if PRINTF_LITE_LONGINT_SUPPORT == 1 printfParams->l_modifier -= 1; #endif break; #endif case 'c': { int c1 = va_arg(VALIST_ACCESS(valist), int); #if PRINTF_UTF8_INPUT_SUPPORT == 1 { // wchar_t tmp2 = L'a'; // int tmp1 = va_arg(VALIST_ACCESS(valist), int); // int tmp3 = va_arg(VALIST_ACCESS(valist), wchar_t); if ( !printfParams->unicode_output && printfParams->l_modifier > 10 ) { // print unicode char to utf8 print_char32_as_utf8_string((char32_t)c1, printfParams); }else{ // c1 might be a char (<255) or a unicode char. UTF16 char < 255 are the same as UTF8. Ne need to check. print_char_macro(c1, printfParams); // 'char' is promoted to 'int' when passed through '...' } } #endif printfParams->inDirective = 0; } break; //#ifdef ARDUINO //#if PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_FLASHSTRING_SUPPORT == 1 // case 'F': // #if PRINTF_LITE_FLASHSTRING_SUPPORT == 1 // print_Fstring(va_arg(VALIST_ACCESS(valist), char *), printfParams); // #endif // printfParams->inDirective = 0; // break; //#endif //PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_FLASHSTRING_SUPPORT == 1 //#else //ARDUINO //#if PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_FLASHSTRING_SUPPORT == 0 // case 'F': //#endif //#endif #if PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 || PRINTF_LITE_FLASHSTRING_SUPPORT == 1 case 'F': #endif #if defined(ARDUINO) && PRINTF_LITE_FLASHSTRING_SUPPORT == 1 print_Fstring(va_arg(VALIST_ACCESS(valist), char *), printfParams); printfParams->inDirective = 0; break; #endif //defined(ARDUINO) && PRINTF_LITE_FLASHSTRING_SUPPORT == 1 case 's': { #ifdef PRINTF_LITE_DOT_STAR_SUPPORT if ( printfParams->precision_specifier == -2 ) { printfParams->precision_specifier = va_arg(VALIST_ACCESS(valist), int); } #endif #if PRINTF_CHECK_UNSUPPORTED_STRING_FORMAT == 1 && (PRINTF_UTF8_INPUT_SUPPORT==0 || PRINTF_UNICODE_INPUT_SUPPORT==0) // If both input support disabled, we can't even print "unsupported" # if PRINTF_UTF8_INPUT_SUPPORT == 1 || PRINTF_UNICODE_INPUT_SUPPORT== 1 # if PRINTF_UTF8_INPUT_SUPPORT == 0 if ( printfParams->l_modifier <= 10 ) { va_arg(VALIST_ACCESS(valist), const char*); # endif # if PRINTF_UNICODE_INPUT_SUPPORT == 0 if ( printfParams->l_modifier > 10 ) { va_arg(VALIST_ACCESS(valist), const wchar_t*); # endif # if PRINTF_UNICODE_OUTPUT_SUPPORT == 1 && PRINTF_UTF8_INPUT_SUPPORT == 0 output_utf8_string(L"unsupported", printfParams); # else output_utf8_string("unsupported", printfParams); # endif printfParams->inDirective = 0; } else # endif #endif #if PRINTF_UNICODE_INPUT_SUPPORT == 1 if ( printfParams->l_modifier > 10 ) { const wchar_t* s = va_arg(VALIST_ACCESS(valist), const wchar_t*); if ( printfParams->unicode_output ) { output_wchar_string(s, printfParams); }else{ output_wchar_string_as_utf8(s, printfParams); } printfParams->inDirective = 0; }else #endif #if PRINTF_UTF8_INPUT_SUPPORT == 1 { const char* s = va_arg(VALIST_ACCESS(valist), const char*); #if PRINTF_UTF8_OUTPUT_SUPPORT == 1 && PRINTF_UNICODE_OUTPUT_SUPPORT == 1 if ( printfParams->unicode_output ) { output_utf8_string_as_wchar(s, printfParams); }else{ output_utf8_string_as_utf8(s, printfParams); } #elif PRINTF_UTF8_OUTPUT_SUPPORT == 1 output_utf8_string(s, printfParams); #elif PRINTF_UNICODE_OUTPUT_SUPPORT == 1 output_utf8_string_as_wchar(s, printfParams); #endif } #endif printfParams->inDirective = 0; } // { // output_utf8_string(va_arg(VALIST_ACCESS(valist), const output_char_type*), printfParams); // printfParams->inDirective = 0; // } //#if PRINTF_UNICODE_INPUT_SUPPORT == 1 && PRINTF_UTF8_OUTPUT_SUPPORT == 1 // if ( printfParams->l_modifier == 0 ) { // output_utf8_string(va_arg(VALIST_ACCESS(valist), const char*), printfParams); // printfParams->inDirective = 0; // }else //#elif PRINTF_UTF8_INPUT_SUPPORT == 1 && PRINTF_UNICODE_OUTPUT_SUPPORT == 1 //#arning TODO // if ( printfParams->l_modifier == 1 ) { // output_utf8_string(va_arg(VALIST_ACCESS(valist), const char*), printfParams); // printfParams->inDirective = 0; // }else //#endif // { // output_utf8_string(va_arg(VALIST_ACCESS(valist), const output_char_type*), printfParams); // printfParams->inDirective = 0; // } break; default: { print_char_macro('%', printfParams); if ( c != '%' ) print_char_macro(c, printfParams); printfParams->inDirective = 0; } } } else { if ( c == '%' ) { printfParams->inDirective = 1; printfParams->l_modifier = 10; #if PRINTF_LITE_ZSPECIFIER_SUPPORT == 1 printfParams->z_modifier = 0; #endif #if PRINTF_LITE_FIELDWIDTH_SUPPORT == 1 printfParams->inWidthField = 0; printfParams->width_specifier = 0; #endif #if PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 || (PRINTF_LITE_FALLBACK_FOR_UNSUPPORTED == 1 && PRINTF_LITE_FIELDWIDTH_SUPPORT == 1) printfParams->inPrecisionField = 0; #endif #if PRINTF_LITE_FIELDPRECISION_SUPPORT == 1 printfParams->precision_specifier = -1; // -1 not specified. -2 specified by parameter. #endif #if PRINTF_LITE_PADCHAR_SUPPORT == 1 printfParams->pad_char = ' '; #endif } else { // print_utf8_char(c, printfParams); print_char_macro(c, printfParams); } } } #if DEFINE_SECTIONS == 1 __attribute__((noinline, section(".vprintf_with_callback"))) #elif DEFINE_SECTIONS == 2 __attribute__((noinline, section(".printf_lite"))) #endif #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 # if PRINTF_EMIT_CR_SUPPORT == 1 void vprintf_with_callback_timestamp_emitcr(const char* format, va_list valist, transmitBufCallBackType transmitBufCallBack, void* context, int* newline, int timestamp, int emitCr) # else void vprintf_with_callback_timestamp(const char* format, va_list valist, transmitBufCallBackType transmitBufCallBack, void* context, int* newline, int timestamp) # endif #else # if PRINTF_EMIT_CR_SUPPORT == 1 void vprintf_with_callback_emitcr(const char* format, va_list valist, transmitBufCallBackType transmitBufCallBack, void* context, int emitCr) # else void vprintf_with_callback(const char* format, va_list valist, transmitBufCallBackType transmitBufCallBack, void* context) # endif #endif { PrintfParams printfParams; #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 printfParams.newlinePtr = newline; printfParams.timestamp = timestamp; #endif #if PRINTF_LITE_BUF_SIZE > 1 printfParams.bufIdx = 0; #endif printfParams.inDirective = 0; #if PRINTF_UTF8_OUTPUT_SUPPORT == 1 && PRINTF_UNICODE_OUTPUT_SUPPORT == 1 printfParams.unicode_output = 0; printfParams.printCharFunction = print_utf8_char; #endif printfParams.transmitBufCallBack.transmitBufCallBack = transmitBufCallBack; #if PRINTF_EMIT_CR_SUPPORT == 1 printfParams.emitCr = emitCr; #endif printfParams.context = context; while ( 1 ) //Iterate over formatting string { char c = *format++; if (c == 0) break; printf_handle_format_char(c, VALIST_PARAM(valist), &printfParams); } #if PRINTF_LITE_BUF_SIZE > 1 if ( printfParams.bufIdx > 0 ) printfParams.transmitBufCallBack.transmitBufCallBack(printfParams.buf.buf, printfParams.bufIdx, printfParams.context); #endif va_end(valist); } // I tried to inline this in printf_lite.h, but GCC seems to not accept that an inline function could call another inline function. #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 # if PRINTF_EMIT_CR_SUPPORT == 1 void vprintf_with_callback_timestamp(const char* format, va_list valist, transmitBufCallBackType transmitBufCallBack, void* context, int* newline, int timestamp) { vprintf_with_callback_timestamp_emitcr(format, valist, transmitBufCallBack, context, newline, timestamp, 0); } void vprintf_with_callback_emitcr(const char* format, va_list valist, transmitBufCallBackType transmitBufCallBack, void* context, int emitCr) { vprintf_with_callback_timestamp_emitcr(format, valist, transmitBufCallBack, context, NULL, 0, emitCr); } void vprintf_with_callback(const char* format, va_list valist, transmitBufCallBackType transmitBufCallBack, void* context) { vprintf_with_callback_timestamp_emitcr(format, valist, transmitBufCallBack, context, NULL, 0, 0); } # else void vprintf_with_callback(const char* format, va_list valist, transmitBufCallBackType transmitBufCallBack, void* context) { vprintf_with_callback_timestamp(format, valist, transmitBufCallBack, context, NULL, 0); } # endif #else # if PRINTF_EMIT_CR_SUPPORT == 1 void vprintf_with_callback(const char* format, va_list valist, transmitBufCallBackType transmitBufCallBack, void* context) { vprintf_with_callback_emitcr(format, valist, transmitBufCallBack, context, 0); } # endif #endif #if DEFINE_SECTIONS == 1 __attribute__((noinline, section(".printf_with_callback"))) #elif DEFINE_SECTIONS == 2 __attribute__((noinline, section(".printf_lite"))) #endif #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 # if PRINTF_EMIT_CR_SUPPORT == 1 void printf_with_callback_timestamp_emitcr(const char* format, transmitBufCallBackType transmitBufCallBack, void* context, int* newline, int timestamp, int emitCr, ...) # else void printf_with_callback_timestamp(const char* format, transmitBufCallBackType transmitBufCallBack, void* context, int* newline, int timestamp, ...) # endif #else # if PRINTF_EMIT_CR_SUPPORT == 1 void printf_with_callback_emitcr(const char* format, transmitBufCallBackType transmitBufCallBack, void* context, int emitCr, ...) # else void printf_with_callback(const char* format, transmitBufCallBackType transmitBufCallBack, void* context, ...) # endif #endif { va_list valist; #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 # if PRINTF_EMIT_CR_SUPPORT == 1 va_start(valist, emitCr); # else va_start(valist, timestamp); #endif #else # if PRINTF_EMIT_CR_SUPPORT == 1 va_start(valist, emitCr); # else va_start(valist, context); #endif #endif #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 # if PRINTF_EMIT_CR_SUPPORT == 1 vprintf_with_callback_timestamp_emitcr(format, valist, transmitBufCallBack, context, newline, timestamp, emitCr); # else vprintf_with_callback_timestamp(format, valist, transmitBufCallBack, context, newline, timestamp); # endif #else # if PRINTF_EMIT_CR_SUPPORT == 1 vprintf_with_callback_emitcr(format, valist, transmitBufCallBack, context, emitCr); # else vprintf_with_callback(format, valist, transmitBufCallBack, context); # endif #endif va_end(valist); } #if PRINTF_UNICODE_OUTPUT_SUPPORT == 1 /* * * Only needed if PRINTF_UNICODE_OUTPUT_SUPPORT == 1 && PRINTF_UTF8_INPUT_SUPPORT == 1 */ static const char* get_utf32_from_utf8(const char* s, char32_t* utf32_letter) { tryagain: if ( *((unsigned char*)s) & 0x80 ) { // if Byte 1 is 1xxxxxxx : multi byte is at least 2 char if (*(s+1) == 0) { // Finished in the middle of an utf8 multibyte char return NULL; } // Byte 2 should be 0b10xxxxxx if ((*(((unsigned char*)s)+1) & 0xc0) != 0x80) { // 0xC0 = 0b11000000 // second byte is not multi byte char, ignore s += 1; goto tryagain; } // if Byte 1 is 111xxxxx : multi byte is at least 3 char if ((*((unsigned char*)s) & 0xe0) == 0xe0) { // 0xE0 = 0b11100000 if (*(s+2) == 0) { // Finished in the middle of an utf8 multibyte char return NULL; } // Byte 3 should be 0b10xxxxxx if ((*(((unsigned char*)s)+2) & 0xc0) != 0x80) { s += 1; goto tryagain; } // if Byte 1 is 1111xxxx : multi byte is 4 char if ((*((unsigned char*)s) & 0xf0) == 0xf0) { // 0xF0 = 0b11110000 if (*(s+3) == 0) { // Finished in the middle of an utf8 multibyte char return NULL; } // if Byte 1 is not 0b11110xxx || Byte 4 not 0b10xxxxxx if ((*((unsigned char*)s) & 0xf8) != 0xf0 || (*(((unsigned char*)s)+3) & 0xc0) != 0x80) { s += 1; goto tryagain; } /* 4-byte code */ *utf32_letter = (char32_t)((*((char32_t*)s) & 0x7) << 18); *utf32_letter |= (char32_t)((*(((unsigned char*)s)+1) & 0x3f) << 12); *utf32_letter |= (char32_t)((*(((unsigned char*)s)+2) & 0x3f) << 6); *utf32_letter |= *(((unsigned char*)s)+3) & 0x3f; return s + 4; } else { /* 3-byte code */ *utf32_letter = (char32_t)((*((unsigned char*)s) & 0xf) << 12); *utf32_letter |= (char32_t)((*(((unsigned char*)s)+1) & 0x3f) << 6); *utf32_letter |= *(((unsigned char*)s)+2) & 0x3f; return s + 3; } } else { /* 2-byte code */ *utf32_letter = (char32_t)((*((unsigned char*)s) & 0x1f) << 6); *utf32_letter |= *(((unsigned char*)s)+1) & 0x3f; return s + 2; } } else { /* 1-byte code */ *utf32_letter = *((unsigned char*)s); return s + 1; } } #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 void vwprintf_with_callback_timestamp(const char* format, va_list valist, transmitWBufCallBackType transmitWBufCallBack, void* context, int* newline, int timestamp) { PrintfParams printfParams; printfParams.newlinePtr = newline; printfParams.timestamp = timestamp; #if PRINTF_LITE_BUF_SIZE > 1 printfParams.bufIdx = 0; #endif printfParams.inDirective = 0; printfParams.unicode_output = 1; printfParams.printCharFunction = print_wchar; printfParams.transmitBufCallBack.transmitWBufCallBack = transmitWBufCallBack; printfParams.context = context; while ( *format ) //Iterate over formatting string { char32_t c; format = get_utf32_from_utf8(format, &c); if (format == 0) break; if ( c <= 0x80) { printf_handle_format_char((char)c, VALIST_PARAM(valist), &printfParams); continue; } #if __WCHAR_MAX__ <= 0xFFFFu if ( c <= 0xFFFF) { print_wchar((wchar_t)c, &printfParams); } else { c -= halfBase; print_wchar((wchar_t)((c >> halfShift) + UNI_SUR_HIGH_START), &printfParams); print_wchar((wchar_t)((c & halfMask) + UNI_SUR_LOW_START), &printfParams); } #else print_wchar((wchar_t)c, &printfParams); #endif } #if PRINTF_LITE_BUF_SIZE > 1 if ( printfParams.bufIdx > 0 ) printfParams.transmitBufCallBack.transmitBufCallBack(printfParams.buf.buf, printfParams.bufIdx, printfParams.context); #endif va_end(valist); } #else void vwprintf_with_callback(const char* format, va_list valist, transmitWBufCallBackType transmitWBufCallBack, void* context) { PrintfParams printfParams; #if PRINTF_LITE_BUF_SIZE > 1 printfParams.bufIdx = 0; #endif printfParams.inDirective = 0; printfParams.unicode_output = 1; printfParams.printCharFunction = print_wchar; printfParams.transmitBufCallBack.transmitWBufCallBack = transmitWBufCallBack; printfParams.emitCr = 0; printfParams.context = context; while ( *format ) //Iterate over formatting string { char32_t c; format = get_utf32_from_utf8(format, &c); if (format == 0) break; if ( c <= 0x80) { printf_handle_format_char((char)c, VALIST_PARAM(valist), &printfParams); continue; } #if __WCHAR_MAX__ <= 0xFFFFu if ( c <= 0xFFFF) { print_wchar((wchar_t)c, &printfParams); } else { c -= halfBase; print_wchar((wchar_t)((c >> halfShift) + UNI_SUR_HIGH_START), &printfParams); print_wchar((wchar_t)((c & halfMask) + UNI_SUR_LOW_START), &printfParams); } #else print_wchar((wchar_t)c, &printfParams); #endif } #if PRINTF_LITE_BUF_SIZE > 1 if ( printfParams.bufIdx > 0 ) printfParams.transmitBufCallBack.transmitBufCallBack(printfParams.buf.buf, printfParams.bufIdx, printfParams.context); #endif va_end(valist); } #endif void wprintf_with_callback(const char* format, transmitWBufCallBackType transmitWBufCallBack, void* context, #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 int* newline, int timestamp, #endif ...) { va_list valist; #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 va_start(valist, timestamp); #else va_start(valist, context); #endif #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 vwprintf_with_callback_timestamp(format, valist, transmitWBufCallBack, context, newline, timestamp); #else vwprintf_with_callback(format, valist, transmitWBufCallBack, context); #endif va_end(valist); } #endif /* ------------------------------------------------- SNPRINTF ------------------------------------------------- */ #if PRINTF_LITE_SNPRINTF_SUPPORT == 1 typedef struct SPrintfContext_t { void* printf_callback_vsnprintf_buffer; size_t printf_callback_vsnprintf_buffer_len; int printf_callback_vsnprintf_count; } SPrintfContext_t; /* --------------- vsnprintf,snprintf (Output UTF8) --------------- */ void transmitSPrintf(const char* buf, unsigned int nbchar, void* context) { SPrintfContext_t* SPrintfContext = (SPrintfContext_t*)context; unsigned int i=0; for ( ; SPrintfContext->printf_callback_vsnprintf_buffer_len>0 && iprintf_callback_vsnprintf_buffer); *(*sprintfBufChar)++ = buf[i]; SPrintfContext->printf_callback_vsnprintf_buffer_len--; } SPrintfContext->printf_callback_vsnprintf_count += nbchar; } int PRINTF_FUNCTION_NAME(PRINTF_CFUNCTION_PREFIX, vsnprint, PRINTF_CFUNCTION_SUFFIX)(char* buf, size_t len, const char *__restrict format, va_list valist) { SPrintfContext_t SPrintfContext; SPrintfContext.printf_callback_vsnprintf_buffer = buf; SPrintfContext.printf_callback_vsnprintf_buffer_len = len > 0 ? len-1 : 0; SPrintfContext.printf_callback_vsnprintf_count = 0; #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 vprintf_with_callback_timestamp(format, valist, transmitSPrintf, (void*)&SPrintfContext, NULL, 0); #else vprintf_with_callback(format, valist, transmitSPrintf, (void*)&SPrintfContext); #endif if ( len > 0 ) *(char*)(SPrintfContext.printf_callback_vsnprintf_buffer) = 0; return SPrintfContext.printf_callback_vsnprintf_count; } int PRINTF_FUNCTION_NAME(PRINTF_CFUNCTION_PREFIX, snprint, PRINTF_CFUNCTION_SUFFIX)(char* buf, size_t len, const char *__restrict format, ...) { va_list valist; va_start(valist, format); int ret = PRINTF_FUNCTION_NAME(PRINTF_CFUNCTION_PREFIX, vsnprint, PRINTF_CFUNCTION_SUFFIX)(buf, len, format, valist); va_end(valist); return ret; } #if PRINTF_UNICODE_OUTPUT_SUPPORT == 1 /* --------------- vsnwprintf,snwprintf (Output Unicode) --------------- */ typedef struct SWPrintfContext_t { wchar_t* printf_callback_vsnprintf_buffer; size_t printf_callback_vsnprintf_buffer_len; int printf_callback_vsnprintf_count; } SWPrintfContext_t; void transmitSWPrintf(const wchar_t* buf, unsigned int nbchar, void* context) { SWPrintfContext_t* SWPrintfContext = (SWPrintfContext_t*)context; unsigned int i=0; for ( ; SWPrintfContext->printf_callback_vsnprintf_buffer_len>0 && iprintf_callback_vsnprintf_buffer); *(*sprintfBufChar)++ = buf[i]; SWPrintfContext->printf_callback_vsnprintf_buffer_len--; } SWPrintfContext->printf_callback_vsnprintf_count += nbchar; } int PRINTF_FUNCTION_NAME(PRINTF_CFUNCTION_PREFIX, vsnwprint, PRINTF_CFUNCTION_SUFFIX)(wchar_t* buf, size_t len, const char *__restrict format, va_list valist) { SWPrintfContext_t SWPrintfContext; SWPrintfContext.printf_callback_vsnprintf_buffer = buf; SWPrintfContext.printf_callback_vsnprintf_buffer_len = len-1; SWPrintfContext.printf_callback_vsnprintf_count = 0; #if PRINTF_LITE_TIMESTAMP_SUPPORT == 1 vwprintf_with_callback_timestamp(format, valist, transmitSWPrintf, (void*)(&SWPrintfContext), NULL, 0); #else vwprintf_with_callback(format, valist, transmitSWPrintf, (void*)(&SWPrintfContext)); #endif *(wchar_t*)(SWPrintfContext.printf_callback_vsnprintf_buffer) = 0; #if VSNWPRINTF_RETURN_MINUS1_ON_OVERFLOW == 1 if ( (size_t)(SWPrintfContext.printf_callback_vsnprintf_count) >= len ) return -1; #endif return SWPrintfContext.printf_callback_vsnprintf_count; } int PRINTF_FUNCTION_NAME(PRINTF_CFUNCTION_PREFIX, snwprint, PRINTF_CFUNCTION_SUFFIX)(wchar_t* buf, size_t len, const char *__restrict format, ...) { va_list valist; va_start(valist, format); int ret = PRINTF_FUNCTION_NAME(PRINTF_CFUNCTION_PREFIX, vsnwprint, PRINTF_CFUNCTION_SUFFIX)(buf, len, format, valist); va_end(valist); return ret; } #endif // PRINTF_UNICODE_OUTPUT_SUPPORT == 1 #endif // PRINTF_LITE_SNPRINTF_SUPPORT == 1 #if defined(__cplusplus) } #endif