Added some collision pathfinding detection