ode45 fixed, now it has the same output as Matlab code