Debugging issue with RK4 integrator.