1 ;---------------------------------------------------------------------------;
\r
2 ; Extended itoa, puts, printf and atoi (C)ChaN, 2011
\r
3 ;---------------------------------------------------------------------------;
\r
5 // Base size is 152 bytes
\r
6 #define CR_CRLF 0 // Convert \n to \r\n (+10 bytes)
\r
7 #define USE_XPRINTF 1 // Enable xprintf function (+194 bytes)
\r
8 #define USE_XSPRINTF 0 // Add xsprintf function (+78 bytes)
\r
9 #define USE_XFPRINTF 0 // Add xfprintf function (+54 bytes)
\r
10 #define USE_XATOI 0 // Enable xatoi function (+182 bytes)
\r
13 #if FLASHEND > 0x1FFFF
\r
14 #error xitoa module does not support 256K devices
\r
18 #include <avr/io.h> // Include device specific definitions.
\r
21 #ifdef SPM_PAGESIZE // Recent devices have "lpm Rd,Z+" and "movw".
\r
25 .macro _MOVW dh,dl, sh,sl
\r
28 #else // Earlier devices do not have "lpm Rd,Z+" nor "movw".
\r
34 .macro _MOVW dh,dl, sh,sl
\r
42 ;---------------------------------------------------------------------------
\r
43 ; Stub function to forward to user output function
\r
45 ;Prototype: void xputc (char chr // a character to be output
\r
50 .global xfunc_out ; xfunc_out must be initialized before using this module.
\r
59 cpi r24, 10 ;LF --> CRLF
\r
68 lds ZL, xfunc_out+0 ;Pointer to the registered output function.
\r
69 lds ZH, xfunc_out+1 ;/
\r
70 sbiw ZL, 0 ;Skip if null
\r
80 ;---------------------------------------------------------------------------
\r
81 ; Direct ROM string output
\r
83 ;Prototype: void xputs (const char *str_p // rom string to be output
\r
89 _MOVW ZH,ZL, r25,r24 ; Z = pointer to rom string
\r
99 ;---------------------------------------------------------------------------
\r
100 ; Extended direct numeral string output (32bit version)
\r
102 ;Prototype: void xitoa (long value, // value to be output
\r
103 ; char radix, // radix
\r
104 ; char width); // minimum width
\r
110 ;r25:r22 = value, r20 = base, r18 = digits
\r
111 clr r31 ;r31 = stack level
\r
112 ldi r30, ' ' ;r30 = sign
\r
113 ldi r19, ' ' ;r19 = filler
\r
114 sbrs r20, 7 ;When base indicates signd format and the value
\r
115 rjmp 0f ;is minus, add a '-'.
\r
128 0: sbrs r18, 7 ;When digits indicates zero filled,
\r
129 rjmp 1f ;filler is '0'.
\r
132 ;----- string conversion loop
\r
133 1: ldi r21, 32 ;r26 = r25:r22 % r20
\r
134 clr r26 ;r25:r22 /= r20
\r
146 cpi r26, 10 ;r26 is a numeral digit '0'-'F'
\r
149 4: subi r26, -'0' ;/
\r
152 cp r22, r1 ;Repeat until r25:r22 gets zero
\r
158 cpi r30, '-' ;Minus sign if needed
\r
162 5: cp r31, r18 ;Filler
\r
168 6: pop r24 ;Flush stacked digits and exit
\r
178 ;---------------------------------------------------------------------------;
\r
179 ; Formatted string output (16/32bit version)
\r
182 ; void __xprintf (const char *format_p, ...);
\r
183 ; void __xsprintf(char*, const char *format_p, ...);
\r
184 ; void __xfprintf(void(*func)(char), const char *format_p, ...);
\r
191 ld ZL, Y+ ;Z = pointer to format string
\r
194 0: _LPMI r24 ;Get a format char
\r
195 cpi r24, 0 ;End of format string?
\r
197 cpi r24, '%' ;Is format?
\r
199 1: rcall xputc ;Put a normal character
\r
203 20: ldi r18, 0 ;r18: digits
\r
205 _LPMI r21 ;Get flags
\r
206 cpi r21, '%' ;Is a %?
\r
208 cpi r21, '0' ;Zero filled?
\r
211 22: _LPMI r21 ;Get width
\r
212 23: cpi r21, '9'+1 ;
\r
224 24: brtc 25f ;get value (low word)
\r
228 cpi r21, 'c' ;Is type character?
\r
230 cpi r21, 's' ;Is type RAM string?
\r
232 cpi r21, 'S' ;Is type ROM string?
\r
234 _MOVW r23,r22,r25,r24 ;r25:r22 = value
\r
238 cpi r21, 'l' ;Is long int?
\r
240 ld r24, Y+ ;get value (high word)
\r
244 26: cpi r21, 'd' ;Is type signed decimal?
\r
253 27: cpi r21, 'u' ;Is type unsigned decimal?
\r
256 cpi r21, 'X' ;Is type hexdecimal?
\r
259 cpi r21, 'b' ;Is type binary?
\r
263 40: push ZH ;Output the value
\r
270 50: push ZH ;Put a string on the RAM
\r
272 _MOVW ZH,ZL, r25,r24
\r
279 60: push ZH ;Put a string on the ROM
\r
291 in YL, _SFR_IO_ADDR(SPL)
\r
293 in YH, _SFR_IO_ADDR(SPH)
\r
297 adiw YL, 5 ;Y = pointer to arguments
\r
309 _MOVW ZH,ZL, r15,r14
\r
311 _MOVW r15,r14, ZH,ZL
\r
317 in YL, _SFR_IO_ADDR(SPL)
\r
319 in YH, _SFR_IO_ADDR(SPH)
\r
323 adiw YL, 5 ;Y = pointer to arguments
\r
324 lds ZL, xfunc_out+0 ;Save registered output function
\r
325 lds ZH, xfunc_out+1 ;
\r
328 ldi ZL, lo8(pm(putram));Set local output function
\r
329 ldi ZH, hi8(pm(putram));
\r
330 sts xfunc_out+0, ZL ;
\r
331 sts xfunc_out+1, ZH ;/
\r
332 push r15 ;Initialize pointer to string buffer
\r
337 _MOVW ZH,ZL, r15,r14 ;Terminate string
\r
341 pop ZH ;Restore registered output function
\r
343 sts xfunc_out+0, ZL ;
\r
344 sts xfunc_out+1, ZH ;/
\r
358 in YL, _SFR_IO_ADDR(SPL)
\r
360 in YH, _SFR_IO_ADDR(SPH)
\r
364 adiw YL, 5 ;Y = pointer to arguments
\r
365 lds ZL, xfunc_out+0 ;Save registered output function
\r
366 lds ZH, xfunc_out+1 ;
\r
369 ld ZL, Y+ ;Set output function
\r
371 sts xfunc_out+0, ZL ;
\r
372 sts xfunc_out+1, ZH ;/
\r
374 pop ZH ;Restore registered output function
\r
376 sts xfunc_out+0, ZL ;
\r
377 sts xfunc_out+1, ZH ;/
\r
388 ;---------------------------------------------------------------------------
\r
389 ; Extended numeral string input
\r
392 ; char xatoi ( /* 1: Successful, 0: Failed */
\r
393 ; const char **str, /* pointer to pointer to source string */
\r
394 ; long *res /* result */
\r
403 _MOVW r1, r0, r23, r22
\r
404 _MOVW XH, XL, r25, r24
\r
407 clr r18 ;r21:r18 = 0;
\r
413 ldi r25, 10 ;r25 = 10;
\r
415 40: adiw ZL, 1 ;Z++;
\r
416 41: ld r22, Z ;r22 = *Z;
\r
417 cpi r22, ' ' ;if(r22 == ' ') continue
\r
419 brcs 70f ;if(r22 < ' ') error;
\r
420 cpi r22, '-' ;if(r22 == '-') {
\r
424 42: cpi r22, '9'+1 ;if(r22 > '9') error;
\r
426 cpi r22, '0' ;if(r22 < '0') error;
\r
428 brne 51f ;if(r22 > '0') cv_start;
\r
429 ldi r25, 8 ;r25 = 8;
\r
430 adiw ZL, 1 ;r22 = *(++Z);
\r
432 cpi r22, ' '+1 ;if(r22 <= ' ') exit;
\r
434 cpi r22, 'b' ;if(r22 == 'b') {
\r
435 brne 43f ; r25 = 2;
\r
436 ldi r25, 2 ; cv_start;
\r
438 43: cpi r22, 'x' ;if(r22 != 'x') error;
\r
440 ldi r25, 16 ;r25 = 16;
\r
442 50: adiw ZL, 1 ;Z++;
\r
443 ld r22, Z ;r22 = *Z;
\r
444 51: cpi r22, ' '+1 ;if(r22 <= ' ') break;
\r
446 cpi r22, 'a' ;if(r22 >= 'a') r22 =- 0x20;
\r
449 52: subi r22, '0' ;if((r22 -= '0') < 0) error;
\r
451 cpi r22, 10 ;if(r22 >= 10) {
\r
452 brcs 53f ; r22 -= 7;
\r
453 subi r22, 7 ; if(r22 < 10)
\r
456 53: cp r22, r25 ;if(r22 >= r25) error;
\r
458 60: ldi r24, 33 ;r21:r18 *= r25;
\r
469 add r18, r22 ;r21:r18 += r22;
\r
490 _MOVW XH, XL, r1, r0
\r