Path following fix, Trajectory class fix, reporting trajectory curves and their curvatures, together with min ICR offset during the motion