00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022 #include <avr/pgmspace.h>
00023
00024
00025 #include <stdarg.h>
00026 #include "global.h"
00027 #include "rprintf.h"
00028
00029 #ifndef TRUE
00030 #define TRUE -1
00031 #define FALSE 0
00032 #endif
00033
00034 #define INF 32766 // maximum field size to print
00035 #define READMEMBYTE(a,char_ptr) ((a)?(pgm_read_byte(char_ptr)):(*char_ptr))
00036
00037 #ifdef RPRINTF_COMPLEX
00038 static unsigned char buf[128];
00039 #endif
00040
00041
00042
00043
00044
00045 static char __attribute__ ((progmem)) HexChars[] = "0123456789ABCDEF";
00046
00047
00048 static void (*rputchar)(unsigned char c);
00049
00050
00051
00052
00053 void rprintfInit(void (*putchar_func)(unsigned char c))
00054 {
00055 rputchar = putchar_func;
00056 }
00057
00058
00059
00060 inline void rprintfChar(unsigned char c)
00061 {
00062
00063 rputchar(c);
00064 }
00065
00066
00067
00068 void rprintfStr(char str[])
00069 {
00070
00071
00072 if (!str) return;
00073
00074
00075 while (*str)
00076 rprintfChar(*str++);
00077 }
00078
00079
00080
00081
00082
00083 void rprintfStrLen(char str[], unsigned int start, unsigned int len)
00084 {
00085 register int i=0;
00086
00087
00088 if (!str) return;
00089
00090
00091 while((i++<start) && (*str++));
00092
00093
00094
00095
00096
00097
00098
00099 for(i=0; i<len; i++)
00100 {
00101
00102
00103 if(*str)
00104 rprintfChar(*str++);
00105 else
00106 rprintfChar(' ');
00107 }
00108
00109 }
00110
00111
00112
00113 void rprintfProgStr(const prog_char str[])
00114 {
00115
00116 register char c;
00117
00118
00119 if (!str) return;
00120
00121
00122 while((c = pgm_read_byte(str++)))
00123 rprintfChar(c);
00124 }
00125
00126
00127
00128 void rprintfCRLF(void)
00129 {
00130
00131 rprintfChar('\r');
00132 rprintfChar('\n');
00133 }
00134
00135
00136
00137 void rprintfu04(unsigned char data)
00138 {
00139
00140
00141
00142
00143
00144
00145 rprintfChar(pgm_read_byte( HexChars+(data&0x0f) ));
00146 }
00147
00148
00149
00150 void rprintfu08(unsigned char data)
00151 {
00152
00153 rprintfu04(data>>4);
00154 rprintfu04(data);
00155 }
00156
00157
00158
00159 void rprintfu16(unsigned short data)
00160 {
00161
00162 rprintfu08(data>>8);
00163 rprintfu08(data);
00164 }
00165
00166
00167
00168 void rprintfu32(unsigned long data)
00169 {
00170
00171 rprintfu16(data>>16);
00172 rprintfu16(data);
00173 }
00174
00175
00176
00177
00178
00179
00180
00181
00182
00183
00184
00185
00186
00187 void rprintfNum(char base, char numDigits, char isSigned, char padchar, long n)
00188 {
00189
00190
00191 char *p, buf[32];
00192 unsigned long x;
00193 unsigned char count;
00194
00195
00196 if( isSigned && (n < 0) )
00197 {
00198 x = -n;
00199 }
00200 else
00201 {
00202 x = n;
00203 }
00204
00205
00206 count = (numDigits-1)-(isSigned?1:0);
00207 p = buf + sizeof (buf);
00208 *--p = '\0';
00209
00210
00211
00212 *--p = pgm_read_byte(HexChars + (x%base)); x /= base;
00213
00214 while(count--)
00215 {
00216 if(x != 0)
00217 {
00218
00219 *--p = pgm_read_byte(HexChars + (x%base)); x /= base;
00220 }
00221 else
00222 {
00223
00224 *--p = padchar;
00225 }
00226 }
00227
00228
00229 if( isSigned )
00230 {
00231 if(n < 0)
00232 {
00233 *--p = '-';
00234 }
00235 else if(n > 0)
00236 {
00237 *--p = '+';
00238 }
00239 else
00240 {
00241 *--p = ' ';
00242 }
00243 }
00244
00245
00246 count = numDigits;
00247 while(count--)
00248 {
00249 rprintfChar(*p++);
00250 }
00251 }
00252
00253 #ifdef RPRINTF_FLOAT
00254
00255
00256 void rprintfFloat(char numDigits, double x)
00257 {
00258 unsigned char firstplace = FALSE;
00259 unsigned char negative;
00260 unsigned char i, digit;
00261 double place = 1.0;
00262
00263
00264 negative = (x<0);
00265
00266 x = (x>0)?(x):(-x);
00267
00268
00269 for(i=0; i<15; i++)
00270 {
00271 if((x/place) < 10.0)
00272 break;
00273 else
00274 place *= 10.0;
00275 }
00276
00277 if(negative)
00278 rprintfChar('-');
00279 else
00280 rprintfChar('+');
00281
00282
00283 for(i=0; i<numDigits; i++)
00284 {
00285 digit = (x/place);
00286
00287 if(digit | firstplace | (place == 1.0))
00288 {
00289 firstplace = TRUE;
00290 rprintfChar(digit+0x30);
00291 }
00292 else
00293 rprintfChar(' ');
00294
00295 if(place == 1.0)
00296 {
00297 rprintfChar('.');
00298 }
00299
00300 x -= (digit*place);
00301 place /= 10.0;
00302 }
00303 }
00304 #endif
00305
00306 #ifdef RPRINTF_SIMPLE
00307
00308
00309
00310
00311
00312
00313 int rprintf1RamRom(unsigned char stringInRom, const char *format, ...)
00314 {
00315
00316
00317
00318 char format_flag;
00319 unsigned int u_val, div_val, base;
00320 va_list ap;
00321
00322 va_start(ap, format);
00323 for (;;)
00324 {
00325 while ((format_flag = READMEMBYTE(stringInRom,format++) ) != '%')
00326 {
00327 if (!format_flag)
00328 {
00329 va_end(ap);
00330 return(0);
00331 }
00332 rprintfChar(format_flag);
00333 }
00334
00335 switch (format_flag = READMEMBYTE(stringInRom,format++) )
00336 {
00337 case 'c': format_flag = va_arg(ap,int);
00338 default: rprintfChar(format_flag); continue;
00339 case 'd': base = 10; div_val = 10000; goto CONVERSION_LOOP;
00340 case 'x': base = 16; div_val = 0x10;
00341
00342 CONVERSION_LOOP:
00343 u_val = va_arg(ap,int);
00344 if (format_flag == 'd')
00345 {
00346 if (((int)u_val) < 0)
00347 {
00348 u_val = - u_val;
00349 rprintfChar('-');
00350 }
00351 while (div_val > 1 && div_val > u_val) div_val /= 10;
00352 }
00353 do
00354 {
00355 rprintfChar(pgm_read_byte(HexChars+(u_val/div_val)));
00356 u_val %= div_val;
00357 div_val /= base;
00358 } while (div_val);
00359 }
00360 }
00361 va_end(ap);
00362 }
00363 #endif
00364
00365
00366 #ifdef RPRINTF_COMPLEX
00367
00368
00369
00370
00371
00372
00373
00374
00375
00376
00377
00378 int rprintf2RamRom(unsigned char stringInRom, const char *sfmt, ...)
00379 {
00380 register unsigned char *f, *bp;
00381 register long l;
00382 register unsigned long u;
00383 register int i;
00384 register int fmt;
00385 register unsigned char pad = ' ';
00386 int flush_left = 0, f_width = 0, prec = INF, hash = 0, do_long = 0;
00387 int sign = 0;
00388
00389 va_list ap;
00390 va_start(ap, sfmt);
00391
00392 f = (unsigned char *) sfmt;
00393
00394 for (; READMEMBYTE(stringInRom,f); f++)
00395 {
00396 if (READMEMBYTE(stringInRom,f) != '%')
00397 {
00398
00399 rprintfChar(READMEMBYTE(stringInRom,f));
00400 }
00401 else
00402 {
00403 f++;
00404 if (READMEMBYTE(stringInRom,f) == '-')
00405 {
00406 flush_left = 1;
00407 f++;
00408 }
00409 if (READMEMBYTE(stringInRom,f) == '0'
00410 || READMEMBYTE(stringInRom,f) == '.')
00411 {
00412
00413 pad = '0';
00414 f++;
00415 }
00416 if (READMEMBYTE(stringInRom,f) == '*')
00417 {
00418 f_width = va_arg(ap, int);
00419 f++;
00420 }
00421 else if (Isdigit(READMEMBYTE(stringInRom,f)))
00422 {
00423 f_width = atoiRamRom(stringInRom, (char *) f);
00424 while (Isdigit(READMEMBYTE(stringInRom,f)))
00425 f++;
00426 }
00427 if (READMEMBYTE(stringInRom,f) == '.')
00428 {
00429 f++;
00430 if (READMEMBYTE(stringInRom,f) == '*')
00431 {
00432 prec = va_arg(ap, int);
00433 f++;
00434 }
00435 else if (Isdigit(READMEMBYTE(stringInRom,f)))
00436 {
00437 prec = atoiRamRom(stringInRom, (char *) f);
00438 while (Isdigit(READMEMBYTE(stringInRom,f)))
00439 f++;
00440 }
00441 }
00442 if (READMEMBYTE(stringInRom,f) == '#')
00443 {
00444 hash = 1;
00445 f++;
00446 }
00447 if (READMEMBYTE(stringInRom,f) == 'l')
00448 {
00449 do_long = 1;
00450 f++;
00451 }
00452
00453 fmt = READMEMBYTE(stringInRom,f);
00454 bp = buf;
00455 switch (fmt) {
00456 case 'd':
00457 if (do_long)
00458 l = va_arg(ap, long);
00459 else
00460 l = (long) (va_arg(ap, int));
00461 if (l < 0)
00462 {
00463 sign = 1;
00464 l = -l;
00465 }
00466 do {
00467 *bp++ = l % 10 + '0';
00468 } while ((l /= 10) > 0);
00469 if (sign)
00470 *bp++ = '-';
00471 f_width = f_width - (bp - buf);
00472 if (!flush_left)
00473 while (f_width-- > 0)
00474 rprintfChar(pad);
00475 for (bp--; bp >= buf; bp--)
00476 rprintfChar(*bp);
00477 if (flush_left)
00478 while (f_width-- > 0)
00479 rprintfChar(' ');
00480 break;
00481 case 'o':
00482 case 'x':
00483 case 'u':
00484 if (do_long)
00485 u = va_arg(ap, unsigned long);
00486 else
00487 u = (unsigned long) (va_arg(ap, unsigned));
00488 if (fmt == 'u')
00489 {
00490 do {
00491 *bp++ = u % 10 + '0';
00492 } while ((u /= 10) > 0);
00493 }
00494 else if (fmt == 'o')
00495 {
00496 do {
00497 *bp++ = u % 8 + '0';
00498 } while ((u /= 8) > 0);
00499 if (hash)
00500 *bp++ = '0';
00501 }
00502 else if (fmt == 'x')
00503 {
00504 do {
00505 i = u % 16;
00506 if (i < 10)
00507 *bp++ = i + '0';
00508 else
00509 *bp++ = i - 10 + 'a';
00510 } while ((u /= 16) > 0);
00511 if (hash)
00512 {
00513 *bp++ = 'x';
00514 *bp++ = '0';
00515 }
00516 }
00517 i = f_width - (bp - buf);
00518 if (!flush_left)
00519 while (i-- > 0)
00520 rprintfChar(pad);
00521 for (bp--; bp >= buf; bp--)
00522 rprintfChar((int) (*bp));
00523 if (flush_left)
00524 while (i-- > 0)
00525 rprintfChar(' ');
00526 break;
00527 case 'c':
00528 i = va_arg(ap, int);
00529 rprintfChar((int) (i));
00530 break;
00531 case 's':
00532 bp = va_arg(ap, unsigned char *);
00533 if (!bp)
00534 bp = (unsigned char *) "(nil)";
00535 f_width = f_width - strlen((char *) bp);
00536 if (!flush_left)
00537 while (f_width-- > 0)
00538 rprintfChar(pad);
00539 for (i = 0; *bp && i < prec; i++)
00540 {
00541 rprintfChar(*bp);
00542 bp++;
00543 }
00544 if (flush_left)
00545 while (f_width-- > 0)
00546 rprintfChar(' ');
00547 break;
00548 case '%':
00549 rprintfChar('%');
00550 break;
00551 }
00552 flush_left = 0, f_width = 0, prec = INF, hash = 0, do_long = 0;
00553 sign = 0;
00554 pad = ' ';
00555 }
00556 }
00557
00558 va_end(ap);
00559 return 0;
00560 }
00561
00562 unsigned char Isdigit(char c)
00563 {
00564 if((c >= 0x30) && (c <= 0x39))
00565 return TRUE;
00566 else
00567 return FALSE;
00568 }
00569
00570 int atoiRamRom(unsigned char stringInRom, char *str)
00571 {
00572 int num = 0;;
00573
00574 while(Isdigit(READMEMBYTE(stringInRom,str)))
00575 {
00576 num *= 10;
00577 num += ((READMEMBYTE(stringInRom,str++)) - 0x30);
00578 }
00579 return num;
00580 }
00581
00582 #endif
00583
00584
00585
00586
00587
00588
00589
00590
00591
00592
00593
00594
00595
00596
00597
00598
00599
00600
00601
00602
00603
00604
00605
00606
00607
00608
00609
00610
00611
00612
00613
00614
00615
00616
00617
00618
00619
00620
00621
00622
00623
00624
00625
00626
00627
00628
00629
00630
00631
00632
00633
00634
00635
00636
00637
00638
00639
00640
00641
00642
00643
00644
00645
00646
00647
00648
00649
00650
00651
00652
00653
00654
00655
00656
00657
00658
00659
00660
00661
00662
00663
00664
00665
00666
00667
00668
00669
00670
00671
00672
00673
00674
00675
00676
00677
00678
00679
00680
00681
00682
00683
00684
00685
00686
00687
00688
00689
00690
00691
00692
00693
00694
00695
00696
00697
00698
00699
00700
00701
00702
00703
00704
00705
00706
00707
00708
00709
00710
00711
00712
00713
00714
00715
00716
00717
00718
00719
00720
00721
00722
00723
00724
00725
00726
00727
00728
00729
00730
00731
00732
00733
00734
00735
00736
00737
00738
00739
00740
00741
00742
00743
00744
00745
00746
00747
00748
00749
00750
00751
00752
00753
00754
00755
00756
00757
00758
00759
00760
00761
00762
00763
00764
00765
00766
00767
00768
00769
00770
00771
00772
00773