/*------------------------------------------------------------------------- printf_fast.c - Fast printf routine for use with sdcc/mcs51 Copyright (C) 2004, Paul Stoffregen, paul@pjrc.com This library is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2, or (at your option) any later version. This library is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this library; see the file COPYING. If not, write to the Free Software Foundation, 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. As a special exception, if you link this library with other files, some of which are compiled with SDCC, to produce an executable, this library does not by itself cause the resulting executable to be covered by the GNU General Public License. This exception does not however invalidate any other reasons why the executable file might be covered by the GNU General Public License. -------------------------------------------------------------------------*/ /******************************************************************/ /** **/ /** Major features. These determine what capabilities your **/ /** 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 hexadecimal. #define LONG // Include support for floating point numbers (%f). Don't forget to // enable LONG above, if you want to print floats greater than // 65535.997. You can have 6 good digits after the decimal point, // or an 8th if a small error is ok. +/- 2^32 to 1/10^8 isn't the // full dynamic range of 32 bit floats, but it covers the most // commonly used range. Adds about 500-600 bytes of code. //#define FLOAT // Include support for minimum field widths (%8d, %20s, %12.5f) #define FIELD_WIDTH // Include fast integer conversion. Without this, a compact but slower // algorithm is used to convert integers (%d, %u, int part of %f). // Even the slow algorithm is much faster than a typical C implementation // based on repetitive division by 10. If you enable this, you get an // extremely fast version (only 8 table lookups and 8 adds to convert a // 32 bit integer), but it costs extra code space for larger lookup // tables and optimized non-looping code. #define FAST_INTEGER /******************************************************************/ /** **/ /** Minor tweaks. These provide small code savings, with **/ /** a partial loss of functionality. **/ /** **/ /******************************************************************/ // If you enabled FLOAT, enabling this replaces the normal %f float // output with a very compact version that always prints 4 fractional // digits and does not have round off. Zero will print as "0.0000", // and 1.999997 will print as "1.9999" (not rounded up to 2). The // 4th digit is not accurate (+/- 2). This simpler version also // avoids using 5 bytes of internal data memory. Code size is about // 240 bytes less. //#define FLOAT_FIXED4 // If you used FLOAT (not FLOAT_FIXED4), this will remove the smart // default number of digits code. When you use "%f" without a field // width, normally the smart default width code chooses a good number // of digits based on size of the number. If you enabled FIELD_WIDTH // and use a number, like "%.5f", this smart default code is never // used anyway. Saves about 40 bytes of code. //#define FLOAT_DEFAULT_FRAC_DIGITS 6 // If you used FLOAT (not FLOAT_FIXED4) and you do not specify a // field width, normally trailing zeros are trimmed. Using this // removes that feature (saves only a few bytes). //#define DO_NOT_TRIM_TRAILING_ZEROS // Omit saving and restoring registers when calling putchar(). If you // are desparate for a little more code space, this will give you a // small savings. You MUST define putchar() with #pragma callee_saves, // or implement it in assembly and avoid changing the registers. //#define PUTCHAR_CALLEE_SAVES /* 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 static __bit continue_float; #ifndef FLOAT_FIXED4 static __data unsigned char frac_field_width; static __data unsigned char float_frac_bcd[4]; // TODO: can float_frac_bcd be overlaid with temps used by trig functions #endif #endif #ifndef FAST_INTEGER #ifdef LONG static __data unsigned int i2bcd_tmp; // slow 32 int conversion needs temp space #endif #endif #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 const char *fmt, ...) __reentrant { fmt; /* suppress unreferenced variable warning */ __asm printf_begin: mov a, _bp // r0 will point to va_args (stack) add a, #253 mov r0, a // r0 points to MSB of fmt mov dph, @r0 dec r0 mov dpl, @r0 // dptr has address of fmt dec r0 printf_main_loop: clr a movc a, @a+dptr // get next byte of fmt string inc dptr //cjne a, #'%', printf_normal cjne a, #37, printf_normal printf_format: clr _long_flag clr _short_flag clr _print_zero_flag clr _negative_flag #ifdef FIELD_WIDTH clr _field_width_flag clr _leading_zero_flag mov r1, #_field_width mov @r1, #0 #endif #ifdef FLOAT clr _continue_float #endif printf_format_loop: clr a movc a, @a+dptr // get next byte of data format inc dptr /* parse and consume the field width digits, even if */ /* we don't build the code to make use of them */ add a, #198 jc printf_nondigit1 add a, #10 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 mov b, #10 mul ab add a, r2 mov @r1, a #endif sjmp printf_format_loop printf_nondigit1: add a, #10 printf_nondigit2: add a, #48 printf_format_l: //cjne a, #'l', printf_format_h cjne a, #108, printf_format_h setb _long_flag sjmp printf_format_loop printf_format_h: //cjne a, #'h', printf_format_s cjne a, #104, printf_format_s setb _short_flag sjmp printf_format_loop printf_format_s: //cjne a, #'s', printf_format_d cjne a, #115, printf_format_d ljmp printf_string printf_format_d: //cjne a, #'d', printf_format_u cjne a, #100, printf_format_u lcall printf_get_int ljmp printf_int printf_format_u: //cjne a, #'u', printf_format_c cjne a, #117, printf_format_c lcall printf_get_int ljmp printf_uint 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 printf_format_x: //cjne a, #'x', printf_format_f cjne a, #120, printf_format_f ljmp printf_hex printf_format_f: #ifdef FLOAT //cjne a, #'f', printf_format_dot cjne a, #102, printf_format_dot ljmp print_float #endif printf_format_dot: //cjne a, #'.', printf_normal cjne a, #46, printf_normal #ifdef FLOAT #ifdef FLOAT_FIXED4 mov r1, #ar3 // parse frac field, but discard if FIXED4 #else mov r1, #_frac_field_width mov @r1, #0 #endif #endif sjmp printf_format_loop printf_normal: jz printf_eot printf_char: lcall printf_putchar ljmp printf_main_loop printf_eot: ljmp printf_end /* print a string... just grab each byte with __gptrget */ /* the user much pass a 24 bit generic pointer */ printf_string: push dph // save addr in fmt onto stack push dpl mov b, @r0 // b has type of address (generic *) dec r0 mov dph, @r0 dec r0 mov dpl, @r0 // dptr has address of user's string dec r0 #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: lcall __gptrget jz printf_str_space inc dptr dec _field_width mov a, _field_width jnz printf_str_fw_loop printf_str_space: lcall printf_space pop dph pop dpl #endif // FIELD_WIDTH printf_str_loop: lcall __gptrget jz printf_str_done inc dptr lcall printf_putchar sjmp printf_str_loop printf_str_done: pop dpl // restore addr withing fmt pop dph ljmp printf_main_loop /* printing in hex is easy because sdcc pushes the LSB first */ printf_hex: lcall printf_hex8 jb _short_flag, printf_hex_end lcall printf_hex8 jnb _long_flag, printf_hex_end lcall printf_hex8 lcall printf_hex8 printf_hex_end: lcall printf_zero ljmp printf_main_loop printf_hex8: mov a, @r0 lcall printf_phex_msn mov a, @r0 dec r0 ljmp printf_phex_lsn #ifndef LONG printf_ld_in_hex: //mov a, #'0' mov a, #48 lcall printf_putchar //mov a, #'x' mov a, #120 lcall printf_putchar mov a, r0 add a, #4 mov r0, a sjmp printf_hex #endif /* printing an integer is not so easy. For a signed int */ /* check if it is negative and print the minus sign and */ /* invert it to a positive integer */ printf_int: mov a, r5 jnb acc.7, printf_uint /* check if negative */ setb _negative_flag mov a, r1 /* invert integer */ cpl a add a, #1 mov r1, a jb _short_flag, printf_uint mov a, r2 cpl a addc a, #0 mov r2, a jnb _long_flag, printf_uint mov a, r3 cpl a addc a, #0 mov r3, a mov a, r4 cpl a addc a, #0 mov r4, a /* printing integers is a lot of work... because it takes so */ /* long, the first thing to do is make sure we're doing as */ /* little work as possible, then convert the binary int to */ /* packed BCD, and finally print each digit of the BCD number */ printf_uint: jb _short_flag, printf_uint_ck8 jnb _long_flag, printf_uint_ck16 printf_uint_ck32: /* it's a 32 bit int... but if the upper 16 bits are zero */ /* we can treat it like a 16 bit integer and convert much faster */ #ifdef LONG mov a, r3 jnz printf_uint_begin mov a, r4 jnz printf_uint_begin #else mov a, r3 jnz printf_ld_in_hex // print long integer as hex mov a, r4 // rather than just the low 16 bits jnz printf_ld_in_hex #endif clr _long_flag printf_uint_ck16: /* it's a 16 bit int... but if the upper 8 bits are zero */ /* we can treat it like a 8 bit integer and convert much faster */ mov a, r2 jnz printf_uint_begin setb _short_flag printf_uint_ck8: /* it's an 8 bit int... if it's zero, it's a lot faster to just */ /* print the digit zero and skip all the hard work! */ mov a, r1 jnz printf_uint_begin #ifdef FLOAT /* never use the "just print zero" shortcut if we're printing */ /* the integer part of a float (fixes bug 1255403) */ jb _continue_float, printf_uint_begin #endif #ifdef FIELD_WIDTH jnb _field_width_flag, printf_uint_zero mov a, _field_width jz printf_uint_zero dec _field_width lcall printf_space #endif printf_uint_zero: //mov a, #'0' mov a, #48 lcall printf_putchar ljmp printf_main_loop printf_uint_begin: push dpl push dph lcall printf_int2bcd // bcd number in r3/r2/r7/r6/r5 printf_uint_2: #ifdef FIELD_WIDTH jnb _field_width_flag, printf_uifw_end #ifdef LONG printf_uifw_32: mov r1, #10 jnb _long_flag, printf_uifw_16 mov a, r3 anl a, #0xF0 jnz printf_uifw_sub dec r1 mov a, r3 anl a, #0x0F jnz printf_uifw_sub dec r1 mov a, r2 anl a, #0xF0 jnz printf_uifw_sub dec r1 mov a, r2 anl a, #0x0F jnz printf_uifw_sub dec r1 mov a, r7 anl a, #0xF0 jnz printf_uifw_sub #endif // LONG printf_uifw_16: mov r1, #5 jb _short_flag, printf_uifw_8 mov a, r7 anl a, #0x0F jnz printf_uifw_sub dec r1 mov a, r6 anl a, #0xF0 jnz printf_uifw_sub printf_uifw_8: mov r1, #3 mov a, r6 anl a, #0x0F jnz printf_uifw_sub dec r1 mov a, r5 anl a, #0xF0 jnz printf_uifw_sub dec r1 printf_uifw_sub: //r1 has the number of digits for the number mov a, _field_width mov c, _negative_flag subb a, r1 jc printf_uifw_end mov _field_width, a #ifndef PUTCHAR_CALLEE_SAVES #ifdef LONG push ar3 push ar2 #endif push ar7 push ar6 push ar5 #endif lcall printf_space #ifndef PUTCHAR_CALLEE_SAVES pop ar5 pop ar6 pop ar7 #ifdef LONG pop ar2 pop ar3 #endif #endif printf_uifw_end: #endif // FIELD_WIDTH printf_uint_doit: jnb _negative_flag, printf_uint_pos #ifdef PUTCHAR_CALLEE_SAVES //mov a, #'-' mov a, #45 lcall printf_putchar #else #ifdef LONG push ar3 push ar2 #endif push ar7 push ar6 push ar5 //mov a, #'-' mov a, #45 lcall printf_putchar pop ar5 pop ar6 pop ar7 #ifdef LONG pop ar2 pop ar3 #endif #endif // PUTCHAR_CALLEE_SAVES printf_uint_pos: jb _short_flag, printf_uint8 #ifdef LONG jnb _long_flag, printf_uint16 printf_uint32: push ar5 push ar6 push ar7 mov dpl, r2 mov a, r3 mov dph, a lcall printf_phex_msn mov a, dph lcall printf_phex_lsn mov a, dpl lcall printf_phex_msn mov a, dpl lcall printf_phex_lsn pop acc mov dpl, a lcall printf_phex_msn mov a, dpl pop dph pop dpl sjmp printf_uint16a #endif // LONG printf_uint16: mov dpl, r5 mov dph, r6 mov a, r7 printf_uint16a: lcall printf_phex_lsn mov a, dph lcall printf_phex_msn mov a, dph sjmp printf_uint8a printf_uint8: mov dpl, r5 mov a, r6 printf_uint8a: lcall printf_phex_lsn mov a, dpl lcall printf_phex_msn mov a, dpl lcall printf_phex_lsn lcall printf_zero pop dph pop dpl #ifdef FLOAT jnb _continue_float, 0002$ ret 0002$: #endif ljmp printf_main_loop #ifdef FLOAT #ifdef FLOAT_FIXED4 // Print a float the easy way. First, extract the integer part and // use the integer printing code. Then extract the fractional part, // convert each bit to 4 digit BCD, and print the BCD sum. Absolutely // no field width control, always 4 digits printed past the decimal // point. No round off. 1.9999987 prints as 1.9999, not 2.0000. print_float: #ifdef FIELD_WIDTH jnb _field_width_flag, print_float_begin mov a, _field_width add a, #251 mov _field_width, a jc print_float_begin mov _field_width, #0 #endif print_float_begin: 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, 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: push dpl lcall fs_rshift_a pop dpl setb _continue_float #ifndef LONG mov a, r3 orl a, r4 jnz printf_float_too_big #endif lcall printf_uint // print the integer portion //mov a, #'.' mov a, #0x2E 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 pop ar0 lcall printf_get_float push ar0 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: jc print_float_frac_rshift //Acc (exponent) is greater than 126 (input >= 1.0) add a, #130 mov r5, a print_float_lshift_loop: clr c mov a, r2 rlc a mov r2, a mov a, r3 rlc a mov r3, a mov a, r4 rlc a mov r4, a djnz r5, print_float_lshift_loop sjmp print_float_frac print_float_frac_rshift: //Acc (exponent) is less than 126 (input < 0.5) cpl a add a, #127 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 // lookup table and BCD sum them together mov r7, #14 clr a mov r6, a mov r5, a mov dptr, #_frac2bcd // FLOAT_FIXED4 version (14 entries) print_float_frac_loop: mov a, r3 rlc a mov r3, a mov a, r4 rlc a mov r4, a jnc print_float_frac_skip clr a movc a, @a+dptr add a, r5 da a mov r5, a mov a, #1 movc a, @a+dptr addc a, r6 da a mov r6, a print_float_frac_skip: inc dptr inc dptr djnz r7, print_float_frac_loop // the BCD sum is in dptr, so all we've got to do is output // all 4 digits. No trailing zero suppression, no nice round // off (impossible to change the integer part since we already // printed it). mov dph, r6 mov dpl, r5 setb _print_zero_flag mov a, dph lcall printf_phex_msn mov a, dph lcall printf_phex_lsn mov a, dpl lcall printf_phex_msn mov a, dpl lcall printf_phex_lsn pop dph pop dpl pop ar0 ljmp printf_main_loop #else // not FLOAT_FIXED4 print_float: // Print a float the not-as-easy way, with a configurable number of // fractional digits (up to 8) and proper round-off (up to 7 digits). // First, extract the fractional part, convert to BCD, and then add // the scaled round-off. Store the rounded fractional digits and // their carry. Then extract the integer portion, increment it if // the rounding caused a carry. Use the integer printing to output // the integer, and then output the stored fractional digits. This // approach requires 5 bytes of internal RAM to store the 8 fractional // digits and the number of them we'll actually print. This code is // a couple hundred bytes larger and a bit slower than the FIXED4 // version, but it gives very nice results. print_float_1: #ifdef FIELD_WIDTH jnb _field_width_flag, print_float_default_width // The caller specified exact field width, so use it. Need to // convert the whole float digits into the integer portion only. mov a, _field_width setb c subb a, _frac_field_width mov _field_width, a jnc print_float_begin mov _field_width, #0 sjmp print_float_begin #endif print_float_default_width: // The caller didn't specify field width (or FIELD_WIDTH is // not defined so it's ignored). We've still got to know // how many fractional digits are going to print, so we can // round off properly. #ifdef FLOAT_DEFAULT_FRAC_DIGITS mov _frac_field_width, #FLOAT_DEFAULT_FRAC_DIGITS #else // default fractional field width (between 0 to 7) // attempt to scale the default number of fractional digits // based on the magnitude of the float mov a, @r0 anl a, #0x7F // ignore sign bit mov r2, a // r2 is first byte of float dec r0 mov ar3, @r0 // r3 is second byte of float inc r0 mov r6, dpl mov r7, dph mov dptr, #_float_range_table mov r5, #7 print_float_default_loop: clr a movc a, @a+dptr add a, r3 inc dptr clr a movc a, @a+dptr addc a, r2 jnc print_float_default_done inc dptr djnz r5, print_float_default_loop print_float_default_done: mov _frac_field_width, r5 mov dpl, r6 mov dph, r7 #endif // not FLOAT_DEFAULT_FRAC_DIGITS print_float_begin: push ar0 // keep r0 safe, will need it again lcall printf_get_float 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: jc print_float_frac_rshift //Acc (exponent) is greater than 126 (input >= 1.0) add a, #130 mov r5, a print_float_lshift_loop: clr c mov a, r2 rlc a mov r2, a mov a, r3 rlc a mov r3, a mov a, r4 rlc a mov r4, a djnz r5, print_float_lshift_loop sjmp print_float_frac print_float_frac_rshift: //Acc (exponent) is less than 126 (input < 0.5) cpl a add a, #127 lcall fs_rshift_a print_float_frac: // Convert the fraction in r4/r3/r2/r1 into 8 BCD digits in r0/r7/r6/r5 mov b, #27 clr a mov r0, a mov r7, a mov r6, a mov r5, a mov dptr, #_frac2bcd // FLOAT version (27 entries) print_float_frac_loop: mov a, r1 rlc a mov r1, a mov a, r2 rlc a mov r2, a mov a, r3 rlc a mov r3, a mov a, r4 rlc a mov r4, a jnc print_float_frac_skip clr a movc a, @a+dptr add a, r5 da a mov r5, a mov a, #1 movc a, @a+dptr addc a, r6 da a mov r6, a mov a, #2 movc a, @a+dptr addc a, r7 da a mov r7, a mov a, #3 movc a, @a+dptr addc a, r0 da a mov r0, a print_float_frac_skip: inc dptr inc dptr inc dptr inc dptr djnz b, print_float_frac_loop print_float_frac_roundoff: // Now it's time to round-off the BCD digits to the desired precision. clr a mov r4, #0x50 // r4/r3/r2/r1 = 0.5 (bcd rounding) mov r3, a mov r2, a mov r1, a mov a, _frac_field_width rl a rl a anl a, #0xFC 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 mov _float_frac_bcd+3, a // and store it for later use mov a, r6 addc a, r2 da a mov _float_frac_bcd+2, a mov a, r7 addc a, r3 da a mov _float_frac_bcd+1, a 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 // let the integer printing code do all the work. pop ar0 lcall printf_get_float push ar0 clr c mov a, #158 // check for large float we can't print 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: 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 mov a, r1 add a, #1 mov r1, a clr a addc a, r2 mov r2, a #ifdef LONG clr a addc a, r3 mov r3, a clr a addc a, r4 mov r4, a #endif jc printf_float_too_big print_float_do_int: #ifndef LONG mov a, r3 orl a, r4 jnz printf_float_too_big #endif setb _continue_float lcall printf_uint // print the integer portion print_float_frac_width: // Now all we have to do is output the fractional digits that // were previous computed and stored in memory. #ifdef FIELD_WIDTH jb _field_width_flag, print_float_do_frac #endif #ifndef DO_NOT_TRIM_TRAILING_ZEROS // if the user did not explicitly set a // field width, trim off trailing zeros print_float_frac_trim: mov a, _frac_field_width jz print_float_do_frac lcall get_float_frac_digit jnz print_float_do_frac djnz _frac_field_width, print_float_frac_trim #endif print_float_do_frac: mov a, _frac_field_width jz print_float_done //mov a, #'.' mov a, #0x2E lcall printf_putchar mov r0, #0 setb _print_zero_flag print_float_do_frac_loop: inc r0 mov a, r0 lcall get_float_frac_digit lcall printf_phex_lsn mov a, r0 cjne a, _frac_field_width, print_float_do_frac_loop print_float_done: pop ar0 ljmp printf_main_loop // acc=1 for tenths, acc=2 for hundredths, etc get_float_frac_digit: dec a clr c rrc a mov psw.5, c add a, #_float_frac_bcd mov r1, a mov a, @r1 jb psw.5, get_float_frac_digit_done swap a get_float_frac_digit_done: anl a, #15 ret #endif // end of normal FLOAT code (not FLOAT_FIXED4) // These helper functions are used, regardless of which type of // FLOAT code is used. #if 0 pm2_print_float: mov a, r7 lcall pm2_entry_phex mov a, #0x20 lcall pm2_entry_cout lcall _print_r4321 mov a, #0x20 lcall pm2_entry_cout ret #endif // Fetch a float from the va_args and put it into // r7(exp) r4/r3/r2(mant) and also clear r1 and preset // the flags printf_get_float: mov a, @r0 dec r0 mov r1, a mov a, @r0 dec r0 mov r4, a rlc a mov a, r1 rlc a mov _negative_flag, c mov r7, a jz printf_get_float_2 orl ar4, #0x80 printf_get_float_2: mov a, @r0 dec r0 mov r3, a mov a, @r0 dec r0 mov r2, a mov r1, #0 clr _short_flag setb _long_flag ret #endif // FLOAT /* read an integer into r1/r2/r3/r4, and msb into r5 */ printf_get_int: mov a, @r0 mov r1, a mov r5, a dec r0 jb _short_flag, printf_get_done mov r2, ar1 mov a, @r0 mov r1, a dec r0 jnb _long_flag, printf_get_done mov r4, ar2 mov r3, ar1 mov a, @r0 mov r2, a dec r0 mov a, @r0 mov r1, a dec r0 printf_get_done: ret #ifdef FAST_INTEGER /* convert binary number in r4/r3/r2/r1 into bcd packed number * in r3/r2/r7/r6/r5. The input number is destroyed in the * process, to avoid needing extra memory for the result (and * r1 gets used for temporary storage). dptr is overwritten, * but r0 is not changed. */ printf_int2bcd: mov a, r1 mov b, #100 div ab mov r6, a mov a, #10 xch a, b div ab swap a orl a, b mov r5, a jnb _short_flag, printf_i2bcd_16 // if 8 bit int, we're done ret printf_i2bcd_16: mov a, r2 anl a, #0x0F mov r1, a mov dptr, #_int2bcd_2 movc a, @a+dptr add a, r5 da a mov r5, a mov a, r1 orl a, #16 movc a, @a+dptr addc a, r6 da a mov r6, a mov a, r2 swap a anl a, #0x0F mov r1, a mov dptr, #_int2bcd_3 movc a, @a+dptr add a, r5 da a mov r5, a mov a, r1 orl a, #16 movc a, @a+dptr addc a, r6 da a mov r6, a mov a, r1 orl a, #32 movc a, @a+dptr addc a, #0 da a mov r7, a jb _long_flag, printf_i2bcd_32 // if 16 bit int, we're done ret printf_i2bcd_32: #ifdef LONG mov a, r3 anl a, #0x0F mov r1, a mov dptr, #_int2bcd_4 movc a, @a+dptr add a, r5 da a mov r5, a mov a, r1 orl a, #16 movc a, @a+dptr addc a, r6 da a mov r6, a mov a, r1 orl a, #32 movc a, @a+dptr addc a, r7 da a mov r7, a clr a addc a, #0 mov r2, a mov a, r3 swap a anl a, #0x0F mov r1, a mov dptr, #_int2bcd_5 movc a, @a+dptr add a, r5 da a mov r5, a mov a, r1 orl a, #16 movc a, @a+dptr addc a, r6 da a mov r6, a mov a, r1 orl a, #32 movc a, @a+dptr addc a, r7 da a mov r7, a mov a, r1 orl a, #48 movc a, @a+dptr addc a, r2 da a mov r2, a mov a, r4 anl a, #0x0F mov r1, a mov dptr, #_int2bcd_6 mov r3, #0 lcall printf_bcd_add10 // saves 27 bytes, costs 5 cycles mov a, r4 swap a anl a, #0x0F mov r1, a mov dptr, #_int2bcd_7 printf_bcd_add10: movc a, @a+dptr add a, r5 da a mov r5, a mov a, r1 orl a, #16 movc a, @a+dptr addc a, r6 da a mov r6, a mov a, r1 orl a, #32 movc a, @a+dptr addc a, r7 da a mov r7, a mov a, r1 orl a, #48 movc a, @a+dptr addc a, r2 da a mov r2, a mov a, r1 orl a, #64 movc a, @a+dptr addc a, r3 da a mov r3, a #endif // LONG ret #else // not FAST_INTEGER /* convert binary number in r4/r3/r2/r1 into bcd packed number * in r3/r2/r7/r6/r5. The input number is destroyed in the * process, to avoid needing extra memory for the result (and * r1 gets used for temporary storage). dptr is overwritten, * but r0 is not changed. */ #ifdef LONG printf_int2bcd: mov a, #8 jb _short_flag, printf_int2bcd_begin mov a, #16 jnb _long_flag, printf_int2bcd_begin mov a, #32 printf_int2bcd_begin: mov b, a clr a mov r5, a mov r6, a mov r7, a mov (_i2bcd_tmp + 0), a mov (_i2bcd_tmp + 1), a mov dptr, #_int2bcd printf_i2bcd_loop: mov a, r4 rrc a mov r4, a mov a, r3 rrc a mov r3, a mov a, r2 rrc a mov r2, a mov a, r1 rrc a mov r1, a jnc print_i2bcd_skip clr a movc a, @a+dptr add a, r5 da a mov r5, a mov a, #1 movc a, @a+dptr addc a, r6 da a mov r6, a mov a, #2 movc a, @a+dptr addc a, r7 da a mov r7, a mov a, #3 movc a, @a+dptr addc a, (_i2bcd_tmp + 0) da a mov (_i2bcd_tmp + 0), a mov a, #4 movc a, @a+dptr addc a, (_i2bcd_tmp + 1) da a mov (_i2bcd_tmp + 1), a print_i2bcd_skip: inc dptr inc dptr inc dptr inc dptr inc dptr djnz b, printf_i2bcd_loop mov r2, (_i2bcd_tmp + 0) mov r3, (_i2bcd_tmp + 1) ret #else // not LONG printf_int2bcd: mov a, #8 jb _short_flag, printf_int2bcd_begin mov a, #16 printf_int2bcd_begin: mov b, a clr a mov r5, a mov r6, a mov r7, a mov dptr, #_int2bcd printf_i2bcd_loop: mov a, r2 rrc a mov r2, a mov a, r1 rrc a mov r1, a jnc printf_i2bcd_add_skip clr a movc a, @a+dptr add a, r5 da a mov r5, a mov a, #1 movc a, @a+dptr addc a, r6 da a mov r6, a mov a, #2 movc a, @a+dptr addc a, r7 da a mov r7, a printf_i2bcd_add_skip: inc dptr inc dptr inc dptr djnz b, printf_i2bcd_loop ret #endif // not LONG #endif // not FAST_INTEGER #ifdef FIELD_WIDTH 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: mov a, _field_width jnz printf_space_loop ret #endif /* print a hex digit, either upper 4 bit (msn) or lower 4 bits (lsn) */ printf_phex_msn: swap a printf_phex_lsn: anl a, #15 jnz printf_phex_ok jnb _print_zero_flag, printf_ret printf_phex_ok: setb _print_zero_flag add a, #0x90 da a addc a, #0x40 da a printf_putchar: #ifdef PUTCHAR_CALLEE_SAVES push dph push dpl mov dpl, a lcall _putchar pop dpl pop dph #else push dph push dpl push ar0 mov dpl, a lcall _putchar pop ar0 pop dpl pop dph #endif printf_ret: ret /* print a zero if all the calls to print the digits ended up */ /* being leading zeros */ printf_zero: jb _print_zero_flag, printf_ret //mov a, #'0' mov a, #48 ljmp printf_putchar printf_end: __endasm; } #ifdef FAST_INTEGER /* * #! /usr/bin/perl * for ($d=0; $d < 8; $d++) { * $n = 16 ** $d; * for ($p=0; $p < 5; $p++) { * last unless (((16 ** $d) * 15) / (10 ** ($p * 2))) % 100; * printf "code unsigned char int2bcd_%d_%d[15] = {", $d, $p; * for ($i=0; $i < 16; $i++) { * printf "0x%02d", * (((16 ** $d) * $i) / (10 ** ($p * 2))) % 100; * print ", " if $i < 15; * } * print "};\n"; * } * } */ #if 0 static __code unsigned char int2bcd_0[] = { 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x10, 0x11, 0x12, 0x13, 0x14, 0x15}; 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 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}; 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, 0x27, 0x68, 0x09, 0x50, 0x91, 0x32, 0x73, 0x14, 0x00, 0x00, 0x00, 0x01, 0x01, 0x02, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x04, 0x05, 0x05, 0x06}; #ifdef LONG 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, 0x42, 0x98, 0x53, 0x08, 0x64, 0x19, 0x75, 0x30, 0x00, 0x06, 0x13, 0x19, 0x26, 0x32, 0x39, 0x45, 0x52, 0x58, 0x65, 0x72, 0x78, 0x85, 0x91, 0x98}; 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, 0x86, 0x71, 0x57, 0x43, 0x29, 0x14, 0x00, 0x86, 0x00, 0x04, 0x09, 0x14, 0x19, 0x24, 0x29, 0x34, 0x38, 0x43, 0x48, 0x53, 0x58, 0x63, 0x68, 0x72, 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x10, 0x11, 0x12, 0x13, 0x14, 0x15}; 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, 0x77, 0x49, 0x21, 0x93, 0x65, 0x38, 0x10, 0x82, 0x00, 0x77, 0x55, 0x33, 0x10, 0x88, 0x66, 0x44, 0x21, 0x99, 0x77, 0x54, 0x32, 0x10, 0x88, 0x65, 0x00, 0x16, 0x33, 0x50, 0x67, 0x83, 0x00, 0x17, 0x34, 0x50, 0x67, 0x84, 0x01, 0x18, 0x34, 0x51, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x02, 0x02, 0x02}; 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, 0x36, 0x91, 0x45, 0x00, 0x54, 0x09, 0x63, 0x18, 0x00, 0x43, 0x87, 0x30, 0x74, 0x17, 0x61, 0x04, 0x48, 0x91, 0x35, 0x79, 0x22, 0x66, 0x09, 0x53, 0x00, 0x68, 0x36, 0x05, 0x73, 0x42, 0x10, 0x79, 0x47, 0x15, 0x84, 0x52, 0x21, 0x89, 0x58, 0x26, 0x00, 0x02, 0x05, 0x08, 0x10, 0x13, 0x16, 0x18, 0x21, 0x24, 0x26, 0x29, 0x32, 0x34, 0x37, 0x40}; #endif // LONG #else // not FAST_INTEGER /* * #! /usr/bin/perl * print "__code unsigned char int2bcd[] = {\n"; * for ($i=0, $n=1; $i<32; $i++, $n*=2) { * $r = sprintf "%010u", $n; * $r =~ /([0-9][0-9])([0-9][0-9])([0-9][0-9])([0-9][0-9])([0-9][0-9])/; * printf "0x%02d, 0x%02d, 0x%02d, 0x%02d, 0x%02d", $5, $4, $3, $2, $1; * print ',' if $i < 31; * printf "\t\t// %10u\n", $n; * } * print "}\n__code unsigned char int2bcd[] = {\n"; * for ($i=0, $n=1; $i<16; $i++, $n*=2) { * $r = sprintf "%06u", $n; * $r =~ /([0-9][0-9])([0-9][0-9])([0-9][0-9])/; * printf "0x%02d, 0x%02d, 0x%02d", $3, $2, $1; * print ',' if $i < 15; * printf "\t\t// %10u\n", $n; * } * print "};\n"; */ #ifdef LONG static __code unsigned char int2bcd[] = { 0x01, 0x00, 0x00, 0x00, 0x00, // 1 0x02, 0x00, 0x00, 0x00, 0x00, // 2 0x04, 0x00, 0x00, 0x00, 0x00, // 4 0x08, 0x00, 0x00, 0x00, 0x00, // 8 0x16, 0x00, 0x00, 0x00, 0x00, // 16 0x32, 0x00, 0x00, 0x00, 0x00, // 32 0x64, 0x00, 0x00, 0x00, 0x00, // 64 0x28, 0x01, 0x00, 0x00, 0x00, // 128 0x56, 0x02, 0x00, 0x00, 0x00, // 256 0x12, 0x05, 0x00, 0x00, 0x00, // 512 0x24, 0x10, 0x00, 0x00, 0x00, // 1024 0x48, 0x20, 0x00, 0x00, 0x00, // 2048 0x96, 0x40, 0x00, 0x00, 0x00, // 4096 0x92, 0x81, 0x00, 0x00, 0x00, // 8192 0x84, 0x63, 0x01, 0x00, 0x00, // 16384 0x68, 0x27, 0x03, 0x00, 0x00, // 32768 0x36, 0x55, 0x06, 0x00, 0x00, // 65536 0x72, 0x10, 0x13, 0x00, 0x00, // 131072 0x44, 0x21, 0x26, 0x00, 0x00, // 262144 0x88, 0x42, 0x52, 0x00, 0x00, // 524288 0x76, 0x85, 0x04, 0x01, 0x00, // 1048576 0x52, 0x71, 0x09, 0x02, 0x00, // 2097152 0x04, 0x43, 0x19, 0x04, 0x00, // 4194304 0x08, 0x86, 0x38, 0x08, 0x00, // 8388608 0x16, 0x72, 0x77, 0x16, 0x00, // 16777216 0x32, 0x44, 0x55, 0x33, 0x00, // 33554432 0x64, 0x88, 0x10, 0x67, 0x00, // 67108864 0x28, 0x77, 0x21, 0x34, 0x01, // 134217728 0x56, 0x54, 0x43, 0x68, 0x02, // 268435456 0x12, 0x09, 0x87, 0x36, 0x05, // 536870912 0x24, 0x18, 0x74, 0x73, 0x10, // 1073741824 0x48, 0x36, 0x48, 0x47, 0x21 // 2147483648 }; #else // not LONG static __code unsigned char int2bcd[] = { 0x01, 0x00, 0x00, // 1 0x02, 0x00, 0x00, // 2 0x04, 0x00, 0x00, // 4 0x08, 0x00, 0x00, // 8 0x16, 0x00, 0x00, // 16 0x32, 0x00, 0x00, // 32 0x64, 0x00, 0x00, // 64 0x28, 0x01, 0x00, // 128 0x56, 0x02, 0x00, // 256 0x12, 0x05, 0x00, // 512 0x24, 0x10, 0x00, // 1024 0x48, 0x20, 0x00, // 2048 0x96, 0x40, 0x00, // 4096 0x92, 0x81, 0x00, // 8192 0x84, 0x63, 0x01, // 16384 0x68, 0x27, 0x03 // 32768 }; #endif // not LONG #endif // not FAST_INTEGER #ifdef FLOAT #ifndef FLOAT_FIXED4 /* * #! /usr/bin/perl * for ($i=0, $f=0.5; $i<24; $i++) { * $r = sprintf "%.8f", $f; * $r =~ /0\.([0-9][0-9])([0-9][0-9])([0-9][0-9])([0-9][0-9])/; * printf "0x%02d, 0x%02d, 0x%02d, 0x%02d", $4, $3, $2, $1; * print ',' if $i < 23; * $sum += $r; * printf "\t\t// %.15f %.8f\n", $f, $sum; * $f /= 2; * } */ 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 0x00, 0x00, 0x25, 0x06, // 0.062500000000000 0.93750000 0x00, 0x50, 0x12, 0x03, // 0.031250000000000 0.96875000 0x00, 0x25, 0x56, 0x01, // 0.015625000000000 0.98437500 0x50, 0x12, 0x78, 0x00, // 0.007812500000000 0.99218750 0x25, 0x06, 0x39, 0x00, // 0.003906250000000 0.99609375 0x12, 0x53, 0x19, 0x00, // 0.001953125000000 0.99804687 0x56, 0x76, 0x09, 0x00, // 0.000976562500000 0.99902343 0x28, 0x88, 0x04, 0x00, // 0.000488281250000 0.99951171 0x14, 0x44, 0x02, 0x00, // 0.000244140625000 0.99975585 0x07, 0x22, 0x01, 0x00, // 0.000122070312500 0.99987792 0x04, 0x61, 0x00, 0x00, // 0.000061035156250 0.99993896 0x52, 0x30, 0x00, 0x00, // 0.000030517578125 0.99996948 0x26, 0x15, 0x00, 0x00, // 0.000015258789062 0.99998474 0x63, 0x07, 0x00, 0x00, // 0.000007629394531 0.99999237 0x81, 0x03, 0x00, 0x00, // 0.000003814697266 0.99999618 0x91, 0x01, 0x00, 0x00, // 0.000001907348633 0.99999809 0x95, 0x00, 0x00, 0x00, // 0.000000953674316 0.99999904 0x48, 0x00, 0x00, 0x00, // 0.000000476837158 0.99999952 0x24, 0x00, 0x00, 0x00, // 0.000000238418579 0.99999976 0x12, 0x00, 0x00, 0x00, // 0.000000119209290 0.99999988 0x06, 0x00, 0x00, 0x00, // 0.000000059604645 0.99999994 0x03, 0x00, 0x00, 0x00, // 0.000000029802322 0.99999997 0x01, 0x00, 0x00, 0x00, // 0.000000014901161 0.99999998 0x01, 0x00, 0x00, 0x00 // 0.000000007450581 0.99999999 }; #ifndef FLOAT_DEFAULT_FRAC_DIGITS // TODO: Perhaps these should be tweaked a bit to take round up // effects into account... or maybe give more default digits?? // Range #digits // 0.0001 - 0.0009999 7 // 0.001 - 0.009999 6 0.001 = 0x3A83126F 3A83 // 0.01 - 0.09999 5 0.01 = 0x3C23D70A 3C23 // 0.1 - 9.9999 4 0.1 = 0x3DCCCCCD, 3DCC // 10.0 - 99.99 3 10.0 = 0x41200000 4120 // 100.0 - 999.99 2 100.0 = 0x42C80000 42C8 // 1000 - 9999.9 1 1000 = 0x447A0000 447A // 10000+ 0 10000 = 0x461C4000 461C static __code unsigned int float_range_table[] = { 65536 - 0x3A83, 65536 - 0x3C23, 65536 - 0x3DCC, 65536 - 0x4120, 65536 - 0x42C8, 65536 - 0x447A, 65536 - 0x461C }; #endif #else // using FLOAT_FIXED4 /* * #! /usr/bin/perl * for ($i=0, $f=0.5; $i<14; $i++) { * $r = sprintf "%.4f", $f; * $r =~ /0\.([0-9][0-9])([0-9][0-9])/; * printf "0x%02d, 0x%02d", $2, $1; * print ',' if $i < 13; * $sum += $r; * printf "\t\t// %.15f %.4f\n", $f, $sum; * $f /= 2; * } */ static __code unsigned char frac2bcd[] = { 0x00, 0x50, // 0.500000000000000 0.5000 0x00, 0x25, // 0.250000000000000 0.7500 0x50, 0x12, // 0.125000000000000 0.8750 0x25, 0x06, // 0.062500000000000 0.9375 0x12, 0x03, // 0.031250000000000 0.9687 0x56, 0x01, // 0.015625000000000 0.9843 0x78, 0x00, // 0.007812500000000 0.9921 0x39, 0x00, // 0.003906250000000 0.9960 0x20, 0x00, // 0.001953125000000 0.9980 0x10, 0x00, // 0.000976562500000 0.9990 0x05, 0x00, // 0.000488281250000 0.9995 0x02, 0x00, // 0.000244140625000 0.9997 0x01, 0x00, // 0.000122070312500 0.9998 0x01, 0x00 // 0.000061035156250 0.9999 }; #endif // FLOAT_FIXED4 #endif // FLOAT #endif // defines compatible with printf_fast