Keisuke Sehara
/
STM32_Whisking
fast-feedback virtual target task code on STM Nucleo
IO.cpp@0:f736749c33d2, 2018-05-14 (annotated)
- Committer:
- gwappa
- Date:
- Mon May 14 14:12:32 2018 +0000
- Revision:
- 0:f736749c33d2
set up config parser
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
gwappa | 0:f736749c33d2 | 1 | #include "IO.h" |
gwappa | 0:f736749c33d2 | 2 | #define NEWLINE "\r\n" |
gwappa | 0:f736749c33d2 | 3 | |
gwappa | 0:f736749c33d2 | 4 | namespace IO { |
gwappa | 0:f736749c33d2 | 5 | Serial conn(USBTX, USBRX, LOGGER_BAUDRATE); |
gwappa | 0:f736749c33d2 | 6 | |
gwappa | 0:f736749c33d2 | 7 | int getc() { |
gwappa | 0:f736749c33d2 | 8 | return conn.getc(); |
gwappa | 0:f736749c33d2 | 9 | } |
gwappa | 0:f736749c33d2 | 10 | |
gwappa | 0:f736749c33d2 | 11 | void config(const char *fmt,...) { |
gwappa | 0:f736749c33d2 | 12 | std::va_list args; |
gwappa | 0:f736749c33d2 | 13 | va_start(args, fmt); |
gwappa | 0:f736749c33d2 | 14 | conn.putc(CONFIG_HEADER); |
gwappa | 0:f736749c33d2 | 15 | conn.vprintf(fmt, args); |
gwappa | 0:f736749c33d2 | 16 | va_end(args); |
gwappa | 0:f736749c33d2 | 17 | conn.printf(NEWLINE); |
gwappa | 0:f736749c33d2 | 18 | } |
gwappa | 0:f736749c33d2 | 19 | |
gwappa | 0:f736749c33d2 | 20 | void info(const char *fmt, ...) { |
gwappa | 0:f736749c33d2 | 21 | std::va_list args; |
gwappa | 0:f736749c33d2 | 22 | va_start(args, fmt); |
gwappa | 0:f736749c33d2 | 23 | conn.putc(INFO_HEADER); |
gwappa | 0:f736749c33d2 | 24 | conn.vprintf(fmt, args); |
gwappa | 0:f736749c33d2 | 25 | va_end(args); |
gwappa | 0:f736749c33d2 | 26 | conn.printf(NEWLINE); |
gwappa | 0:f736749c33d2 | 27 | } |
gwappa | 0:f736749c33d2 | 28 | |
gwappa | 0:f736749c33d2 | 29 | void result(const char *fmt, ...) { |
gwappa | 0:f736749c33d2 | 30 | std::va_list args; |
gwappa | 0:f736749c33d2 | 31 | va_start(args, fmt); |
gwappa | 0:f736749c33d2 | 32 | conn.putc(RESULT_HEADER); |
gwappa | 0:f736749c33d2 | 33 | conn.vprintf(fmt, args); |
gwappa | 0:f736749c33d2 | 34 | va_end(args); |
gwappa | 0:f736749c33d2 | 35 | conn.printf(NEWLINE); |
gwappa | 0:f736749c33d2 | 36 | } |
gwappa | 0:f736749c33d2 | 37 | |
gwappa | 0:f736749c33d2 | 38 | void error(const char *fmt, ...) { |
gwappa | 0:f736749c33d2 | 39 | std::va_list args; |
gwappa | 0:f736749c33d2 | 40 | va_start(args, fmt); |
gwappa | 0:f736749c33d2 | 41 | conn.putc(ERROR_HEADER); |
gwappa | 0:f736749c33d2 | 42 | conn.vprintf(fmt, args); |
gwappa | 0:f736749c33d2 | 43 | va_end(args); |
gwappa | 0:f736749c33d2 | 44 | conn.printf(NEWLINE); |
gwappa | 0:f736749c33d2 | 45 | } |
gwappa | 0:f736749c33d2 | 46 | |
gwappa | 0:f736749c33d2 | 47 | void debug(const char *fmt, ...) { |
gwappa | 0:f736749c33d2 | 48 | std::va_list args; |
gwappa | 0:f736749c33d2 | 49 | va_start(args, fmt); |
gwappa | 0:f736749c33d2 | 50 | conn.putc(DEBUG_HEADER); |
gwappa | 0:f736749c33d2 | 51 | conn.vprintf(fmt, args); |
gwappa | 0:f736749c33d2 | 52 | va_end(args); |
gwappa | 0:f736749c33d2 | 53 | conn.printf(NEWLINE); |
gwappa | 0:f736749c33d2 | 54 | } |
gwappa | 0:f736749c33d2 | 55 | |
gwappa | 0:f736749c33d2 | 56 | void write(const char *fmt, ...) { |
gwappa | 0:f736749c33d2 | 57 | std::va_list args; |
gwappa | 0:f736749c33d2 | 58 | va_start(args, fmt); |
gwappa | 0:f736749c33d2 | 59 | conn.vprintf(fmt, args); |
gwappa | 0:f736749c33d2 | 60 | va_end(args); |
gwappa | 0:f736749c33d2 | 61 | } |
gwappa | 0:f736749c33d2 | 62 | |
gwappa | 0:f736749c33d2 | 63 | void write(const char& c) { |
gwappa | 0:f736749c33d2 | 64 | conn.putc(c); |
gwappa | 0:f736749c33d2 | 65 | } |
gwappa | 0:f736749c33d2 | 66 | } |