From 6c316629703ffee8c09baf05fd5706551ecf6b97 Mon Sep 17 00:00:00 2001
From: Aadi Desai <21363892+supleed2@users.noreply.github.com>
Date: Sat, 22 May 2021 18:06:39 +0100
Subject: [PATCH] UART Test program for ESP32 expansion board

Uses ESP32 hardware serial UARTs with pins of Arduino HAT board
---
 Control/src/main.cpp | 28 ++++++++++++++++++++++++++--
 1 file changed, 26 insertions(+), 2 deletions(-)

diff --git a/Control/src/main.cpp b/Control/src/main.cpp
index 1943407..847d03a 100644
--- a/Control/src/main.cpp
+++ b/Control/src/main.cpp
@@ -1,9 +1,33 @@
 #include <Arduino.h>
-#define LED_BUILTIN 2
+#include <string>
+
+#define RX1pin 14 // Pin 10 on expansion board
+#define TX1pin  4 // Pin 11 on expansion board
+#define RX2pin 15 // Pin 12 on expansion board
+#define TX2pin  2 // Pin 13 on expansion board
+
+void forwardprint();
+
+int counter;
+String input1, input2;
 
 void setup() {
-	Serial.begin(115200);
+	Serial.begin(115200); // Set up hardware UART 0 (Connected to USB port)
+	Serial1.begin(9600, SERIAL_8N1, RX1pin, TX1pin); // Set up hardware UART 1
+	Serial2.begin(9600, SERIAL_8N1, RX2pin, TX2pin); // Set up hardware UART 2
 }
 
 void loop() {
+	forwardprint();
+	if(Serial.available()){
+		input1 = String(Serial.readStringUntil('\n'));
+		Serial1.println(input1);
+	}
+}
+
+void forwardprint() {
+	if(Serial2.available()){
+		input2 = String(Serial2.readStringUntil('\n'));
+		Serial.println(input2);
+	}
 }