Fixed realtime, will work after RK4 stepper is fixed