Fixed a bug with pathing caused when a unit was exactly on a boundary