Solid pathfinding (but faces wrong angle)