Fixed some bugs with clearance based pathfinding, not too sure on how to resolve a few issues with clearance based pathfinding and connections