Fixed some positioning issues for 3x2 or 2x3 buildings
Started implementation of new pathfinder logic