Minor fix in dynamics2D to fix a compilation warning
Minor code refactoring
More work on the PhysX engine.

1. finished the first implementation of the multi-body model
2. cleaned up the code of the single-body model