Add PiecewisePolynomialTrajectory