mirror of
https://git.mirrors.martin98.com/https://github.com/luc-github/ESP3D.git
synced 2025-08-03 23:00:38 +08:00
93312ff8b5
* Update WebSocket library * Update SSDP library * Update TFT_eSPI library * Update EspLuaEngine library * Update SDFat library * Change to pioarduino * Make ESP3DMessageFIFO and ESP3DMessage more thread safe * Fix sanity checks for BT * Add some C6 support * Refactor ethernet code * Split Ethernet Sta / WiFi sta ESP Commands and settings * Simplify wait and wdtFeed code * Set C3 with 4MB by default in platformio.ini * Apply Disable brown out only on ESP32 to avoid crash e.g:ESP32S3 * Add missing entries in platformio.ini
501 lines
11 KiB
C++
501 lines
11 KiB
C++
/**
|
|
* Copyright (c) 2011-2020 Bill Greiman
|
|
* This file is part of the SdFat library for SD memory cards.
|
|
*
|
|
* MIT License
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a
|
|
* copy of this software and associated documentation files (the "Software"),
|
|
* to deal in the Software without restriction, including without limitation
|
|
* the rights to use, copy, modify, merge, publish, distribute, sublicense,
|
|
* and/or sell copies of the Software, and to permit persons to whom the
|
|
* Software is furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be included
|
|
* in all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
|
|
* OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
|
|
* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
|
|
* DEALINGS IN THE SOFTWARE.
|
|
*/
|
|
#ifndef PrintTemplates_h
|
|
#define PrintTemplates_h
|
|
/**
|
|
* \file
|
|
* \brief templates for printf
|
|
*/
|
|
#include <stdarg.h>
|
|
#include "FmtNumber.h"
|
|
/** test for digit */
|
|
#define isDigit(d) ('0' <= (d) && (d) <= '9')
|
|
/** control for supported floating formats */
|
|
#define PRINTF_USE_FLOAT 2
|
|
//-----------------------------------------------------------------------------
|
|
/** Formatted print.
|
|
*
|
|
* \param[in] file destination file or device.
|
|
* \param[in] fmt format string.
|
|
* \param[in] ap argument list.
|
|
*
|
|
* \return number of character printed for success else a negative value.
|
|
*/
|
|
template<typename F>
|
|
int vfprintf(F* file, const char *fmt, va_list ap) {
|
|
#if PRINTF_USE_FLOAT
|
|
char buf[30];
|
|
double f;
|
|
#else // PRINTF_USE_FLOAT
|
|
char buf[15];
|
|
#endif // PRINTF_USE_FLOAT
|
|
char prefix[3];
|
|
unsigned base;
|
|
int n;
|
|
int nc = 0;
|
|
int nf;
|
|
int nz;
|
|
int prec;
|
|
int width;
|
|
size_t np;
|
|
size_t ns;
|
|
size_t nw;
|
|
long ln;
|
|
char c;
|
|
char plusSign;
|
|
char* ptr; // end of string
|
|
char* str; // start of string
|
|
bool altForm;
|
|
bool leftAdjust;
|
|
bool isLong;
|
|
bool zeroPad;
|
|
|
|
while (true) {
|
|
const char* bgn = fmt;
|
|
while ((c = *fmt++) && c!= '%') {}
|
|
nw = fmt - bgn - 1;
|
|
if (nw) {
|
|
nc += nw;
|
|
if (nw != file->write(bgn, nw)) {
|
|
goto fail;
|
|
}
|
|
}
|
|
if (!c) break;
|
|
altForm = false;
|
|
leftAdjust = false;
|
|
np = 0;
|
|
nz = 0;
|
|
zeroPad = false;
|
|
plusSign = 0;
|
|
c = *fmt++;
|
|
|
|
while (true) {
|
|
if (c == '-') {
|
|
leftAdjust = true;
|
|
} else if (c == '+') {
|
|
plusSign = '+';
|
|
} else if (c == ' ') {
|
|
if (plusSign == 0) {
|
|
plusSign = ' ';
|
|
}
|
|
} else if (c == '0') {
|
|
zeroPad = true;
|
|
} else if (c == '#') {
|
|
altForm = true;
|
|
} else {
|
|
break;
|
|
}
|
|
c = *fmt++;
|
|
}
|
|
|
|
width = 0;
|
|
if (isDigit(c)) {
|
|
while(isDigit(c)) {
|
|
width = 10 * width + c - '0';
|
|
c = *fmt++;
|
|
}
|
|
} else if (c == '*') {
|
|
width = va_arg(ap, int);
|
|
c = *fmt++;
|
|
if (width < 0) {
|
|
leftAdjust = true;
|
|
width = -width;
|
|
}
|
|
}
|
|
if (leftAdjust) {
|
|
zeroPad = false;
|
|
}
|
|
|
|
prec = -1;
|
|
if (c == '.') {
|
|
zeroPad = false;
|
|
prec = 0;
|
|
c = *fmt++;
|
|
if (isDigit(c)) {
|
|
while(isDigit(c)) {
|
|
prec = 10 * prec + c - '0';
|
|
c = *fmt++;
|
|
}
|
|
} else if (c == '*') {
|
|
prec = va_arg(ap, int);
|
|
c = *fmt++;
|
|
}
|
|
}
|
|
|
|
isLong = false;
|
|
if (c == 'l' || c =='L') {
|
|
isLong = true;
|
|
c = *fmt++;
|
|
}
|
|
|
|
if (!c) break;
|
|
|
|
str = buf + sizeof(buf);
|
|
ptr = str;
|
|
switch(c) {
|
|
case 'c':
|
|
*--str = va_arg(ap, int);
|
|
break;
|
|
|
|
case 's':
|
|
str = va_arg(ap, char *);
|
|
if (!str) {
|
|
str = (char*)"(null)";
|
|
}
|
|
ns = strlen(str);
|
|
ptr = str + (prec >= 0 && (size_t)prec < ns ? prec : ns);
|
|
break;
|
|
|
|
case 'd':
|
|
case 'i':
|
|
ln = isLong ? va_arg(ap, long) : va_arg(ap, int);
|
|
if (prec || ln) {
|
|
if (ln < 0) {
|
|
prefix[np++] = '-';
|
|
ln = -ln;
|
|
} else if (plusSign) {
|
|
prefix[np++] = plusSign;
|
|
}
|
|
str = fmtUnsigned(str, ln, 10, true);
|
|
nz = prec + str - ptr;
|
|
}
|
|
break;
|
|
|
|
#if PRINTF_USE_FLOAT > 1
|
|
case 'e':
|
|
case 'E':
|
|
case 'f':
|
|
case 'F':
|
|
f = va_arg(ap, double);
|
|
if (f < 0) {
|
|
f = -f;
|
|
prefix[np++] = '-';
|
|
} else if (plusSign) {
|
|
prefix[np++] = plusSign;
|
|
}
|
|
str = fmtDouble(str, f, prec < 0 ? 6 : prec, altForm, c);
|
|
break;
|
|
#elif PRINTF_USE_FLOAT > 0
|
|
case 'f':
|
|
case 'F':
|
|
f = va_arg(ap, double);
|
|
if (f < 0) {
|
|
f = -f;
|
|
prefix[np++] = '-';
|
|
} else if (plusSign) {
|
|
prefix[np++] = plusSign;
|
|
}
|
|
str = fmtDouble(str, f, prec < 0 ? 6 : prec, altForm);
|
|
break;
|
|
#endif // PRINTF_USE_FLOAT
|
|
|
|
case 'o':
|
|
base = 8;
|
|
goto printUnsigned;
|
|
|
|
case 'u':
|
|
base = 10;
|
|
altForm = false;
|
|
goto printUnsigned;
|
|
|
|
case 'x':
|
|
case 'X':
|
|
base = 16;
|
|
goto printUnsigned;
|
|
|
|
printUnsigned:
|
|
ln = isLong ? va_arg(ap, long) : va_arg(ap, int);
|
|
if (prec || ln) {
|
|
str = fmtUnsigned(str, ln, base, c == 'X');
|
|
nz = prec + str - ptr;
|
|
}
|
|
if (altForm && ln) {
|
|
if (c == 'o') {
|
|
*--str = '0';
|
|
} else {
|
|
prefix[np++] = '0';
|
|
prefix[np++] = c;
|
|
}
|
|
}
|
|
break;
|
|
|
|
default:
|
|
*--str = c;
|
|
break;
|
|
}
|
|
ns = (ptr - str);
|
|
if (nz < 0) nz = 0;
|
|
n = ns + np + nz;
|
|
if (width < n) {
|
|
nc += n;
|
|
nf = 0;
|
|
} else {
|
|
nc += width;
|
|
if (zeroPad) {
|
|
nz += width - n;
|
|
nf = 0;
|
|
} else {
|
|
nf = width - n;
|
|
}
|
|
}
|
|
// Do right blank padding.
|
|
if (!leftAdjust) {
|
|
for (; nf > 0; nf--) {
|
|
if (1 != file->write(' ')) {
|
|
goto fail;
|
|
}
|
|
}
|
|
}
|
|
// Don't call write if no prefix.
|
|
if (np && np != file->write(prefix, np)) {
|
|
goto fail;
|
|
}
|
|
// Do zero padding.
|
|
for (; nz > 0; nz--) {
|
|
if (1 != file->write('0')) {
|
|
goto fail;
|
|
}
|
|
}
|
|
// Main item.
|
|
if (ns != file->write(str, ns)) {
|
|
goto fail;
|
|
}
|
|
// Right blank padding.
|
|
for (; nf > 0; nf--) {
|
|
if (1 != file->write(' ')) {
|
|
goto fail;
|
|
}
|
|
}
|
|
}
|
|
return nc;
|
|
fail:
|
|
return -1;
|
|
}
|
|
//-----------------------------------------------------------------------------
|
|
/** Formatted print.
|
|
*
|
|
* \param[in] file destination file or device.
|
|
* \param[in] fmt format string.
|
|
*
|
|
* \return number of character printed for success else a negative value.
|
|
*/
|
|
template<typename T>
|
|
int fprintf(T *file, const char* fmt, ...) {
|
|
va_list ap;
|
|
va_start(ap, fmt);
|
|
int rtn = vfprintf(file, fmt, ap);
|
|
va_end(ap);
|
|
return rtn;
|
|
}
|
|
//-----------------------------------------------------------------------------
|
|
/** Minimal formatted print.
|
|
*
|
|
* \param[in] file destination file or device.
|
|
* \param[in] fmt format string.
|
|
* \param[in] ap argument list.
|
|
*
|
|
* \return number of character printed for success else a negative value.
|
|
*/
|
|
template<typename F>
|
|
int vmprintf(F* file, const char *fmt, va_list ap) {
|
|
char buf[15];
|
|
char* ptr;
|
|
char* str;
|
|
bool isLong;
|
|
char c;
|
|
int nc = 0;
|
|
size_t ns;
|
|
long n;
|
|
|
|
while (true) {
|
|
const char* bgn = fmt;
|
|
while ((c = *fmt++) && c!= '%') {}
|
|
ns = fmt - bgn - 1;
|
|
if (ns) {
|
|
nc += file->write(bgn, ns);
|
|
}
|
|
if (!c) {
|
|
break;
|
|
}
|
|
c = *fmt++;
|
|
if (c == 'l') {
|
|
isLong = true;
|
|
c = *fmt++;
|
|
} else {
|
|
isLong = false;
|
|
}
|
|
if (!c) {
|
|
break;
|
|
}
|
|
ptr = str = buf + sizeof(buf);
|
|
switch (c) {
|
|
case 'c':
|
|
*--str = va_arg(ap, int);
|
|
break;
|
|
|
|
case 's':
|
|
str = va_arg(ap, char*);
|
|
ptr = str ? str + strlen(str) : nullptr;
|
|
break;
|
|
|
|
case 'd':
|
|
n = isLong ? va_arg(ap, long) : va_arg(ap, int);
|
|
str = fmtSigned(str, n, 10, true);
|
|
break;
|
|
|
|
case 'u':
|
|
n = isLong ? va_arg(ap, long) : va_arg(ap, int);
|
|
str = fmtUnsigned(str, n, 10, true);
|
|
break;
|
|
|
|
case 'x':
|
|
case 'X':
|
|
n = isLong ? va_arg(ap, long) : va_arg(ap, int);
|
|
str = fmtUnsigned(str, n, 16, c == 'X');
|
|
break;
|
|
|
|
default:
|
|
*--str = c;
|
|
break;
|
|
}
|
|
ns = ptr - str;
|
|
nc += file->write(str, ns);
|
|
}
|
|
return nc;
|
|
}
|
|
//-----------------------------------------------------------------------------
|
|
/** Minimal formatted print.
|
|
*
|
|
* \param[in] file destination file or device.
|
|
* \param[in] fmt format string.
|
|
*
|
|
* \return number of character printed for success else a negative value.
|
|
*/
|
|
template<typename T>
|
|
int mprintf(T *file, const char* fmt, ...) {
|
|
va_list ap;
|
|
va_start(ap, fmt);
|
|
int rtn = vmprintf(file, fmt, ap);
|
|
va_end(ap);
|
|
return rtn;
|
|
}
|
|
//------------------------------------------------------------------------------
|
|
#ifdef __AVR__
|
|
/** Minimal formatted print.
|
|
*
|
|
* \param[in] file destination file or device.
|
|
* \param[in] ifsh format string using F() macro.
|
|
* \param[in] ap argument list.
|
|
*
|
|
* \return number of character printed for success else a negative value.
|
|
*/
|
|
template<typename F>
|
|
int vmprintf(F file, const __FlashStringHelper *ifsh, va_list ap) {
|
|
bool isLong;
|
|
char buf[15];
|
|
char c;
|
|
char* ptr;
|
|
char* str;
|
|
size_t ns;
|
|
int nc = 0;
|
|
long n;
|
|
|
|
PGM_P fmt = reinterpret_cast<PGM_P>(ifsh);
|
|
while (true) {
|
|
while ((c = pgm_read_byte(fmt++)) && c != '%') {
|
|
nc += file->write(c);
|
|
}
|
|
if (!c) {
|
|
break;
|
|
}
|
|
c = pgm_read_byte(fmt++);
|
|
if (c == 'l') {
|
|
isLong = true;
|
|
c = pgm_read_byte(fmt++);
|
|
} else {
|
|
isLong = false;
|
|
}
|
|
if (!c) {
|
|
break;
|
|
}
|
|
ptr = str = buf + sizeof(buf);
|
|
switch (c) {
|
|
case 'c':
|
|
*--str = va_arg(ap, int);
|
|
break;
|
|
|
|
case 's':
|
|
str = va_arg(ap, char*);
|
|
ptr = str ? str + strlen(str) : nullptr;
|
|
break;
|
|
|
|
case 'd':
|
|
n = isLong ? va_arg(ap, long) : va_arg(ap, int);
|
|
str = fmtSigned(str, n, 10, true);
|
|
break;
|
|
|
|
case 'u':
|
|
n = isLong ? va_arg(ap, long) : va_arg(ap, int);
|
|
str = fmtUnsigned(str, n, 10, true);
|
|
break;
|
|
|
|
case 'x':
|
|
case 'X':
|
|
n = isLong ? va_arg(ap, long) : va_arg(ap, int);
|
|
str = fmtUnsigned(str, n, 16, c == 'X');
|
|
break;
|
|
|
|
default:
|
|
*--str = c;
|
|
break;
|
|
}
|
|
ns = ptr - str;
|
|
nc += file->write(str, ns);
|
|
}
|
|
return nc;
|
|
}
|
|
#endif // __AVR__
|
|
//-----------------------------------------------------------------------------
|
|
/** Minimal formatted print.
|
|
*
|
|
* \param[in] file destination file or device.
|
|
* \param[in] ifsh format string using F() macro.
|
|
*
|
|
* \return number of character printed for success else a negative value.
|
|
*/
|
|
template<typename F>
|
|
int mprintf(F* file, const __FlashStringHelper *ifsh, ...) {
|
|
va_list ap;
|
|
va_start(ap, ifsh);
|
|
#ifdef __AVR__
|
|
int rtn = vmprintf(file, ifsh, ap);
|
|
#else // __AVR__
|
|
int rtn = vmprintf(file, (const char*)ifsh, ap);
|
|
#endif // __AVR__
|
|
va_end(ap);
|
|
return rtn;
|
|
}
|
|
#endif // PrintTemplates_h
|