Adjusted for non-continuous servos

Angle addition to allow for angle holding and pan/tilt in the negative
direction.