Teensy firmware initial commit