MSP: Track the KDTree size
MSP: Reserve paths vector in advance