ServoEx Support on Teensy

First pass add support for Teensy 3/3.1 to servoEx library.

May extract later to own project