Trajectory generation code now includes rho sampling.
Working new sampling scheme into SMCTreeDensity.