Fix Servo Offset code

Fix some of the issues, like C/F/T commands did not work, plus using
characters to hold offsets did not fully work as old value may have been
-100 and we want +100 so the 200 delta does not fit in a signed
character value