You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
68 lines
1.4 KiB
68 lines
1.4 KiB
#include "wrnum.h"
|
|
|
|
#include "libmflcd.h"
|
|
#define uart_tx(x) do { lcd_writedata(x); lcd_waitshort(); } while (0)
|
|
#define uart_writenum16 lcd_writenum16
|
|
|
|
|
|
__reentrantb uint8_t uart_writenum16(uint16_t val, uint8_t nrdig1, uint8_t flags1) __reentrant
|
|
{
|
|
char ch = 0;
|
|
uint8_t d;
|
|
uint8_t cnt = 5;
|
|
uint8_t flags = flags1;
|
|
uint8_t nrdig = nrdig1;
|
|
|
|
if ((flags & WRNUM_SIGNED) && (int16_t)val < 0) {
|
|
val = -val;
|
|
ch = '-';
|
|
} else if ((flags & WRNUM_ZEROPLUS) || ((flags & WRNUM_PLUS) && val)) {
|
|
ch = '+';
|
|
}
|
|
if (ch && nrdig > 0)
|
|
--nrdig;
|
|
if (flags & WRNUM_TSDSEP) {
|
|
if (nrdig > 3)
|
|
--nrdig;
|
|
}
|
|
flags &= WRNUM_MASK;
|
|
if (cnt < nrdig)
|
|
cnt = nrdig;
|
|
do {
|
|
d = cnt;
|
|
val = libmf_num16_digit(val, (uint8_t __auto *)&d);
|
|
if (!d && cnt != 1 && !(flags & WRNUM_DIGCONT)) {
|
|
if (cnt > nrdig)
|
|
continue;
|
|
if (!(flags & WRNUM_PADZERO)) {
|
|
if (!(flags & WRNUM_DIGSET)) {
|
|
nrdig = cnt;
|
|
flags |= WRNUM_DIGSET;
|
|
}
|
|
uart_tx(' ');
|
|
if ((flags & WRNUM_TSDSEP) && (cnt == 4)) {
|
|
uart_tx(' ');
|
|
++nrdig;
|
|
}
|
|
continue;
|
|
}
|
|
}
|
|
if (!(flags & WRNUM_DIGCONT)) {
|
|
if (!(flags & WRNUM_DIGSET))
|
|
nrdig = cnt;
|
|
flags |= WRNUM_PADZERO | WRNUM_DIGCONT | WRNUM_DIGSET;
|
|
if (ch) {
|
|
uart_tx(ch);
|
|
++nrdig;
|
|
}
|
|
}
|
|
uart_tx('0' + d);
|
|
if ((flags & WRNUM_TSDSEP) && (cnt == 4)) {
|
|
uart_tx('\'');
|
|
++nrdig;
|
|
}
|
|
} while (--cnt);
|
|
return nrdig;
|
|
}
|
|
|