fix TrajectoryBuilderPSet