Function resolve_contact 

pub fn resolve_contact(
    a: &mut RigidBody,
    b: &mut RigidBody,
    manifold: &ContactManifold,
)

Resolve a contact manifold by applying impulses to both bodies.