diff options
| -rw-r--r-- | include/arch/lora32u4ii/driver/stdout.h | 2 | ||||
| -rw-r--r-- | src/arch/lora32u4ii/driver/stdout.cc | 12 |
2 files changed, 13 insertions, 1 deletions
diff --git a/include/arch/lora32u4ii/driver/stdout.h b/include/arch/lora32u4ii/driver/stdout.h index 2eb669d..e9f0411 100644 --- a/include/arch/lora32u4ii/driver/stdout.h +++ b/include/arch/lora32u4ii/driver/stdout.h @@ -1,6 +1,7 @@ #ifndef STANDARDOUTPUT_H #define STANDARDOUTPUT_H +#include <avr/pgmspace.h> #include "object/outputstream.h" class StandardOutput : public OutputStream { @@ -12,6 +13,7 @@ class StandardOutput : public OutputStream { void setup(); virtual void put(char c) override; + OutputStream & pprint(const char *text); }; extern StandardOutput kout; diff --git a/src/arch/lora32u4ii/driver/stdout.cc b/src/arch/lora32u4ii/driver/stdout.cc index afe6ff8..ee45a43 100644 --- a/src/arch/lora32u4ii/driver/stdout.cc +++ b/src/arch/lora32u4ii/driver/stdout.cc @@ -1,6 +1,5 @@ #include "driver/stdout.h" #include <avr/io.h> -#include <avr/interrupt.h> #ifndef BAUD #define BAUD 9600UL @@ -24,6 +23,17 @@ void StandardOutput::setup() //UCSR1D = 0; } +OutputStream & StandardOutput::pprint(const char *text) +{ + PGM_P p = reinterpret_cast<PGM_P>(text); + char c; + while ((c = pgm_read_byte(p++))) { + put(c); + } + return *this; +} + + void StandardOutput::put(char c) { while (!(UCSR1A & _BV(UDRE1))); |