Switched ekf integrator to rk4 from odeint to avoid re-entrant errors