Diff: Leds/LEDs.cpp

Revision:

6:5f76dd718dc3

Child:

10:29126a41b1da

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Leds/LEDs.cpp	Wed Feb 19 21:40:21 2020 +0000
@@ -0,0 +1,61 @@
+#include "LEDs.h"
+
+void LEDs::Speed(bool leds_on, float speed, float max_speed, Gamepad &Device)
+{
+    if(leds_on == true) {
+        float mapped_speed = 3 * speed / max_speed;
+
+        if(mapped_speed < 1) {
+            Device.led(1,0);
+            Device.led(2,0);
+            Device.led(3, mapped_speed);
+        } else if (mapped_speed >= 1 && mapped_speed < 2) {
+            Device.led(1,0);
+            Device.led(2, (mapped_speed - 1));
+            Device.led(3,1);
+        } else if (mapped_speed >= 2 && mapped_speed < 3) {
+            Device.led(1, (mapped_speed - 2));
+            Device.led(2,1);
+            Device.led(3,1);
+        }
+    }
+
+}
+
+void LEDs::Start_Sequence(bool leds_on,  int state, Gamepad &Device)
+{
+    if(leds_on == true) {
+        if(state == 2) {
+            Device.led(1,1);
+            Device.led(2,0);
+            Device.led(3,0);
+            Device.led(4,1);
+            Device.led(5,0);
+            Device.led(6,0);
+        } else if(state == 1) {
+            Device.led(1,0);
+            Device.led(2,1);
+            Device.led(3,0);
+            Device.led(4,0);
+            Device.led(5,1);
+            Device.led(6,0);
+        } else if(state == 0) {
+            Device.led(1,0);
+            Device.led(2,0);
+            Device.led(3,1);
+            Device.led(4,0);
+            Device.led(5,0);
+            Device.led(6,1);
+        }
+    }
+}
+
+void LEDs::Clear(Gamepad &Device)
+{
+    Device.led(1,0);
+    Device.led(2,0);
+    Device.led(3,0);
+    Device.led(4,0);
+    Device.led(5,0);
+    Device.led(6,0);
+}
\ No newline at end of file