From 102e6f03e9d1ab9dc213b021b1dbe81d7fda332a Mon Sep 17 00:00:00 2001
From: Daniel Friesel <derf@finalrewind.org>
Date: Thu, 23 Sep 2021 20:58:49 +0200
Subject: lora32u4ii: stdout: Add pprint for PSTR (pgmspace strings)

---
 src/arch/lora32u4ii/driver/stdout.cc | 12 +++++++++++-
 1 file changed, 11 insertions(+), 1 deletion(-)

(limited to 'src')

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)));
-- 
cgit v1.2.3