loop index in jac
f diff initialised in step_ekf
LU permutation in ekf, corrected size