pub fn test_collision(a: &RigidBody, b: &RigidBody) -> Option<Contact>
Test collision between two rigid bodies. Returns a contact if overlapping. Contact normal always points from body_a toward body_b.