Mostly fixed running around obstacle issues