Finish Teensy 3.x port