3 files changed, 101 insertions, 36 deletions
diff --git a/CODE/debug/IR/IR_sens1/IR_sens1.ino b/CODE/debug/IR/IR_sens/IR_sens1.ino
index df4a5fc..df4a5fc 100644
--- a/CODE/debug/IR/IR_sens1/IR_sens1.ino
+++ b/CODE/debug/IR/IR_sens/IR_sens1.ino
diff --git a/CODE/debug/IR/IR_sens2/IR_sens2.ino b/CODE/debug/IR/IR_sens2/IR_sens2.ino
deleted file mode 100644
index 5fb4e9f..0000000
--- a/CODE/debug/IR/IR_sens2/IR_sens2.ino
+++ /dev/null
@@ -1,36 +0,0 @@
-int ir9 = 0
-int ir10 = 1
-int ir11 = 9
-int ir12 = 2
-int ir13 = 3
-int ir14 = 4
-int ir15 = 5
-int ir16 = 8
-
-int dir1 = 1;   // data IR1
-int dir2 = 1;   // data IR2
-int dir3 = 1;   // etc
-int dir4 = 1;   
-int dir5 = 1;    
-int dir6 = 1;   
-int dir7 = 1;   
-int dir8 = 1;
-
-volatile long IRcount1 = 0;
-volatile long IRcount2 = 0;
-volatile long IRcount3 = 0;
-volatile long IRcount4 = 0;
-volatile long IRcount5 = 0;
-volatile long IRcount6 = 0;
-volatile long IRcount7 = 0;
-volatile long IRcount8 = 0;
-
-void setup() {
-  // put your setup code here, to run once:
-
-}
-
-void loop() {
-  // put your main code here, to run repeatedly:
-
-}
diff --git a/CODE/debug/IR/teensydeco/teensydeco.ino b/CODE/debug/IR/teensydeco/teensydeco.ino
new file mode 100644
index 0000000..87828be
--- /dev/null
+++ b/CODE/debug/IR/teensydeco/teensydeco.ino
@@ -0,0 +1,101 @@
+int incomingbyte1 = 0;  //the byte that it is reciefing
+bool iswriting1 = false;  //true if writing else fals
+String tlocdat1 = "";  //temporary location data
+String locdat1 = "";   //location data
+int nir1 = "-99"; // which ir sensor it is
+int pir1 = "-99"; // amount of pulses it had
+
+int incomingbyte2 = 0;  //same but for seeed xiao N 2
+bool iswriting2 = false;
+String tlocdat2 = ""; 
+String locdat2 = ""; 
+int nir2 = "-99";
+int pir2 = "-99";
+
+float degwhere = -99.0; // where the ball is in degrees
+
+void setup() {
+  Serial.begin(9600);
+  Serial1.begin(9600);
+  Serial2.begin(9600);
+}
+
+void loop() {
+  if (Serial1.available() > 0) {
+    incomingbyte1 = Serial1.read();
+    //Serial.print(char(incomingbyte1));
+    if (incomingbyte1 == 's'){
+      iswriting1 = true;
+      tlocdat1 = "";
+    }else if(incomingbyte1 == 'e'){
+      iswriting1 = false;
+      locdat1 = tlocdat1;        
+    }else if(iswriting1 == true){
+      //Serial.print(char(incomingbyte1));
+      tlocdat1 += (char)incomingbyte1;  
+    }
+  }
+  if (Serial2.available() > 0) {
+    incomingbyte2 = Serial2.read();
+    //Serial.print(char(incomingbyte2));
+    if (incomingbyte2 == 's'){
+      iswriting2 = true;
+      tlocdat2 = "";
+    }else if(incomingbyte1 == 'e'){
+      iswriting2 = false;
+      locdat2 = tlocdat1;        
+    }else if(iswriting2 == true){
+      //Serial.print(char(incomingbyte1));
+      tlocdat2 += (char)incomingbyte1;  
+    }
+  }
+  //Serial.println(locdat);
+  sscanf(locdat1.c_str(), "%d, %d", &nir1, &pir1);
+  sscanf(locdat2.c_str(), "%d, %d", &nir2, &pir2);
+  
+  
+  if(pir1 > pir2){
+     if(nir1 = 1){    //not good looking code because posbile wrong wireing
+      degwhere = 0;      
+     }else if(nir1 = 2){
+      degwhere = 22.5;
+     }else if(nir1 = 3){
+      degwhere = 45;
+     }else if(nir1 = 4){
+      degwhere = 67.5;
+     }else if(nir1 = 5){
+      degwhere = 90;
+     }else if(nir1 = 6){
+      degwhere = 112.5;
+     }else if(nir1 = 7){
+      degwhere = 135;
+     }else if(nir1 = 8){
+      degwhere = 157.5;
+     }
+  }else{     
+     if(nir2 = 1){
+      degwhere = 180;
+     }else if(nir2 = 2){
+      degwhere = 202.5;
+     }else if(nir2 = 3){
+      degwhere = 225;
+     }else if(nir2 = 4){
+      degwhere = 247.5;
+     }else if(nir2 = 5){
+      degwhere = 270;
+     }else if(nir2 = 6){
+      degwhere = 292.5;
+     }else if(nir2 = 7){
+      degwhere = 315; 
+     }else if(nir2 = 8){
+      degwhere = 337.5; 
+     }
+  }
+  
+  Serial.print("IR sensor N: ");
+  Serial.print(nir1);
+  Serial.print(", with ");
+  Serial.print(pir1);
+  Serial.println(" pulses.");
+  delay(10);
+}