Incorporate Paul Stoffregen's Teensy 3.1 changes