Fix drawing backward trajectories
Make sure all methods are const