Improve performance (a lot!) of PathTreeSearch algorithm
Improve performance (a lot!) of PathTreeSearch algorithm

fire-rs-laas/fire-rs-saop,fire-rs-laas/fire-rs-saop,fire-rs-laas/fire-rs-saop,fire-rs-laas/fire-rs-saop