Added C++ version of PSV algorithm; implemented comparisons of PSV/diffusion to WF