fix for reconstructStateTrajectory error found by build server