Support Teensy 3.x & fix null pointer write