Add unit test for `PiecewiseTrajectory`, and fix `PiecewiseTrajectory` such that it passes

Gerhard Ravenrequested to merge
add-piecewise-trajectory-unittest into master

NOT for any run1/run2 patches branch

Edited by Marco Cattaneo

Merge request reports