Tracker: only run servo updates when safety is off

Largely removes the sudden jerk that occurs when the user pushes the
safety switch