Multithreaded RRTForest working sharing costs only