Harry/servo lock

tested all states and transitions