Arduino Code for MeU Square that runs on Teensy 3.1