129 lines
2.2 KiB
C
129 lines
2.2 KiB
C
#include "sersendf.h"
|
|
|
|
#include <stdarg.h>
|
|
#include <avr/pgmspace.h>
|
|
|
|
#include "serial.h"
|
|
#include "sermsg.h"
|
|
|
|
PGM_P str_ox = "0x";
|
|
|
|
void sersendf(char *format, ...) {
|
|
va_list args;
|
|
va_start(args, format);
|
|
|
|
uint16_t i = 0;
|
|
uint8_t c, j = 0;
|
|
while ((c = format[i++])) {
|
|
if (j) {
|
|
switch(c) {
|
|
case 'l':
|
|
j = 4;
|
|
case 'u':
|
|
if (j == 4)
|
|
serwrite_uint32(va_arg(args, uint32_t));
|
|
else
|
|
serwrite_uint16(va_arg(args, uint16_t));
|
|
j = 0;
|
|
break;
|
|
case 'd':
|
|
if (j == 4)
|
|
serwrite_int32(va_arg(args, int32_t));
|
|
else
|
|
serwrite_int16(va_arg(args, int16_t));
|
|
j = 0;
|
|
break;
|
|
case 'p':
|
|
case 'x':
|
|
serial_writestr_P(str_ox);
|
|
if (j == 4)
|
|
serwrite_hex32(va_arg(args, uint32_t));
|
|
else
|
|
serwrite_hex16(va_arg(args, uint16_t));
|
|
j = 0;
|
|
break;
|
|
case 'c':
|
|
serial_writechar(va_arg(args, uint16_t));
|
|
j = 0;
|
|
break;
|
|
case 's':
|
|
serial_writestr(va_arg(args, uint8_t *));
|
|
j = 0;
|
|
break;
|
|
default:
|
|
j = 0;
|
|
break;
|
|
}
|
|
}
|
|
else {
|
|
if (c == '%') {
|
|
j = 2;
|
|
}
|
|
else {
|
|
serial_writechar(c);
|
|
}
|
|
}
|
|
}
|
|
va_end(args);
|
|
}
|
|
|
|
void sersendf_P(PGM_P format, ...) {
|
|
va_list args;
|
|
va_start(args, format);
|
|
|
|
uint16_t i = 0;
|
|
uint8_t c = 1, j = 0;
|
|
while ((c = pgm_read_byte(&format[i++]))) {
|
|
if (j) {
|
|
switch(c) {
|
|
case 's':
|
|
j = 1;
|
|
break;
|
|
case 'l':
|
|
j = 4;
|
|
break;
|
|
case 'u':
|
|
if (j == 4)
|
|
serwrite_uint32(va_arg(args, uint32_t));
|
|
else
|
|
serwrite_uint16(va_arg(args, uint16_t));
|
|
j = 0;
|
|
break;
|
|
case 'd':
|
|
if (j == 4)
|
|
serwrite_int32(va_arg(args, int32_t));
|
|
else
|
|
serwrite_int16(va_arg(args, int16_t));
|
|
j = 0;
|
|
break;
|
|
/* case 'x':
|
|
serial_writestr_P(str_ox);
|
|
if (j == 4)
|
|
serwrite_hex32(va_arg(args, uint32_t));
|
|
else if (j == 1)
|
|
serwrite_hex8(va_arg(args, uint16_t));
|
|
else
|
|
serwrite_hex16(va_arg(args, uint16_t));
|
|
j = 0;
|
|
break;
|
|
case 'c':
|
|
serial_writechar(va_arg(args, uint16_t));
|
|
case 'p':
|
|
serwrite_hex16(va_arg(args, uint16_t));
|
|
default:
|
|
j = 0;
|
|
break;*/
|
|
}
|
|
}
|
|
else {
|
|
if (c == '%') {
|
|
j = 2;
|
|
}
|
|
else {
|
|
serial_writechar(c);
|
|
}
|
|
}
|
|
}
|
|
va_end(args);
|
|
}
|