Fixed? possible bug in WalkPathPlanner, in GoToPoint.