Teensy Code for Yoke Controller