|
|
@ -129,6 +129,30 @@ void safe_delay(millis_t ms) { |
|
|
|
return conv; |
|
|
|
} |
|
|
|
|
|
|
|
// Convert float to rj string with 1234, _123, -123, _-12, 12.3, _1.2, or -1.2 format
|
|
|
|
char *ftostr4sign(const float& fx) { |
|
|
|
int x = fx * 10, xx = abs(x); |
|
|
|
bool ispos = x >= 0, |
|
|
|
isten = xx >= 100, |
|
|
|
ishun = xx >= 1000; |
|
|
|
if (!isten || (ispos && !ishun)) { |
|
|
|
// 12.3, _1.2, -1.2
|
|
|
|
conv[0] = ispos ? (isten ? DIGIMOD(xx, 100) : ' ') : '-'; |
|
|
|
conv[1] = DIGIMOD(xx, 10); |
|
|
|
conv[2] = '.'; |
|
|
|
conv[3] = DIGIMOD(xx, 1); |
|
|
|
} |
|
|
|
else { |
|
|
|
// 1234, _123, -123, _-12
|
|
|
|
conv[0] = ispos ? (xx >= 10000 ? DIGIMOD(xx, 10000) : ' ') : (ishun ? '-' : ' '); |
|
|
|
conv[1] = ishun ? DIGIMOD(xx, 1000) : '-'; |
|
|
|
conv[2] = DIGIMOD(xx, 100); |
|
|
|
conv[3] = DIGIMOD(xx, 10); |
|
|
|
} |
|
|
|
conv[4] = '\0'; |
|
|
|
return conv; |
|
|
|
} |
|
|
|
|
|
|
|
// Convert float to fixed-length string with +123.4 / -123.4 format
|
|
|
|
char* ftostr41sign(const float& x) { |
|
|
|
int xx = x * 10; |
|
|
|