Updated the PRM and FADPRM algorithms to use new connection strategy. Created unified SBMP visitor concepts.