tangents and servos

-algorithm for servo movement