Add support for the different body types (static, kinematic, dynamic)
Fix issue in the broad-phase pair manager