feat(manipulation): add trajectory parametrization (#3287)