Finish porting to Teensy 3.1