TST: move the test that samples an initial feasible trajectory