diff --git a/cores/esp32/StreamString.cpp b/cores/esp32/StreamString.cpp index bb992322..f50b6825 100644 --- a/cores/esp32/StreamString.cpp +++ b/cores/esp32/StreamString.cpp @@ -25,10 +25,11 @@ size_t StreamString::write(const uint8_t *data, size_t size) { if(size && data) { - if(reserve(length() + size + 1)) { + const unsigned int newlen = length() + size; + if(reserve(newlen + 1)) { memcpy((void *) (wbuffer() + len()), (const void *) data, size); - setLen(len() + size); - *(wbuffer() + len()) = 0x00; // add null for string end + setLen(newlen); + *(wbuffer() + newlen) = 0x00; // add null for string end return size; } }