Only zero the output velocity when near the goal orientation