Still issues with variable timestep.
Now working.