Feedforward control to the path following geometry. + telemetry for it