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 brailleMap = { +std::unordered_map 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