turns out the 100us sleep in the set servo is really important