Fixed bugged behavior for awkward corner cases like on backdoor map. made moveTo method that we should put in util.