Fixed timestep integrator bug