Added firmware for Teensy 3.1 and Teensy 3.0 (built but not tested)