Use LSPB tajectory generator for ECM, new values for ECM PID and tracking errors