Related to #3135 

## Changes:

- Adds collision sub-stepping to discretize each frame further to help with fast moving objects
- Improves integration accuracy