From f99d467c3651094306d056f074382f85cd6c8d74 Mon Sep 17 00:00:00 2001
From: EmaMaker <emamaker0@gmail.com>
Date: Thu, 17 Dec 2020 13:04:32 +0100
Subject: [PATCH] ball_read: add option to receive bytes from teensy Those will
 turn LED2, LED3, LED4 on or off depending on the byte received They can be
 used as status LEDs to report Teensy activity

---
 utility/32u4/ball_read/ball_read.ino | 23 ++++++++++++++++++-----
 1 file changed, 18 insertions(+), 5 deletions(-)

diff --git a/utility/32u4/ball_read/ball_read.ino b/utility/32u4/ball_read/ball_read.ino
index 2c3eef8..9cc2a02 100644
--- a/utility/32u4/ball_read/ball_read.ino
+++ b/utility/32u4/ball_read/ball_read.ino
@@ -92,11 +92,11 @@ void setup() {
   //Set the LEDs as outputs, keep the rest as input by default
 
   //LED3(PB7) and LED4 (PB0)
-  //DDRB |= 0b10000001;
+  DDRB |= 0b10000001;
   //LED2 (PF0)
-  //DDRF |= 0b00000001;
+  DDRF |= 0b00000001;
   //LED1 (PD5)
-  //DDRD |= 0b00100000;
+  DDRD |= 0b00100000;
   
   /*pinMode(26, INPUT);   //S1
   pinMode(25, INPUT);   //S2
@@ -125,6 +125,7 @@ void loop() {
   readBallInterpolation();
   //printCounter();
   sendDataInterpolation();
+  readFromTeensy();
   //test();
   //delay(100);
 }
@@ -182,11 +183,11 @@ void readBallInterpolation() {
   distance = nmax;
   
   //turn led on
-  /*if (distance == 0) {
+  if (distance == 0) {
     LED1OFF;
   } else {
     LED1ON;
-  }*/
+  }
 }
 
 void sendDataInterpolation() {
@@ -257,3 +258,15 @@ void printCounter() {
   Serial1.println();
   delay(100);
 }
+
+void readFromTeensy(){
+  while(Serial1.available()){
+    byte b = Serial1.read();
+    if(b & 0b00000001 == 1) LED2ON;
+    else LED2OFF;
+    if((b & 0b00000010) >> 1 == 1) LED3ON;
+    else LED3OFF;
+    if((b & 0b00000100) >> 2 == 1) LED4ON;
+    else LED4OFF;
+  }
+}