|
|
|
@ -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;
|
|
|
|
|