From a1e1c65aa49ad9a3b9b89984bfdabee0dfa0878e Mon Sep 17 00:00:00 2001
From: blackfur <64478051+TheBlackfurGuy@users.noreply.github.com>
Date: Tue, 9 Feb 2021 09:56:51 +0100
Subject: [PATCH] Add files via upload

---
 ardlego-joy.ino | 63 +++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 63 insertions(+)
 create mode 100644 ardlego-joy.ino

diff --git a/ardlego-joy.ino b/ardlego-joy.ino
new file mode 100644
index 0000000..b31d9ef
--- /dev/null
+++ b/ardlego-joy.ino
@@ -0,0 +1,63 @@
+#include <legopowerfunctions.h>
+
+byte analogX = A1;
+byte analogY = A0;
+
+int X = 0;
+int Y = 0;
+
+LEGOPowerFunctions lego(11);
+
+int analogToLEGOPWM(int num) {
+  if (num > 0 && num <= 64) {
+    return 9;
+  } else if (num > 64 && num <= 128) {
+    return 10;
+  } else if (num > 128 && num <= 192) {
+    return 11;
+  } else if (num > 192 && num <= 256) {
+    return 12;
+  } else if (num > 256 && num <= 320) {
+    return 13;
+  } else if (num > 320 && num <= 384) {
+    return 14;
+  } else if (num > 384 && num <= 448) {
+    return 15;
+  } else if (num > 448 && num <= 576) {
+    return 8;
+  } else if (num > 576 && num <= 640) {
+    return 1;
+  } else if (num > 640 && num <= 704) {
+    return 2;
+  } else if (num > 704 && num <= 768) {
+    return 3;
+  } else if (num > 768 && num <= 832) {
+    return 4;
+  } else if (num > 832 && num <= 896) {
+    return 5;
+  } else if (num > 896 && num <= 960) {
+    return 6;
+  } else if (num > 960 && num <= 1024) {
+    return 7;
+  }
+}
+
+void setup() {
+  Serial.begin(9600);
+}
+
+void loop() {
+  X = analogRead(analogX);
+  Y = analogRead(analogY);
+  Serial.print("X: ");
+  Serial.print(X);
+  Serial.print(" Y: ");
+  Serial.print(Y);
+  Serial.print(" PWMX: ");
+  //Serial.print(analogToLEGOPWMBlue(X));
+  Serial.print(analogToLEGOPWM(X+1));
+  Serial.print(" PWMY: "); 
+  //Serial.println(analogToLEGOPWMRed(Y));
+  Serial.println(analogToLEGOPWM(Y+1));
+  lego.ComboPWM(analogToLEGOPWM(X+1),analogToLEGOPWM(Y+1),CH1);
+}