Reduced time step back to 30hz, seems to run a lot better.