/******************************************************************/
/** **/
/** Major features. These determine what capabilities your **/
-/** comiled printf_fast will have. **/
+/** compiled printf_fast will have. **/
/** **/
/******************************************************************/
// Include support for 32 bit base 10 integers (%ld and %lu). Without
// this, you won't be able to print 32 bit integers as base 10. They
-// will appear in hexidecimal.
+// will appear in hexadecimal.
#define LONG
// Include support for floating point numbers (%f). Don't forget to
/* extern void putchar(char ); */
+// Warning: using static/global variables makes these functions NON-reentrant!
+// reentrant keyword is only used for parameter passing method
static bit long_flag, short_flag, print_zero_flag, negative_flag;
#ifdef FIELD_WIDTH
static bit field_width_flag;
+static bit leading_zero_flag;
static data unsigned char field_width;
#endif
#ifdef FLOAT
+#define SDCC_FLOAT_LIB
#include <float.h>
static bit continue_float;
#ifndef FLOAT_FIXED4
-void printf_fast(code char *fmt, ...) reentrant
+#ifndef PRINTF_FAST
+#define PRINTF_FAST printf_fast
+#endif
+
+
+#if !defined(SDCC_mcs51) || defined(SDCC_USE_XSTACK) || defined(_SDCC_NO_ASM_LIB_FUNCS)
+// Does printf_fast really work on ds390 and ds400?
+// If it does, enable them in the line above
+#if defined(SDCC_USE_XSTACK)
+#warning "printf_fast not built, does not support --xstack"
+#elif defined(_SDCC_NO_ASM_LIB_FUNCS)
+#warning "printf_fast not built, _SDCC_NO_ASM_LIB_FUNCS defined"
+#endif
+#else // defines are compatible with printf_fast
+
+
+void PRINTF_FAST(code char *fmt, ...) reentrant
{
- fmt; /* supress unreferenced variable warning */
+ fmt; /* suppress unreferenced variable warning */
_asm
clr _negative_flag
#ifdef FIELD_WIDTH
clr _field_width_flag
+ clr _leading_zero_flag
mov r1, #_field_width
mov @r1, #0
#endif
jnc printf_nondigit2
#ifdef FIELD_WIDTH
printf_digit:
+ jnz printf_digit_2
+ cjne a, _field_width, printf_digit_2
+ setb _leading_zero_flag
+printf_digit_2:
setb _field_width_flag
mov r2, a
mov a, @r1
printf_format_c:
//cjne a, #'c', printf_format_x
cjne a, #99, printf_format_x
+ dec r0
mov a, @r0 // Acc has the character to print
dec r0
sjmp printf_char
#ifdef FIELD_WIDTH
jnb _field_width_flag, printf_str_loop
+ clr _leading_zero_flag // never leading zeros for strings
push dpl
push dph
printf_str_fw_loop:
mov _field_width, #0
#endif
print_float_begin:
- mov exp_b, r0 // keep r0 safe, will need it again
+ push ar0 // keep r0 safe, will need it again
lcall printf_get_float
clr c
mov a, #158 // check for large float we can't print
- subb a, exp_a
+ subb a, r7
jnc print_float_size_ok
printf_float_too_big:
// TODO: should print some sort of overflow error??
+ pop ar0
ljmp printf_format_loop
print_float_size_ok:
- lcall __fs_rshift_a
+ push dpl
+ lcall fs_rshift_a
+ pop dpl
setb _continue_float
#ifndef LONG
mov a, r3
lcall printf_putchar
// now that the integer part is printed, we need to refetch the
// float from the va_args and extract the fractional part
- mov r0, exp_b
+ pop ar0
lcall printf_get_float
push ar0
- mov a, exp_a
+ push dpl
+ push dph
+ mov a, r7
cjne a, #126, print_float_frac_lshift
sjmp print_float_frac // input between 0.5 to 0.9999
print_float_frac_lshift:
//Acc (exponent) is less than 126 (input < 0.5)
cpl a
add a, #127
- lcall __fs_rshift_a
+ lcall fs_rshift_a
print_float_frac:
// now we've got the fractional part, so now is the time to
// convert to BCD... just convert each bit to BCD using a
clr a
mov r6, a
mov r5, a
- push dpl
- push dph
mov dptr, #_frac2bcd // FLOAT_FIXED4 version (14 entries)
print_float_frac_loop:
mov a, r3
print_float_begin:
push ar0 // keep r0 safe, will need it again
lcall printf_get_float
- mov a, exp_a
+ push dpl
+ push dph
+ mov a, r7
cjne a, #126, print_float_frac_lshift
sjmp print_float_frac // input between 0.5 to 0.9999
//Acc (exponent) is less than 126 (input < 0.5)
cpl a
add a, #127
- lcall __fs_rshift_a
+ lcall fs_rshift_a
print_float_frac:
- // Convert the fraction in r4/r3/r2/r1 into 8 BCD digits in exb_b/r7/r6/r5
+ // Convert the fraction in r4/r3/r2/r1 into 8 BCD digits in r0/r7/r6/r5
mov b, #27
clr a
- mov exp_b, a
+ mov r0, a
mov r7, a
mov r6, a
mov r5, a
- push dpl
- push dph
mov dptr, #_frac2bcd // FLOAT version (27 entries)
print_float_frac_loop:
mov a, r1
mov r7, a
mov a, #3
movc a, @a+dptr
- addc a, exp_b
+ addc a, r0
da a
- mov exp_b, a
+ mov r0, a
print_float_frac_skip:
inc dptr
inc dptr
inc dptr
inc dptr
djnz b, print_float_frac_loop
- pop dph
- pop dpl
print_float_frac_roundoff:
// Now it's time to round-off the BCD digits to the desired precision.
clr a
rl a
rl a
anl a, #0xFC
- lcall __fs_rshift_a // divide r4/r3/r2/r1 by 10^frac_field_width
+ mov dph, r0 // fs_rshift_a will overwrite r0 & dpl
+ lcall fs_rshift_a // divide r4/r3/r2/r1 by 10^frac_field_width
mov a, r5
add a, r1 // add rounding to fractional part
da a
addc a, r3
da a
mov _float_frac_bcd+1, a
- mov a, exp_b
+ mov a, dph
addc a, r4
da a
mov _float_frac_bcd+0, a
mov sign_b, c // keep fractional carry in sign_b
+ pop dph
+ pop dpl
print_float_int:
// Time to work on the integer portion... fetch the float again, check
// size (exponent), scale to integer, add the fraction's carry, and
push ar0
clr c
mov a, #158 // check for large float we can't print
- subb a, exp_a
+ subb a, r7
jnc print_float_size_ok
printf_float_too_big:
// TODO: should print some sort of overflow error??
+ pop ar0
ljmp printf_format_loop
print_float_size_ok:
- lcall __fs_rshift_a
+ push dpl
+ lcall fs_rshift_a
+ pop dpl
jnb sign_b, print_float_do_int
// if we get here, the fractional round off caused the
// integer part to increment. Add 1 for a proper result
#if 0
pm2_print_float:
- mov a, exp_a
+ mov a, r7
lcall pm2_entry_phex
mov a, #0x20
lcall pm2_entry_cout
#endif
// Fetch a float from the va_args and put it into
- // exp_a/r4/r3/r2 and also clear r1 and preset
+ // r7(exp) r4/r3/r2(mant) and also clear r1 and preset
// the flags
printf_get_float:
mov a, @r0
mov a, r1
rlc a
mov _negative_flag, c
- mov exp_a, a
+ mov r7, a
jz printf_get_float_2
orl ar4, #0x80
printf_get_float_2:
printf_space_loop:
//mov a, #' '
mov a, #32
+ jnb _leading_zero_flag, printf_space_output
+ //mov a, #'0'
+ mov a, #48
+printf_space_output:
lcall printf_putchar
dec _field_width
printf_space:
*/
#if 0
-code unsigned char int2bcd_0[] = {
+static code unsigned char int2bcd_0[] = {
0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
0x08, 0x09, 0x10, 0x11, 0x12, 0x13, 0x14, 0x15};
-code unsigned char int2bcd_1[] = {
+static code unsigned char int2bcd_1[] = {
0x00, 0x16, 0x32, 0x48, 0x64, 0x80, 0x96, 0x12,
0x28, 0x44, 0x60, 0x76, 0x92, 0x08, 0x24, 0x40,
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01,
0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x02, 0x02};
#endif
-code unsigned char int2bcd_2[] = {
+static code unsigned char int2bcd_2[] = {
0x00, 0x56, 0x12, 0x68, 0x24, 0x80, 0x36, 0x92,
0x48, 0x04, 0x60, 0x16, 0x72, 0x28, 0x84, 0x40,
0x00, 0x02, 0x05, 0x07, 0x10, 0x12, 0x15, 0x17,
0x20, 0x23, 0x25, 0x28, 0x30, 0x33, 0x35, 0x38};
-code unsigned char int2bcd_3[] = {
+static code unsigned char int2bcd_3[] = {
0x00, 0x96, 0x92, 0x88, 0x84, 0x80, 0x76, 0x72,
0x68, 0x64, 0x60, 0x56, 0x52, 0x48, 0x44, 0x40,
0x00, 0x40, 0x81, 0x22, 0x63, 0x04, 0x45, 0x86,
0x03, 0x03, 0x04, 0x04, 0x04, 0x05, 0x05, 0x06};
#ifdef LONG
-code unsigned char int2bcd_4[] = {
+static code unsigned char int2bcd_4[] = {
0x00, 0x36, 0x72, 0x08, 0x44, 0x80, 0x16, 0x52,
0x88, 0x24, 0x60, 0x96, 0x32, 0x68, 0x04, 0x40,
0x00, 0x55, 0x10, 0x66, 0x21, 0x76, 0x32, 0x87,
0x00, 0x06, 0x13, 0x19, 0x26, 0x32, 0x39, 0x45,
0x52, 0x58, 0x65, 0x72, 0x78, 0x85, 0x91, 0x98};
-code unsigned char int2bcd_5[] = {
+static code unsigned char int2bcd_5[] = {
0x00, 0x76, 0x52, 0x28, 0x04, 0x80, 0x56, 0x32,
0x08, 0x84, 0x60, 0x36, 0x12, 0x88, 0x64, 0x40,
0x00, 0x85, 0x71, 0x57, 0x43, 0x28, 0x14, 0x00,
0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
0x08, 0x09, 0x10, 0x11, 0x12, 0x13, 0x14, 0x15};
-code unsigned char int2bcd_6[] = {
+static code unsigned char int2bcd_6[] = {
0x00, 0x16, 0x32, 0x48, 0x64, 0x80, 0x96, 0x12,
0x28, 0x44, 0x60, 0x76, 0x92, 0x08, 0x24, 0x40,
0x00, 0x72, 0x44, 0x16, 0x88, 0x60, 0x32, 0x05,
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x01,
0x01, 0x01, 0x01, 0x01, 0x02, 0x02, 0x02, 0x02};
-code unsigned char int2bcd_7[] = {
+static code unsigned char int2bcd_7[] = {
0x00, 0x56, 0x12, 0x68, 0x24, 0x80, 0x36, 0x92,
0x48, 0x04, 0x60, 0x16, 0x72, 0x28, 0x84, 0x40,
0x00, 0x54, 0x09, 0x63, 0x18, 0x72, 0x27, 0x81,
*/
#ifdef LONG
-code unsigned char int2bcd[] = {
+static code unsigned char int2bcd[] = {
0x01, 0x00, 0x00, 0x00, 0x00, // 1
0x02, 0x00, 0x00, 0x00, 0x00, // 2
0x04, 0x00, 0x00, 0x00, 0x00, // 4
0x48, 0x36, 0x48, 0x47, 0x21 // 2147483648
};
#else // not LONG
-code unsigned char int2bcd[] = {
+static code unsigned char int2bcd[] = {
0x01, 0x00, 0x00, // 1
0x02, 0x00, 0x00, // 2
0x04, 0x00, 0x00, // 4
* }
*/
-code unsigned char frac2bcd[] = {
+static code unsigned char frac2bcd[] = {
0x00, 0x00, 0x00, 0x50, // 0.500000000000000 0.50000000
0x00, 0x00, 0x00, 0x25, // 0.250000000000000 0.75000000
0x00, 0x00, 0x50, 0x12, // 0.125000000000000 0.87500000
// 100.0 - 999.99 2 100.0 = 0x42C80000 42C8
// 1000 - 9999.9 1 1000 = 0x447A0000 447A
// 10000+ 0 10000 = 0x461C4000 461C
-code unsigned int float_range_table[] = {
+static code unsigned int float_range_table[] = {
65536 - 0x3A83,
65536 - 0x3C23,
65536 - 0x3DCC,
* }
*/
-code unsigned char frac2bcd[] = {
+static code unsigned char frac2bcd[] = {
0x00, 0x50, // 0.500000000000000 0.5000
0x00, 0x25, // 0.250000000000000 0.7500
0x50, 0x12, // 0.125000000000000 0.8750
#endif // FLOAT
-
+#endif // defines compatible with printf_fast
projects / fw / sdcc / blobdiff