Port ContactSolver

Signed-off-by: Aleksi Sapon <QcTechs@gmail.com>
Port DynamicsWorld

Signed-off-by: Aleksi Sapon <QcTechs@gmail.com>