working on trajectory initialization. need to do it so other examples with nontrivial initializations can use it too