From 33cfcd5c91f2a9c7a5fe71d6e20d4eddfdc0e6fe Mon Sep 17 00:00:00 2001
From: spatialfree <mail@ethanmerchant.com>
Date: Tue, 2 Apr 2024 14:54:31 -0400
Subject: [PATCH] chiral

---
 firmware/braille_xr/braille_xr.ino | 11 +++++++++--
 1 file changed, 9 insertions(+), 2 deletions(-)

diff --git a/firmware/braille_xr/braille_xr.ino b/firmware/braille_xr/braille_xr.ino
index e79b558..a67710c 100644
--- a/firmware/braille_xr/braille_xr.ino
+++ b/firmware/braille_xr/braille_xr.ino
@@ -29,9 +29,9 @@ ServoPin servos[6] = {
 // 00
 // braille alphabet array
 struct BrailleChar {
-  int servoStates[6];
+  int servo_states[6];
 };
-std::unordered_map<char, BrailleChar> brailleMap = {
+std::unordered_map<char, BrailleChar> braille_map = {
   {' ', {{
     0, 0,
     0, 0,
@@ -240,6 +240,13 @@ void loop() {
   // udp.broadcast("Anyone here?");
 
   if (in_char != old_char) {
+    BrailleChar bc = braille_map[in_char];
+    for (int i = 0; i < 6; i++) {
+      int state = bc.servo_states[i];
+      int s = i % 2 == 0 ? state : (1 - state);
+      servos[i].servo.write(s * 180);
+    }
+
     old_char = in_char;
   }
 }
\ No newline at end of file