added encoder again

Multi-line description of commit,
feel free to be detailed.

Signed-off-by: Abel Tim <git@abeltim.com>

1 files changed, 20 insertions, 0 deletions

diff --git a/code/debug/communication&IR/rx/rx_teensy/src/main.cpp b/code/debug/communication&IR/rx/rx_teensy/src/main.cpp
new file mode 100644
index 0000000..f3e9e79
--- /dev/null
+++ b/code/debug/communication&IR/rx/rx_teensy/src/main.cpp
@@ -0,0 +1,20 @@
+// this code is for Teensy 4.1 to read serial data and relay it to serial 1(computer)
+
+#include <Arduino.h>
+
+int incomingbyte = 0; 
+void setup() {
+  Serial.begin(9600);
+  Serial2.begin(9600); //19200
+  Serial3.begin(9600); //19200
+  Serial.print("Starting ....");
+}
+
+void loop() {
+  if (Serial3.available() > 0) {
+    incomingbyte = Serial3.read();
+    Serial.print(char(incomingbyte));
+  }
+  milis(1);
+  
+} 
\ No newline at end of file