Add a lot of stuffs.

- Use Clone instead of Copy
- Add a (incomplete) implomentation of dbvh-based broad phase.
- Add an incremental contact manifols genertor based on variance maximization.
Removed a debug println.