Movement uncertainties, and bug fix to find goal