Updated Teensy Code