ServoEx/Phoenix_Driver_Servoex - Update

Found a bug with yesterdays delta, Also tested by converting my SQ3 Quad
hexapod, to use my Teensy 3.1 board and have it directly drive the
servos